At the picture you can see my bot improved. All wires hided inside the box. Scan algorithm was improved as well. Now I can release him for long autonomous traveling inside my house.
For servo coding I used my USB scope DSO-2090. All pulses was measured perfect.
This pulse controls the servo position. 1 ms - the servo edge position.