Dnipro University of Technology — Compliance with the Time

Theoretical part

Calculation of the trajectory of Car Vali:

The robotic electric car "Car Vali" has to drive through the rotunda, fitting into the width of the Allowed zone of the road (Fig. 4). The start of the movement is defined in the coordinate system xworld,yworld associated with the road (Fig. 4).

The route of the Car Vali electric robot»
Fig. 4. The route of the Car Vali electric robot»

Having tied this coordinate system to the front bridge of the robot at the beginning of the rotunda, we select the position in the coordinate system (x0,y0), which is rotated relative to the coordinate system, as the Start position xworld,yworld by an angle π2 (Fig.5).

Coordinate systems of the
Fig. 5. Coordinate systems of the "Car Vali" robot-electric vehicle

To form a trajectory, it is necessary to enter trajectory sections of a given length l at a certain angle step by step θ (Fig.5). To ensure that the robot moves at this angle, the angular speeds of rotation of the left ωland right ωr wheels of the electric vehicle should be controlled, ensuring the difference in linear speeds of the wheels. Vv=(ωlωr)rv, rpm, where rv – wheel radius. In this case, the linear speed of the electric vehicle Vv (the speed of the point 0v of the origin (xv,yv) will be the average value of the linear speeds of the left and right wheels (Fig.5).

The robot rotates by an angle of θ with a shoulder Bv (wheelbase width) relative to the axis of rotation passing through the corresponding wheel (Fig. 6).

Turning of the
Fig.6. Turning of the "Car Vali" electric robot

Thus, we can write the following system of equations for the i-th section:

Vv,i=ωv,iBv=(ωl,iωr,i)rv, (1)
ωv,i=(ωl,iωr,i)rvBv, (2)
θv,i=ωv,idt, (3)
θv,i=θv,i1+θv,i (4)

It follows from formula (4) that changes in the rotation angle θv,i at the i-th step (section) added to the rotation angle at the (i1)-th step leads to the rotation angle θv,i.

Changing the angle of rotation leads to a change in coordinates in the coordinate system (x0,y0):

x0,i=(Vv,idt)cos(θv,i), (5)
y0,i=(Vv,idt)sin(θv,i). (6)

The position of the robot in the (x0,y0) axes at the i-th step will be determined by the coordinates

x0,i=x0,i1+x0,i, (7)
y0,i=y0,i1+y0,i. (8)

Services

Schedule

Social networks

Facebook
YouTube
© 2006-2024 Інформація про сайт