SLIDE 24 24
23-nov.-14 47
The turn of most vehicles usually follows a pattern known as coordinated turn (CT), characterized by a (nearly) constant turn rate and a (nearly) constant speed. Assuming the turn is taking place in an horizontal plane (2D), a CT is a turn with a constant yaw rate along a road of constant radius of curvature. However, the curvatures of actual roads are not constant. Hence, a fairly small noise is added to a constant-speed turn model for the purpose of capturing the variation of the road
- curvature. The noise in this model represents the modeling error, such as the
presence of angular acceleration and non-constant radius of curvature. For a vehicle turning with a constant angular rate and moving with constant speed (the magnitude
- f the velocity vector is constant), the kinematic equations for the longitudinal and
tangential acceleration in the (x,y) plane are,
Kinematic model for coordinated turn
( ) ( ), ( ) ( ) x n y n y n x n
Where represents the yaw rate (also called the turn rate or the angular rate). Note: ω > 0 implies a counter-clockwise turn). The tangential component of the acceleration is equal to the rate of change of the speed, that is, and the normal component is defined as the square of the speed in the tangential direction divided by the radius of the curvature of the path, that is,
( ) ( ) ( 1) / ( ) ( 1) / y n y n y n T x n x n T
2 2
( ) ( ) / ( ) ( ), ( ) ( ) x n y n x n x n with y n x n
Modeling dynamics D Gingras – ME470 IV course CalPoly Week 2 23-nov.-14 48
Kinematic model for coordinated turn
Note that the noise vector here is 3D, the first two for modeling the longitudinal acceleration, whereas the 3rd one for the angular acceleration.
2 2
1 ( ) 1 sin ( ) / ( ) (1 cos ( ) ) / ( ) 2 ( ) cos ( ) sin ( ) ( ) ( 1) ( ) (1 cos ( ) ) / ( ) 1 sin ( ) / ( ) 1 2 ( ) sin ( ) cos ( ) 1 T x n n T n n T n x n n T n T T X n X n y n n T n n T n T y n n T n T T T ( 1) n
( ) ( ) ( ) ( ) ( ) ( )
T
X n x n x n y n y n n
Assuming the angular speed to be piecewise constant during the turn, the state equations become,
Modeling dynamics D Gingras – ME470 IV course CalPoly Week 2