Location via proxy:   [ UP ]  
[Report a bug]   [Manage cookies]                

Traction Control for a Rocker-Bogie Robot with Wheel-Ground Contact Angle Estimation

Lecture Notes in Computer Science, 2006
...Read more
The 19th Conference of Mechanical Engineering Network of Thailand 19-21 October 2005, Phuket, Thailand Traction Control for a Rocker-Bogie Robot with Wheel-Ground Contact Angle Estimation Viboon Sangveraphunsiri and Mongkol Thianwiboon Robotics and Automation Laboratory, Department of Mechanical Engineering Faculty of Engineering, Chulalongkorn University, Phayathai Rd. Prathumwan, Bangkok 10330, Thailand E-Mail: Viboon.s@eng.chula.ac.th and kieng@eng.chula.ac.th Abstract A method for kinematics modeling of a six-wheel Rocker-Bogie mobile robot is described in detail. The forward kinematics is derived by using wheel Jacobian matrices in conjunction with wheel-ground contact angle estimation. The inverse kinematics is to obtain the wheel velocities and steering angles from the desired forward velocity and turning rate of the robot. Traction Control is also developed to improve traction by comparing information from onboard sensors and wheel velocities to minimize wheel slip. Finally, simulation of a small robot using rocker-bogie suspension has been performed and simulate in two conditions of surfaces including climbing slope and travel over a ditch. Keywords: Rocker-Bogie Suspension / Traction Control / Slip Ratio 1. Introduction The effectiveness of a wheeled mobile robot has been proven by NASA by sending a semi-autonomous rover "Sojourner" landed on Martian surface in 1997 [1]. Future field mobile robots are expected to traverse much longer distance over more challenging terrain than Sojourner, and perform more difficult tasks. Other examples of rough terrain applications for robotic can be found in hazardous material handling applications, such as explosive ordnance disposal, search and rescue. Corresponding to such growing attention, the researches are varying from mechanical design, performance of the robot, control system, navigation systems, path planning, field test and so on. However, there are very few concerning dynamics of the robot. This is because the field robots are considered too slow to encounter dynamic effect. And the high mobility of the robot, moving in 3 dimensions with 6 degrees of freedom (X, Y, Z, pitch, yaw, roll), makes the kinematics modeling a challenging task than the robots which move on flat and smooth surface (3 degrees of freedom : X, Y, rotation about Z axis). In rough terrain, it is critical for mobile robots to maintain maximum traction. Wheel slip could cause the robot to lose control and trapped. Traction control for low-speed mobile robots on flat terrain has been studied by Reister and Unseren [2] using pseudo velocity to synchronize the motion of the wheels during rotation about a point. Sreenivasan and Wilcox [3] have considered the effects of terrain on traction control by assume knowledge of terrain geometry, soil characteristics and real-time measurements of wheel- ground contact forces. However, this information is usually unknown or difficult to obtain directly. Quasi- static force analysis and fuzzy logic algorithm have been proposed for a rocker-bogie robot [4]. Knowledge of terrain geometry is critical to the traction control. A method for estimating wheel-ground contact angles using only simple on-board sensors has been proposed [5]. A model of load-traction factor and slip-based traction model has been developed [6]. The traveling velocity of the robot is estimated by measure the PWM duty ratio driving the wheels. Angular velocities of the wheels are also measured then compare with estimated traveling velocity to estimate the slip and perform traction control loop. In this research work, the method to derive the wheel-ground contact angle estimation and kinematics modeling of a small six-wheel robot with Rocker - Bogie suspension are described. A traction control is proposed and integrated with the model then examined by simulation. 2. Rocker-Bogie Suspension In this research, the computer model of the robot named “Lonotech 10” is built. Its dimensions are 480x640x480 mm 3 , consists of six wheels, three on each side. Four steering mechanisms are equipped to the front and rear wheels. Figure 1. Lonotech 10 All independently actuated wheels are connected by the Rocker-Bogie suspension, a passive suspension that works well at low-velocity. This suspension consists of two rocker arms connected to the sides of the robot body. DRC010
At one end of each rocker is connected to pivot of the smaller rocker, the bogie, and the other end has a steerable wheel attached. Two wheels are attached to the end of these bogies. The rockers connected to the body via a differential link. This configuration maintains the pitch of the body equal to the average angle between the two rockers. This mechanism also provides an important mobility characteristic of the robot: one wheel can be lifted vertically while other wheels remain in contact with the ground. 3. Wheel-Ground Contact Angle Estimation To formulate kinematics modeling for the mobile robot, the wheel-ground contact angles must be known. But it is difficult to make a direct measurement of these angles, a method for estimating the contact angles based on [5] is implemented to the rocker-bogie suspension in this section. In kinematics modeling and contact angle estimation, we introduce the following assumptions. 1) Each wheel makes contact with the ground at a single point. 2) No side slip and rolling slip between a wheel and the ground. Consider the left bogie on uneven terrain, the bogie pitch, 1 μ , is defined with respect to the horizon. The wheel center velocities, 1 v and 2 v , are parallel to the wheel-ground tangent plane. The distance between the wheel centers is B L B L 1 μ 1 ρ 2 ρ 1 v 2 v Figure 2. The left bogie on uneven terrain The kinematics equations can be written as following 1 1 1 2 2 1 cos( ) cos( ) v v ρ μ ρ μ = (1) 1 1 1 2 2 1 1 sin( ) sin( ) B v v L ρ μ ρ μ μ = (2) Combining Equations (1) and (2): 1 1 2 1 1 1 2 1 sin[( ) ( )] ( / ) cos( ) B L v ρ μ ρ μ μ ρ μ = Define 1 1 1 / B a L v μ = , 1 2 1 / b v v = Contact angles of the wheel 1 and 2 are given by [ ] 1 2 1 2 1 1 1 2 / ) ( arcsin a b a + = μ ρ (3) [ ] 1 2 1 2 1 1 2 2 / ) 1 ( arcsin a b a + + = μ ρ (4) In order to compute the contact angle of the rear wheel, we need to know velocity of the bogie joint first. Define 1 B r : rotation radius of the left bogie 1 μ : angular velocity of the left bogie The velocity of the bogie joint can be written as: 1 1 1 μ B B r v = B L 1 μ 1 ρ 2 ρ 1 v 2 v λ d 2 A 1 A 1 B v 1 r 1 B r 2 r 1 B 1 C Figure 3. Instantaneous center of rotation of the left bogie where ) 90 cos( 2 1 2 2 2 2 2 1 λ μ ρ + + = d r d r r B 1 2 1 1 2 sin(90 ) / sin( ) B r L ρ μ ρ ρ = + 2 1 1 1 2 sin(90 ) / sin( ) B r L ρ μ ρ ρ = + Consider Left Rocker, the rocker pitch, 1 τ , is defined with respect to the horizon direction. The distance between rear wheel center and bogie joint is R L . 1 B v R L 1 τ 1 B ρ 3 ρ 3 v Figure 4. Left Rocker on an uneven terrain Contact angles of the wheel 3 is 1 1 3 3 1 arccos[( / ) cos( )] B B v v ρ ρ τ = (5) In the same way, we repeated these procedures with the right side: [ ] 2 2 2 2 2 2 4 2 / ) ( arcsin a b a + = μ ρ (6) [ ] 2 2 2 2 2 2 5 2 / ) 1 ( arcsin a b a + + = μ ρ (7) )] cos( ) / arccos[( 2 6 6 2 2 τ ρ ρ = B B v v (8) There are special cases that the contact angle cannot be estimated [5]. First occur when the robot is stationary. Pitch rates of the bogie and rocker cannot be computed. Then equations (3)-(5) do not yield a solution. Since a robot in a fixed configuration has an infinite set of contact angles. The second case occurs when the bogie is parallel to the surface and the front wheel encounter a vertical obstacle with respect to the surface. B L 1 μ 1 v 1 v 0 1 > μ 0 1 < μ Figure 5. Left Bogie where 0 cos 1 = ε However, by observation that 2 v is zero, equation (1) and (2) can be written as 1 1 1 cos( ) 0 v ρ μ = (9) DRC010
DRC010 The 19th Conference of Mechanical Engineering Network of Thailand 19-21 October 2005, Phuket, Thailand Traction Control for a Rocker-Bogie Robot with Wheel-Ground Contact Angle Estimation Viboon Sangveraphunsiri and Mongkol Thianwiboon Robotics and Automation Laboratory, Department of Mechanical Engineering Faculty of Engineering, Chulalongkorn University, Phayathai Rd. Prathumwan, Bangkok 10330, Thailand E-Mail: Viboon.s@eng.chula.ac.th and kieng@eng.chula.ac.th Abstract A method for kinematics modeling of a six-wheel Rocker-Bogie mobile robot is described in detail. The forward kinematics is derived by using wheel Jacobian matrices in conjunction with wheel-ground contact angle estimation. The inverse kinematics is to obtain the wheel velocities and steering angles from the desired forward velocity and turning rate of the robot. Traction Control is also developed to improve traction by comparing information from onboard sensors and wheel velocities to minimize wheel slip. Finally, simulation of a small robot using rocker-bogie suspension has been performed and simulate in two conditions of surfaces including climbing slope and travel over a ditch. Keywords: Rocker-Bogie Suspension / Traction Control / Slip Ratio 1. Introduction The effectiveness of a wheeled mobile robot has been proven by NASA by sending a semi-autonomous rover "Sojourner" landed on Martian surface in 1997 [1]. Future field mobile robots are expected to traverse much longer distance over more challenging terrain than Sojourner, and perform more difficult tasks. Other examples of rough terrain applications for robotic can be found in hazardous material handling applications, such as explosive ordnance disposal, search and rescue. Corresponding to such growing attention, the researches are varying from mechanical design, performance of the robot, control system, navigation systems, path planning, field test and so on. However, there are very few concerning dynamics of the robot. This is because the field robots are considered too slow to encounter dynamic effect. And the high mobility of the robot, moving in 3 dimensions with 6 degrees of freedom (X, Y, Z, pitch, yaw, roll), makes the kinematics modeling a challenging task than the robots which move on flat and smooth surface (3 degrees of freedom : X, Y, rotation about Z axis). In rough terrain, it is critical for mobile robots to maintain maximum traction. Wheel slip could cause the robot to lose control and trapped. Traction control for low-speed mobile robots on flat terrain has been studied by Reister and Unseren [2] using pseudo velocity to synchronize the motion of the wheels during rotation about a point. Sreenivasan and Wilcox [3] have considered the effects of terrain on traction control by assume knowledge of terrain geometry, soil characteristics and real-time measurements of wheelground contact forces. However, this information is usually unknown or difficult to obtain directly. Quasistatic force analysis and fuzzy logic algorithm have been proposed for a rocker-bogie robot [4]. Knowledge of terrain geometry is critical to the traction control. A method for estimating wheel-ground contact angles using only simple on-board sensors has been proposed [5]. A model of load-traction factor and slip-based traction model has been developed [6]. The traveling velocity of the robot is estimated by measure the PWM duty ratio driving the wheels. Angular velocities of the wheels are also measured then compare with estimated traveling velocity to estimate the slip and perform traction control loop. In this research work, the method to derive the wheel-ground contact angle estimation and kinematics modeling of a small six-wheel robot with Rocker - Bogie suspension are described. A traction control is proposed and integrated with the model then examined by simulation. 2. Rocker-Bogie Suspension In this research, the computer model of the robot named “Lonotech 10” is built. Its dimensions are 480x640x480 mm3, consists of six wheels, three on each side. Four steering mechanisms are equipped to the front and rear wheels. Figure 1. Lonotech 10 All independently actuated wheels are connected by the Rocker-Bogie suspension, a passive suspension that works well at low-velocity. This suspension consists of two rocker arms connected to the sides of the robot body. DRC010 At one end of each rocker is connected to pivot of the smaller rocker, the bogie, and the other end has a steerable wheel attached. Two wheels are attached to the end of these bogies. The rockers connected to the body via a differential link. This configuration maintains the pitch of the body equal to the average angle between the two rockers. This mechanism also provides an important mobility characteristic of the robot: one wheel can be lifted vertically while other wheels remain in contact with the ground. 3. Wheel-Ground Contact Angle Estimation To formulate kinematics modeling for the mobile robot, the wheel-ground contact angles must be known. But it is difficult to make a direct measurement of these angles, a method for estimating the contact angles based on [5] is implemented to the rocker-bogie suspension in this section. In kinematics modeling and contact angle estimation, we introduce the following assumptions. 1) Each wheel makes contact with the ground at a single point. 2) No side slip and rolling slip between a wheel and the ground. Consider the left bogie on uneven terrain, the bogie pitch, μ1 , is defined with respect to the horizon. The wheel center velocities, v1 and v2 , are parallel to the wheel-ground tangent plane. The distance between the wheel centers is LB v1 v2 LB μ1 r2 B1 v2 d ρ2 λ v1 ρ1 μ1 A1 LB A2 Figure 3. Instantaneous center of rotation of the left bogie where rB = r22 + d 2 − 2r2 d cos(90 + ρ 2 − μ1 − λ ) r1 = LB sin(90 + ρ 2 − μ1 ) / sin( ρ1 − ρ 2 ) r2 = LB sin(90 − ρ1 + μ1 ) / sin( ρ1 − ρ 2 ) Consider Left Rocker, the rocker pitch, τ 1 , is defined with respect to the horizon direction. The distance between rear wheel center and bogie joint is LR . 1 vB1 ρB 1 τ1 LR ρ3 v3 Figure 4. Left Rocker on an uneven terrain Contact angles of the wheel 3 is ρ3 = arccos[(vB1 / v3 ) cos( ρ B1 − τ 1 )] 2 Figure 2. The left bogie on uneven terrain as (1) (2) (5) (3) (7) (8) 2 There are special cases that the contact angle cannot be estimated [5]. First occur when the robot is stationary. Pitch rates of the bogie and rocker cannot be computed. Then equations (3)-(5) do not yield a solution. Since a robot in a fixed configuration has an infinite set of contact angles. The second case occurs when the bogie is parallel to the surface and the front wheel encounter a vertical obstacle with respect to the surface. v1 (4) In order to compute the contact angle of the rear wheel, we need to know velocity of the bogie joint first. Define rB1 ρ 5 = μ 2 + arcsin[(1 + a22 − b22 ) / 2a2 ] ρ 6 = arccos[( vB / v6 ) cos( ρ B − τ 2 )] ρ2 ρ 2 = μ1 + arcsin[(1 + a12 − b12 ) / 2a1 ] vB1 r1 In the same way, we repeated these procedures with the right side: ρ 4 = μ 2 + arcsin[(a22 − b22 ) / 2a2 ] (6) ρ1 The kinematics equations can be written following v1 cos( ρ1 − μ1 ) = v2 cos( ρ 2 − μ1 ) v1 sin( ρ1 − μ1 ) − v2 sin( ρ 2 − μ1 ) = LB μ1 Combining Equations (1) and (2): sin[( ρ1 − μ1 ) − ( ρ 2 − μ1 )] = ( LB μ1 / v1 ) cos( ρ 2 − μ1 ) Define a1 = LB μ1 / v1 , b1 = v2 / v1 Contact angles of the wheel 1 and 2 are given by ρ1 = μ1 + arcsin[(a12 − b12 ) / 2a1 ] C1 LB μ1 μ1 > 0 v1 μ1 < 0 Figure 5. Left Bogie where cos ε 1 = 0 rB1 : rotation radius of the left bogie μ1 : angular velocity of the left bogie The velocity of the bogie joint can be written as: v B1 = rB1 μ1 However, by observation that v2 is zero, equation (1) and (2) can be written as (9) v1 cos( ρ1 − μ1 ) = 0 DRC010 (10) v1 sin( ρ1 − μ1 ) = LB μ1 The variable ρ 2 is undefined since wheel 2 is stationary, and π ρ1 = μ1 + (11) sgn( μ1 ) 2 The last case occurs when ρ1 is equal to ρ 2 . The pitch rate μ1 is zero and ratio of v2 and v1 is unity. Then equations (3)-(5) have no solution. But it is easy to detect constant pitch rate from an inclinometer. If the bogie is on the flat terrain, the contact angles are equal to the pitch angle. In the case that pitch rate is zero temporary; we assume that the terrain profile varies slowly with respect to data sampling rate and use previously to estimate contact angle instead. By following the Denavit-Hartenburg notation [7], the transformation matrix for coordinate i to j can be written as follows: ⎡CΘ j − SΘ j Cα j SΘ j Sα j a j CΘ j ⎤ ⎢ SΘ CΘ j Cα j − CΘ j sα j a j SΘ j ⎥⎥ Tj ,i = ⎢ j ⎢ 0 Sα j Cα j dj ⎥ ⎥ ⎢ 0 0 1 ⎦ ⎣ 0 where Θ j , α j , a j and d j are the D-H parameters given for coordinate frame j . In this transformation, we have used the notation CΘ j = cos Θ j and SΘ j = sin Θ j , etc. The transformations from the robot reference frame ( O ) to the wheel axle frames ( Ai ) are obtained by cascading the individual transformations. For example, the transformations for wheel 1 are TO , A1 = TO ,D TD ,B1 TB1 ,S1 TS1 , A1 Figure 6. Left Bogie where μ1 = 0 and v2 =0 v1 4. Forward Kinematics We define coordinate frames as in Fig. 7 and 8. The subscripts for the coordinate frames are as follows: O : robot frame, D : differential joint, Bi : left and right bogie ( i = 1,2 ), S i : steering of left front, left rear, right front and right rear wheels ( i = 1,3,4,6 ) and Ai : Axle of all wheels ( i = 1− 6 ). Other quantities shown are steering angles ψ i ( i = 1,3,4,6 ), rocker angle β , left and right bogie angle γ 1 and γ 2 . 3 ZO XS 3 ψ3 l6 ZD l1 YO β l2 YD 1 ψ1 XS 1 YS 1 YB γ1 l5 1 XA ZA 3 XA ZA 2 XA 2 ZA 1 YA 1 2 3 YA 1 Figure 7. Left Coordinate frames YA 3 X Ci Φ X Ai YAi Wheel 4, 5, 6 Figure 9. Contact Coordinate Frame TAi ,Ci ZB 1 l5 YAi X Ai Wheel 1, 2, 3 3 l7 = l3 + l5 l8 l4 X B1 Z Ci X Ci Φ YS l3 ZS Z Ci The transformation matrices for contact frame are derived using Z-X-Y Euler angle ZS XD XO In order to capture the wheel motion, we need to derive two additional coordinate frames for each wheel, contact frame and motion frame. Contact frame is obtained by rotating the wheel axle frame ( Ai ) about the z-axis followed by a 90 degree rotation about the x-axis. The z-axis of the contact frame ( Ci ) points away from the contact point as shown in Fig. 7. ⎡ Cpi Cri − Spi Sqi Sri ⎢ −Cqi Spi =⎢ ⎢Cri Spi Sqi + Cpi Cri ⎢ 0 ⎣ Cri Spi + Cpi Sqi Sri −Cqi Sri Cpi Cqi −Cpi Cri Sqi + Spi Sri Sqi Cqi Cri 0 0 0⎤ 0 ⎥⎥ 0⎥ ⎥ 1⎦ where pi , qi and ri are rotation angle about X, Y and Z respectively. Cpi = cos pi and Spi = sin pi , etc. The wheel motion frame is obtained by translating along the negative z-axis by wheel radius ( Rw ) and translating along the x-axis for wheel roll ( Rwθ i ) Z Ci ZS ZO 6 YS XS l7 = l3 + l5 β 6 l6 ψ6 X Ci XD XO 6 l2 Z Mi YD l3 l8 l5 YA ZB 6 ZA ZD YO l1 2 γ2 ZS YB 2 X B2 l4 l5 X A6 YA 6 X Mi 4 YS ψ4 4 5 YA X A5 4 ZA 4 Figure 10. Wheel Motion Frame X S4 5 ZA θi X A4 Figure 8. Right Coordinate frames The transformation matrices for all wheels can be written as follows: DRC010 TO , M1 = TO , D TD , B1 TB1 , S1 TS1 , A1 TA1 ,C1 TC1 , M1 TO , M 2 = TO , D TD , B1 TB1 , A2 TA2 ,C2 TC2 , M 2 TO , M 3 = TO , D TD , S3 TS3 , A3 TA3 ,C3 TC3 , M 3 The parameters Ai to K i in the matrices above can be easily derived in terms of wheel-ground contact angle ( ρ1 ,.., ρ 6 ) and joint angle ( β , γ , and ψ ) . For example, TO , M 4 = TO , D TD , B2 TB2 , S4 TS4 , A4 TA4 ,C4 TC4 , M 4 the parameter A1 of the front left wheel is TO , M 6 = TO , D TD , S6 TS6 , A6 TA6 ,C6 TC6 , M 6 + Sρ1 Sψ 1 ( 200 − 400Cρ1 Sρ1 + 200C 2 ρ1 S 2 ρ1 )] TO , M 5 = TO , D TD , B2 TB2 , A5 TA5 ,C5 TC5 , M 5 In order to obtain the wheel Jacobian matrices, the motion of the robot is express in the wheel motion frame, by applying the transformation T Oˆ ,O = TOˆ ,Mˆ T M ,O and can i i be written in the following form as ⎡ 0 − φ p x ⎤ ⎢  ⎥ φ 0 − r y ⎥ ⎢  TOˆ ,O = (12) ⎢− p r 0 z ⎥ ⎥ ⎢ 0 0 1 ⎦⎥ ⎣⎢ 0 where φ = yaw angle of the robot p = pitch angle of the robot r = roll angle of the robot Once the instantaneous transformations are obtained, we can extract a set of equations relating the robot’s motion in vector form [ x y z φ p r]T to the joint angular rates. The results of the left and right front wheel are found to be ⎡ x ⎤ ⎡ Ai 0 Bi Ci ⎤ ⎢ y ⎥ ⎢ D 0 E F ⎥ ⎡  ⎤ i i ⎥ θi ⎢ ⎥ ⎢ i ⎢ ⎥ ⎢ z ⎥ ⎢ Gi 0 H i I i ⎥ ⎢ β ⎥ i = 1,4 (13) ⎥⎢ ⎥ ⎢ ⎥ = ⎢ ⎢ φ ⎥ ⎢ 0 0 0 J i ⎥ ⎢ γi ⎥ ⎢ p ⎥ ⎢ 0 −1 −1 0 ⎥ ⎢ψ ⎥ ⎥⎣ i⎦ ⎢ ⎥ ⎢  K 0 0 0 r ⎥ i⎦ ⎣⎢ ⎦⎥ ⎣⎢ The results of wheel 2 and 5 (the left and right middle wheel) are found to be ⎡ x ⎤ ⎡ Ai 0 Bi ⎤ ⎢ y ⎥ ⎢C 0 ⎥⎥  ⎢ ⎥ ⎢ i 0 ⎡θ ⎤ ⎢ z ⎥ ⎢ Di 0 Ei ⎥ ⎢ i ⎥ i = 2,5 (14) ⎥ β ⎢ ⎥ = ⎢ 0 ⎥ ⎢⎢ ⎥⎥ ⎢φ ⎥ ⎢ 0 0 i γ ⎢ p ⎥ ⎢ 0 − 1 − 1⎥ ⎣ ⎦ ⎥ ⎢ ⎥ ⎢ 0 ⎥⎦ ⎢⎣ r ⎥⎦ ⎢⎣ 0 0 The results of wheel 3 and 6 (the left and right back wheel) are found to be ⎡ x ⎤ ⎡ Ai 0 Bi ⎤ ⎥ ⎢ y ⎥ ⎢C ⎢ ⎥ ⎢ i 0 Di ⎥ ⎡θ ⎤ ⎢ z ⎥ ⎢ Ei 0 Fi ⎥ ⎢ i ⎥ i = 3, 6 (15) ⎥ ⎢ β ⎥ ⎢ ⎥ = ⎢ ⎢φ ⎥ ⎢ 0 0 Gi ⎥ ⎢ψ ⎥ ⎢ p ⎥ ⎢ 0 − 1 0 ⎥ ⎣ i ⎦ ⎥ ⎢ ⎥ ⎢ ⎣⎢ r ⎦⎥ ⎣⎢ 0 0 H i ⎦⎥ where θ is the angular velocity of the wheel, β is the rocker pitch rate, γ is the bogie pitch rate and ψ is the steering rate of the steerable wheel. A1 = 1 [C ( β + γ 1 ) Cρ1 (Cψ 1 − Sψ 1 ) (−2 + S (2 ρ1 )) 2 We will see that the 5th equation (5th row) does not contribute to any unknowns. It simply states that the change in pitch is equal to the change in the bogie and rocker angles. With the help of an installed inclinometer , p can be sensed without knowledge of the rocker and bogie angles. Since only the p , in equation (13) to (15), contains γ and β , we can remove these for further consideration. 5. Inverse Kinematics The purpose of inverse kinematics is to determine the individual wheel rolling velocities which will accomplish desired robot motion. The desired robot motion is given by forward velocity and turning rate. In this section, we will develop all 6 wheels rolling velocities with geometric approach to determine steering angle of steerable wheels. 5.1 Wheel Rolling Velocities Consider forward kinematics of the front wheel (12), define the desired forward velocity is x d and desired heading angular rate is φ . The first and the d fourth equation give x d = Aiθi + Biγi + Ciψ i φ = J ψ d i i = 1,3 (16) i The rolling velocities of the front wheels can be written as C θi = ( x d − Bi γi − i φd ) / Ai i = 1,3 (17) Ji Similarly, the rolling velocities of the middle wheels can be written as (18) θi = ( x d − Bi γi ) / Ai i = 2,5 Finally the rolling velocities of the back wheels can be written as B i = 3, 6 θi = ( x d − i φd ) / Ai (19) Gi 5.2 Steering Angles Center of rotation is estimated based on two nonsteerable middle wheels. This turning center will be used to determine the steering angles of the four corner wheels. From Fig. 7 and 8, we can derive coordinate of the wheel centers respect to the robot reference frame as follows: DRC010 xC1 = l2 cos β + l3 sin β + l4 cos( β − γ 1 ) + l5 sin( β − γ 1 ) xC 2 = l2 cos β + l3 sin β − l8 cos( β − γ 1 ) + l5 sin( β − γ 1 ) xC 3 = −l6 cos β + (l3 + l5 ) sin β xC 4 = l2 cos(− β ) − l3 sin(− β ) + l4 cos(− β + γ 2 ) + l5 sin(− β + γ 2 ) xC 5 = l2 cos(− β ) − l3 sin(− β ) − l8 cos(− β + γ 2 ) + l8 sin(− β + γ 2 ) xC 6 = −l6 cos(− β ) − (l3 + l5 ) sin β S is positive when the robot is accelerating and negative when decelerating. From the slip ratio, a robot can travel stably when the slip ratio is around 0 and will be stuck when the ratio is around 1. To gain maximum traction, we must keep the slip ratio at a small as possible. Figure 12. Robot Control Schematic Figure 11. Instantaneous Center of Rotation From Fig. 11, the instantaneous center of rotation can be estimated by average the x position of the middle wheels. The distance in Z axis is neglected because there is only 1 degree of freedom per each steering. If the wheel’s axis is steered to intersect with the center of rotation on the X axis, the angle in Z direction is coupled and cannot be controlled. Using the estimated center of rotation, the desired steering angle for each steerable wheel can be determined. Define R is a turning radius, x R is the distance in X-direction of the center of rotation with respect to the robot reference frame. l1 is the distance from the robot reference frame to steering joint in Ydirection (see figure 7 and 8). The desired steering angles are for wheel 1 ψ 1 = arctan [ ( xC1 − xR ) /( R − l1 ) ] ψ 3 = arctan [ ( xC 3 − xR ) /( R − l1 ) ] ψ 4 = arctan [ ( xC 4 − xR ) /( R + l1 ) ] ψ 6 = arctan [ ( xC 6 − xR ) /( R + l1 ) ] for wheel 3 for wheel 4 for wheel 6 6. Traction Control In section 4 and 5, we assume that there is no side slip and rolling slip between wheel and ground. Then slip must be minimizing to guarantee accuracy of the kinematics model. The slip ratio S , of each wheel is defined as follows [6]: ⎧(rθ − vw ) / rθw (rθw > vw : accelerating ) (30) S =⎨ w  (rθw < vw : decelerating ) ⎩ ( rθ w − v w ) / v w where r = radius of the wheel θ w = rotating angle of the wheel rθ = wheel circumference velocity w vw = traveling velocity of the wheel By measuring of the wheel angles with information from the accelerometer, we can minimize slip so that the traction of the robot is improved. The control problem is to control the slip S to a desired set point S d that is either constant or commanded from a higher-level control system. The feedback value Ŝ is computed from a slip estimator. To complete the estimation of the slip, we need the rolling velocity and the traveling velocity of the wheels, ω and v w . Rolling velocity of the wheels is easily obtained from encoders which installed in all wheels. Traveling velocity of the wheel can be computed from robot velocity by using data from onboard accelerometer. The robot velocity can be obtained by integrating the accelerometer signal. Then use this value as an input to the inverse kinematics to compute the rolling velocities of all wheels. Then multiply by wheel radius, we can obtain the traveling velocity of the wheels. 7. Experiment The traction control system was verified by simulation on Visual Nastran 4D. In Fig. 12, the robot climbs up a 30-degree slope, with coefficient of friction about 0.5. Figure 13. Robot climbing up a slope As a result, in case without control, the robot was running at 55 mm/s, then the front wheels touched the slope at t = 0.5 sec. and begin to climb up. Robot velocity measured in reduced to 25 mm/s. But the robot can continue to climb until the middle wheels touch the slope at t = 9 sec. The velocity reduced to nearly zero. DRC010 ditch. The robot velocity also increased temporary and back to 55 mm/s again when the middle wheels went up completely. The last two wheels went down the ditch at t = 13 sec. and the sequence was repeated in the same way as front and middle wheels. 55 Robot Velocity (mm/s) 45 35 25 200 15 5 150 0 2 4 6 8 10 12 14 16 -15 w/o traction control time (s) traction control 1.2 Robot Velocity (mm/s) -5 100 50 1 0 0 2 4 6 8 10 12 14 16 0.8 Slip Ratio -50 0.6 w/o traction control time (s) traction control 0.4 1.5 w/o traction Control 0.2 1 0 2 4 6 8 10 12 14 16 0.5 time (s) w/o traction control traction control Figure 14. Velocity and Slip ratio when climbing up 30 degrees slope Slip Ratio 0 -0.2 0 0 -0.5 In case with control, the sequence was almost the same until t = 0.5 sec. The velocity reduced to approximately 35 mm/s when the front wheels touched the slope. At t = 6 sec., the middle wheels touched the slope and velocity reduced to about 28 mm/s. And both rear wheels begin to climb up the slope at t = 15 sec. with velocity approximately 20m/s. Figure 15. Traversing over a ditch In Fig. 15, the robot traversed over a ditch, which has 32 mm depth and 73 mm width with coefficient of friction about 0.5. The robot was commanded to move at 55 mm/s, and then the front wheels went down the ditch at t = 0.5 sec. The velocity of the robot increased temporary and begin to climb up when front wheels touch the up-edge of the ditch. But the wheels slipped with the ground and failed to climb up. Then the slip ratio went up to 1 ( S = 1 ), the robot has stuck and the velocity decreased about zero at t = 1.5 sec. With traction control, after the front wheels went down the ditch, the slip ratio was increased. Then the controller tried to decelerate to decrease the slip ratio. When the slip ratio was around 0.5, the robot continued to climb up. Until t = 4.5 sec., both of the front wheels went up the ditch completely and the robot velocity increased to the 55 mm/s as commanded. At t = 6 sec., the middle wheels went down the 2 4 6 8 10 12 14 16 Traction Control -1 w/o traction control time (s) traction control Figure 16. Velocity and Slip ratio when traversing over a ditch 7. Conclusion In this research, the wheel-ground contact angle estimation has been presented and integrated into a kinematics modeling. Unlike the available methods that applicable to the robots operating on flat and smooth terrain, the proposed method uses the Denavit-Hartenburg notation like a serial link robot, due to the rocker-bogie suspension characteristics. The steering angle is estimated by using geometric approach. A traction controller is proposed based on the slip ratio. The slip ratio is estimated from wheel rolling velocities and the robot velocity. The traction control strategy is to minimize this slip ratio. So the robot can traverse over obstacle without being stuck. The traction control strategy is verified in the simulation with two conditions. Climbing up the slope and moving over a ditch with coefficient of friction 0.5. The robot velocity and slip ratio are compared between using traction control and without using traction control system. References [1] JPL Mars Pathfinder. February 2003. Available from: http://mars.jpl.nasa.gov/MPF [2] D.B.Reister, and M.A.Unseren, “Position and Constraint force Control of a Vehicle with Two or More Steerable Drive Wheels”, IEEE Transaction on DRC010 Robotics and Automation, page 723-731, Volume 9, 1993. [3] S.Sreenivasan, and B.Wilcox, “Stability and Traction control of an Actively Actuated Micro-Rover”, Journal of Robotic Systems, 1994. [4] H.Hacot, “Analysis and Traction Control of a RockerBogie Planetary Rover”, M.S. Thesis, Massachusetts Institute of Technology, Cambridge, MA, 1998. [5] K.Iagnemma, and S.Dubowsky, “Mobile Robot Rough-Terrain Control (RTC) for Planetary Exploration”, Proceedings of the 26th ASME Biennial Mechanisms and Robotics Conference, Baltimore, Maryland, 2000. [6] K.Yoshida, H.Hamano: Motion Dynamics of a Rover with Slip-Based Traction Model, Proceeding of 2002 IEEE International Conference on Robotics and Automation (2002) [7] John J. Craig, “Introduction to Robotics Mechanics and Control”, Second Edition, Addison-Wesley Publishing Company, 1989. [8] M.Thianwiboon, V.Sangveraphunsiri, and R.Chancharoen, “Rocker-Bogie Suspension Performance”, Proceeding of the 11th International Pacific Conference on Automotive Engineering, 2001.
Keep reading this paper — and 50 million others — with a free Academia account
Used by leading Academics
BORA YILDIRIM
Hacettepe University
Mikail F Lumentut
National Taiwan University
mahmoud hafiz
Al-Azhar University
Mahmoud Farag
American University in Cairo