Manual

Copyright © Dr Robot Inc. 2008
49
The the robot position X = (xL + xR) /2
Y = (yL + yR) /2
Z = zL = zR = z1- CarHeight = z2 - CarHeight
L3
(xL,yL,zL)
DisSensor
(x2,y2,z2)
(x1,y1,z1)
CarSensorDis
CarHeight
(xR,yR,zR) L1
L2
L4