Next Article in Journal
Routing and Scheduling Algorithms for WirelessHARTNetworks: A Survey
Previous Article in Journal
Optical Fiber Nanotips Coated with Molecular Beacons for DNA Detection
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Analysis and Experimental Kinematics of a Skid-Steering Wheeled Robot Based on a Laser Scanner Sensor

Robotics Institute, Beihang University, Beijing 100191, China
*
Author to whom correspondence should be addressed.
Sensors 2015, 15(5), 9681-9702; https://doi.org/10.3390/s150509681
Submission received: 11 February 2015 / Revised: 8 April 2015 / Accepted: 17 April 2015 / Published: 24 April 2015
(This article belongs to the Section Physical Sensors)

Abstract

:
Skid-steering mobile robots are widely used because of their simple mechanism and robustness. However, due to the complex wheel-ground interactions and the kinematic constraints, it is a challenge to understand the kinematics and dynamics of such a robotic platform. In this paper, we develop an analysis and experimental kinematic scheme for a skid-steering wheeled vehicle based-on a laser scanner sensor. The kinematics model is established based on the boundedness of the instantaneous centers of rotation (ICR) of treads on the 2D motion plane. The kinematic parameters (the ICR coefficient χ , the path curvature variable λ and robot speed v ), including the effect of vehicle dynamics, are introduced to describe the kinematics model. Then, an exact but costly dynamic model is used and the simulation of this model’s stationary response for the vehicle shows a qualitative relationship for the specified parameters χ and λ . Moreover, the parameters of the kinematic model are determined based-on a laser scanner localization experimental analysis method with a skid-steering robotic platform, Pioneer P3-AT. The relationship between the ICR coefficient χ and two physical factors is studied, i.e., the radius of the path curvature λ and the robot speed v . An empirical function-based relationship between the ICR coefficient of the robot and the path parameters is derived. To validate the obtained results, it is empirically demonstrated that the proposed kinematics model significantly improves the dead-reckoning performance of this skid–steering robot.

1. Introduction

Skid-steering motion is widely used for wheeled and tracked mobile robots [1]. Steering in this way is based on controlling the relative velocities of the left and right side drives. The robot turning requires slippage of the wheels for wheeled vehicles. Due to their identical steering mechanisms, wheeled and tracked skid-steering vehicles share many properties [2,3].
Like differential steering, skid steering leads to high maneuverability [4,5], and has a simple and robust mechanical structure, leaving more room in the vehicle for the mission equipment [3,6]. In addition, it has good mobility on a variety of terrains, which makes it suitable for all-terrain missions.
However, this locomotion scheme makes it difficult to develop kinematic and dynamic models that can accurately describe the motion. It is very difficult for the skid-steering kinematics to predict the exact motion of the vehicle only from its control inputs. As a result, the kinematics models with pure rolling and no-slip assumptions for non-holonomic wheeled vehicles cannot apply in this case [2]. Furthermore, other disadvantages are that the motion tends to be energy inefficient, difficult to control, and for wheeled vehicles, the tires tend to wear out faster [6,7].
Some previous studies have discussed the dynamic control of skid-steering mobile robots. A dynamic model was presented for a skid-steering four-wheel robot and a non-holonomic constraint between the robot’s lateral velocity and yaw rate was considered in [5]. A perfect wheel-ground interaction was assumed. A simple Coulomb friction model was used to capture the wheel-ground interaction and a nonlinear feedback controller was designed to track the desired path [6]. Yu and Ylaya Chuy developed a skid-steering mobile robot dynamic model for general 2D motion and linear 3D motion [8,9]. This model was based on the functional relationship of shear stress to shear displacement, which is different from the previous Coulomb-friction-based model [5,6]. It needs a lot of computational effort to calculate a complex dynamics model in real-time, for example, this work requires a number of integral operations, so the dynamic models for skid-steering may result too costly for real-time motion control and dead-reckoning.
In the meantime, Maalouf et al. [10] and Kozlowski [11] separately considered the kinematics for the relation between drive velocities and vehicle velocities without concerning themselves with major skid effects. As we know, wheel slip plays a critical role in the kinematic and dynamic modeling of skid-steering mobile robots. The slip information provides a connection between the wheel rotation velocity and the linear motion of the robot platform. With an extended Kalman filter, the slip estimation was performed from actual inertial readings and a kinematics model of the vehicle relates the slip parameters to the track velocities [12]. Furthermore, an experimental method was developed to determine the slip ratios. The slip coefficients of tracks were modeled as an exponential function of path radius [13].
An extra trailer was designed to study the kinematic relationship for simultaneous localization and mapping (SLAM) applications. It was concluded that an ideal differential-driven kinematics model for wheeled robot cannot be used for skid-steering robots [14,15]. Meanwhile, geometric analogy with an ideal differential-driven wheeled mobile robot was studied [2,7]. Experimental validations have been conducted for both tracked vehicles and skid-steering mobile robots. These correspond to the position of ideal differential drive wheels for a particular terrain. This is based on the fact that tread ICR values are dynamics-dependent, but they lie within a bounded area at moderate speeds. A group of constant kinematic parameters were derived as optimized values for the tread ICR on the plane. Specifically, we find that tread ICR values vary with the speed of the robot and the path curvature, so it is necessary to further describe the relationship between tread ICR values and curvature of the path and the vehicle speed.
Building upon the research by Mandow [2] and Moosavian [13], we develop an experimental kinematics model for a skid-steering mobile robot. The kinematics model based on ICR of both treads on the motion plane is used [2], and we consider that tread ICR values change with the speed of the robot and the path curvature by explicitly considering slip ratio [13]. A dynamic model based on the research by Yu [8,9] and Wong [16,17] is developed for a simulation in order to estimate a potential kinematics relationship. Because a laser scanner is accurate and efficient for mobile robot localization and dead-reckoning [18,19], with a laser-scanner-based experimental method, an approximating function is derived to describe the relationship between the ICR values of the robot and the radius of curvature of the path and speed of the robot.
The main contribution in this paper is that the new analysis and experimental kinematic scheme of the skid-steering robot reveal the underlying kinematic relationship between the ICR coefficient of the robot and the path parameters. The simulation based on a dynamic model analysis shows a qualitative relationship among the parameters theoretically specified before the experiment. An empirical function relationship between the ICR values of the robot and the path parameters is derived with this laser-scanner-based experimental method. Dead-reckoning performance shows that the empirical function kinematics model improves the motion estimation accuracy significantly. This laser-scanner-based method is easy to operate and does not add extra sensors or change the vehicle mechanical structure and control system. The proposed model and analysis approach can be further used for robot control, as an exact kinematics control can be used for a skid-steering robot [13].
The remainder of this paper is organized as follows: Section 2 presents the kinematic and dynamic modeling of a four-wheel skid-steering mobile robot. A dynamic model based simulation to explain the potential kinematics relationship is proposed. In Section 3 the laser-scanner-based localization method is presented and the experiment results and analyses are given.

2. Model Analysis and Simulation

2.1. Kinematical Analogy of Skid-Steering with Differential Drive

Figure 1 shows the kinematics schematic of a skid-steering robot. We consider the following model assumptions:
(1)
the mass center of the robot is located at the geometric center of the body frame;
(2)
the two wheels of each side rotate at the same speed;
(3)
the robot is running on a firm ground surface, and four wheels are always in contact with the ground surface.
Figure 1. The kinematics schematic of skid-steering mobile robot.
Figure 1. The kinematics schematic of skid-steering mobile robot.
Sensors 15 09681 g001
We define an inertial frame ( X , Y ) (global frame) and a local (robot body) frame ( x , y ) , as shown in Figure 1. Suppose that the robot moves on a plane with a linear velocity expressed in the local frame as v = ( v x , v y , 0 ) T and rotates with an angular velocity vector ω = ( 0 , 0 , ω z ) T . If q = ( X , Y , θ ) T is the state vector describing generalized coordinate of the robot (i.e., the COM position, X and Y, and the orientation θ of the local coordinate frame with respect to the inertial frame), then q ˙ = ( X ˙ , Y ˙ , θ ˙ ) T denotes the vector of generalized velocities. It is straightforward to calculate the relationship of the robot velocities in both frames as follows [6]:
[ X ˙ Y ˙ θ ˙ ] = [ c o s θ s i n θ 0 s i n θ c o s θ 0 0 0 1 ] [ v x v y ω z ]
Let ω i , i = 1,2,3,4 denote the wheel angular velocities for front-left, rear-left, front-right and rear-right wheels, respectively. From assumption (2), we have:
ω L = ω 1 = ω 2 ,     ω R = ω 3 = ω 4
Then the direct kinematics on the plane can be stated as follows:
[ v x v y ω z ] = f [ ω l r ω r r ]
where v = ( v x , v y ) is the vehicle’s translational velocity with respect to its local frame, and ω z is its angular velocity, r is the radius of the wheel.
When the mobile robot moves, we denote instantaneous centers of rotation (ICR) of the left-side tread, right-side tread, and the robot body as I C R l , I C R r and I C R G , respectively. It is known that I C R l , I C R r and I C R G lie on a line parallel to the x-axis [7,16]. We define the x-y coordinates for I C R l , I C R r and I C R G as ( x l , y l ) ,   ( x r , y r ) , and ( x G , y G ) , respectively.
Note that treads have the same angular velocity ω z as the robot body. We can get the geometrical relation:
y G = v x ω z
y l = v x ω l r ω z
y r = v x ω r r ω z
x G = x l = x r = v y ω z
From Equations (4)–(7), the kinematics relation (3) can be represented as:
[ v x v y ω z ] = J ω [ ω l r ω r r ]
Where the elements of matrix J ω depend on the tread ICR coordinates:
J ω = 1 y l y r [ y r y l x G x G 1 1 ]
If the mobile robot is symmetrical, we can get a symmetrical kinematics model (i.e., the ICRs lie symmetrically on the x-axis and x G   = 0), so matrix J ω can be written as the following form:
J ω = 1 2 y 0 [ y 0 y 0 0 0 1 1 ]
where y 0 = y l = y r is the instantaneous tread ICR value. Noted that v l = ω l r ,       v r = ω r r , for the symmetrical model, the following equations can be obtained:
{ v x = ω l r + ω r r 2 = v l + v r 2 v y = 0 ω z = ω l r + ω r r 2 y 0 = v l + v r 2 y 0
Noted v y = 0 , so that v G = v x . We can get the instantaneous radius of the path curvature:
R = v G ω z = v G ω z = v l + v r v l + v r y 0
A non-dimensional path curvature variable λ is introduced as the ratio of sum and difference of left- and right-side’s wheel linear velocities [1], namely:
λ = v l + v r v l + v r  
and we can rewrite Equation (12) as:
R = v l + v r v l + v r y 0 = λ y 0
We use a similar index as in Mandow’s work [2,7], then an ICR coefficient χ can be defined as:
χ   = y l y r B = 2 y 0 B ,     χ 1
where   B denotes the lateral wheel bases, as illustrated in Figure 1. The ICR coefficient χ is equal to 1 when no slippage occurs (ideal differential drive). Note that the locomotion system introduces a non-holonomic restriction in the motion plane because the non-square matrix J ω has no inverse.
It is noted that the above expressions also present the kinematics for ideal wheeled differential drive vehicles, as illustrated in Figure 2. Therefore, for instantaneous motion, kinematic equivalences can be considered between skid-steering and ideal wheel vehicles. The difference between both traction schemes is that whereas the ICR values for single ideal wheels are constant and coincident with the ground contact points, tread ICR values are dynamics-dependent and always lie outside of the tread centerlines because of slippage, so we can know that less slippage results in that tread ICRs are closer to the vehicle.
Figure 2. Geometric equivalence between the wheeled skid-steering robot and the ideal differential drive robot.
Figure 2. Geometric equivalence between the wheeled skid-steering robot and the ideal differential drive robot.
Sensors 15 09681 g002
The major consequence of the study above is that the effect of vehicle dynamics is introduced in the kinematics model. Although the model does not consider the direct forces, it provides an accurate model of the underlying dynamics using lump parameters: I C R l and I C R r . Furthermore, from assumptions (1) and (3), we get a symmetrical kinematics model, and an ICR coefficient χ from Equation (15) is defined to describe the model. The relationship between ICR coefficient and the vehicle motion path and velocity will be studied.

2.2. Dynamic Model for Kinematics Parameters Relationship

2.2.1. Skid-Steering Mobile Robot Dynamic Model

In Section 2.1, the effect of vehicle dynamics is introduced in the kinematics model. This section develops dynamic models of a skid-steering wheeled vehicle for the cases of 2D motion. Using the dynamic models, the relationship between the ICR coefficients and the path and velocity of the vehicle motion will be studied in a simulation.
In contrast to dynamic models described in terms of the velocity vector of the vehicle [4], the dynamic models here are described in terms of the angular velocity vector of the wheels. This is because the wheel velocities are actually commanded by the control system, so this model form is particularly beneficial for motion simulation.
Figure 3. Forces and moments acting on a wheeled skid-steering vehicle during a steady state turn.
Figure 3. Forces and moments acting on a wheeled skid-steering vehicle during a steady state turn.
Sensors 15 09681 g003
As in Figure 3, following Wong’s model [16], the dynamic model is given by:
{ F x f r + F x r r + F x f l + F x r l R x m v G 2 R s i n β = 0 F y f r + F y r r + F y f l + F y r l = m v G 2 R c o s β M d M r = 0
where v G is the vehicle velocity, and β is the angle between the vehicle velocity and x-axis on the local frame. F x f r ,   F x r r ,   F x f l ,   F x r l are the longitudinal (friction) forces and F y f r ,   F y r r ,   F y f l ,   F y r l are the lateral forces. R f r ,   R r r ,   R f l ,   R r l are external motion resistances on the four wheels.   M d is the drive moment and   M r is the resistance moment.
Based on the wheel-ground interaction theory [16,17], the shear stress τ s s   and shear displacement j relationship can be described as:
    τ s s   = p μ ( 1 e j K )
where p is the normal pressure, μ is the coefficient of friction and K is the shear deformation modulus.
Figure 4 depicts a skid-steering wheeled vehicle moving counterclockwise (CCW) at constant linear velocity v and angular velocity ϕ ˙ in a circle centered at O from position (1) to position (2). The four contact patches of the wheels with the ground are shadows in Figure 4. L and C are the patch-related distances. In the inertial X-Y frame, we define that j f r ,   j r r ,   j f l ,   j r l and γ f r ,   γ r r ,   γ f l ,   γ r l are respectively the shear displacements and sliding velocity angle (opposite direction of sliding velocity). The readers can refer to Yu’s work [9] for a detailed analysis. The longitudinal sliding friction and lateral force of the four wheels can be expressed as follows:
{ F x f r = C / 2 L / 2 b / 2 b / 2 p r μ r ( 1 e j f r K r ) s i n ( π + γ f r ) d x r d y r F y f r = C / 2 L / 2 b / 2 b / 2 p r μ r ( 1 e j f r K r ) c o s ( π + γ f r ) d x r d y r ,
{ F x r r = L / 2 C / 2 b / 2 b / 2 p r μ r ( 1 e j r r K r ) s i n ( π + γ r r ) d x r d y r F y r r = C / 2 L / 2 b / 2 b / 2 p r μ r ( 1 e j r r K r ) c o s ( π + γ r r ) d x r d y r ,
{ F x f l = C / 2 L / 2 b / 2 b / 2 p l μ l ( 1 e j f l K l ) s i n ( π + γ f l ) d x l d y l F y f l = C / 2 L / 2 b / 2 b / 2 p l μ l ( 1 e j f l K l ) c o s ( π + γ f l ) d x l d y l ,
{ F x r l = L / 2 C / 2 b / 2 b / 2 p l μ l ( 1 e j r l K r ) s i n ( π + γ r l ) d x l d y l F y r l = L / 2 C / 2 b / 2 b / 2 p l μ l ( 1 e j r l K r ) c o s ( π + γ r l ) d x l d y l ,
where p l , μ l and K l are respectively the normal pressure, coefficient of friction, and shear deformation modulus of the left wheels, and p r , μ r and K r are the ones of the right wheels, respectively. With the other parameters directly measured or given, such as mass of vehicle, m, patch-related distances, L and C, width of wheel, b, p l and p r can be determined by m g / 2 ( L C ) b when a uniform normal pressure distributions assumption used ( p l = p r ). We share some parameters: μ l ,     μ r , K l and K r as in Yu’s research [9], because the same platform (Pioneer P3-AT robot) and similar lab surface are used for the simulation.
Figure 4. Motion of the skid-steering mobile robot wheel element on the lab surface (firm ground) from position (1) to (2).
Figure 4. Motion of the skid-steering mobile robot wheel element on the lab surface (firm ground) from position (1) to (2).
Sensors 15 09681 g004
In Equation (16), the rolling resistance is denoted as μ r o l l . We can obtain the resistance force, such that:
R x = m g μ r o l l

2.2.2. Dynamic Simulation

This section describes the dynamic simulation that has been used to get the relationship between the treads’ ICRs and path. This model has been simulated for computing the treads’ ICR positions for the Pioneer P3-AT robot. We set all of the key parameters for the model as listed in Table 1.
Table 1. The parameters for Pioneer P3-AT robot and terrain dynamic model.
Table 1. The parameters for Pioneer P3-AT robot and terrain dynamic model.
Key Parameters SymbolValue
Mass of robot (kg)m31
Width of robot (m)B0.40
Length of robot (m)L0.31
Length of C (m)C0.24
Radius of tire (m)R0.11
Width of wheel (m)b0.05
Shear deformation modulus (m) K l , K r 0.00054
Coefficient of rolling resistance μ r o l l , l a b 0.0371
Coefficient of friction, of μ s a μ s a 0.4437
Coefficient of friction, of μ o p μ o p 0.3093
The values of the ICR coefficient χ and nondimensional path curvature variable λ are computed by solving the non-linear optimization problem with Equations (16)–(22):
m i n λ , χ i = 1 N [ Δ F x i 2 + Δ F y i 2 ]
where i denotes the ith of N simulated data. When the skid-steering wheeled vehicle is in a constant velocity circular motion, a set of different commanded turning radii is given by:
R = λ R 0 ( m ) ,   λ = 0 ,   1 ,   2   , , 7
So we can use Equation (16) to get χ with respect to a special λ . The simulated results of χ vs. λ are shown in Figure 5.
Figure 5. The dynamic simulated results of χ vs. λ with Pioneer P3-AT robot using parameters in Table 1.
Figure 5. The dynamic simulated results of χ vs. λ with Pioneer P3-AT robot using parameters in Table 1.
Sensors 15 09681 g005
In Figure 5, we can find that χ decreases as λ increases, so there is a relationship between these two parameters. In this simulation, we must note that these results are obtained by assuming that the skid-steering mobile robot runs on the firm road and with special values of K , μ s a , and μ o p . Because these terrain parameters are difficult to determine, an exact relationship needs further experimental identification.

3. Laser-Scanner-Based Experimental Kinematics Method

3.1. Proposed Algorithm

In this section, an easy-operating and effective experiment can be used to derive the symmetric kinematics model and the ICR coefficient. When different angular speed control inputs ω l and ω r are issued, we consider that the vehicle moves at a constant ICR value, then the following equation can be applied:
y 0 ( ω l , ω r ) = ω r r d t ω l r d t 2 ϕ
where ϕ is the actual rotation angle. We can get y 0 by Equation (25). Then, we can use Equation (15) to determine the ICR coefficient χ .
A set of experiments have been performed. The robot is planned to follow eight different paths with curvatures of radii:
R = λ R 0 ( m ) ,       λ = 0 ,   1 ,   2 , ,   7
Note that λ is denoted in Equation (13). We can choose one of the experimental y 0 data as R 0 , and on each path, five different speeds:
υ = 0.1 n ( m / s ) ,       n = 1 ,   2 ,   ,   5
With Equations (26) and (27), we can get different ( v l , v r ) pairs. Therefore, 40 experiments will be performed. The ICR coefficient χ is calculated in each experiment using Equations (15) and (25), which requires measuring the actual speed of each side wheel during the experiment.

3.2. Laser-Scanner-Based Localization Method and Experiment Setup

The skid-steering mobile robot—a Pioneer P3-AT robot shown in Figure 6—is used for all testing in this research [20], the parameters for the Pioneer P3-AT robot are listed in Table 1 in Section 2.2.2. The P3-AT robot is driven by two motors on each side, and the two wheels of the same side are connected by one chain, so the two wheels of each side rotate at the same speed.
In all of the experiments the field is faced with a tile. Final drive shaft speeds of the motors on the robot are measured using two optical encoders. The optical encoders produce 2048 pulses per resolution, and the interface chip provides quadrature encoding, producing a change of 8192 counts for one revolution, or 0.0439° per count. A YL-100il wireless series port module, which can transmit data transparently, is selected as wireless transmission part.
Figure 6. Skid-steering mobile robot platform—a Pioneer P3-AT mobile robot.
Figure 6. Skid-steering mobile robot platform—a Pioneer P3-AT mobile robot.
Sensors 15 09681 g006
A laser scanner-based localization method is used for the position and heading measurements of the robot. An overview of the proposed localization method and the robot control system are demonstrated in Figure 7. In order to localize the robot a thin plate (indicated as (1) in Figure 7) is mounted on top of the Pioneer P3-AT robot in the symmetric plane. A Sick LMS400-10000 laser scanner (3) is installed at the same height, the data of which are used to localize the robot. We use a laptop to control the Pioneer P3-AT robot (4) through a wireless serial port communication. The speed range of the robot is about 0–0.6 m/s.
Figure 7. An overview of the proposed localization method based on a Laser Scanner. (1) The thin plate; (2) Pioneer P3-AT robot; (3) Sick LMS400 Laser Scanner; (4) Laptop software panel.
Figure 7. An overview of the proposed localization method based on a Laser Scanner. (1) The thin plate; (2) Pioneer P3-AT robot; (3) Sick LMS400 Laser Scanner; (4) Laptop software panel.
Sensors 15 09681 g007
The Sick LMS400-1000 laser scanner [21], has a large dynamic measurement range of 0.7 m to 3 m with 3 mm systematic error. The field of view of the laser scanner is 70° with 0.1 °   angular resolution and 270 Hz–500 Hz scanning frequency. The measurement data from the laser scanner are sent to the laptop using an Ethernet connection. The data of the LMS400 regarding the plate are extracted by a clustering method. A line is fitted to the points. The line slope angle is equal to the heading angle, and coordinates of its center are equal to the coordinates of robot geometric center. A median filter, an edge filter and a mean filter are applied to the computed coordinates of robot to smooth the data as much as possible. Measurements of position and heading from the plate can be updated at 135 Hz after filtering. The calculations of position and heading from the plate are shown below.
Figure 8. Position and heading measurement from the plate based on LMS400-1000 Laser Scanner for a real trajectory Ω of the robot’s center.
Figure 8. Position and heading measurement from the plate based on LMS400-1000 Laser Scanner for a real trajectory Ω of the robot’s center.
Sensors 15 09681 g008
In Figure 8, the laser scanner is at origin point O in the inertial frame   ( X , Y ) , the actual width of the thin plate is L p a = 290.0   mm , that is from point P S t a r t to P e n d (the solid blue line) in the laser scanner image region. And P m i d is the middle point of plate. The red dot dash line Ω is the planning trajectory of the robot’s center. The coordinates of P m i d are the position of the robot’s center coordinates in inertial frame. The angle θ p a between X-axis and line   P S t a r t P e n d ¯ , is the heading angle of the mobile robot. We can get point data from the laser scanner from polar coordinates to orthogonal coordinates:
P x = ρ   c o s α ,   P y = ρ   s i n α
where ρ and α are the distance and corresponding angle of point P measured by the laser scanner, respectively. The measured width of the thin plate L p a ^ is:
L p a ^ = ( P e n d x P S t a r t x ) 2 + ( P e n d y P S t a r t y ) 2
All the data on the plate acquired by the laser scanner can be written in orthogonal coordinates:
P x i = ρ i   c o s α i ,   P y i = ρ i   s i n α i ,   i = 1 ,   2 , , n
The date can be fitted as a line, and a least-square method is applied to get the heading angle of the line (the same as the robot heading):
P y = k P x + a
P x ¯ = i = 1 n P x i n ,   P y ¯ = i = 1 n P y i n
k ^ = i = 1 n P x i P y i n P x ¯ P y ¯ i = 1 n ( P x i ) 2 n ( P x ¯ ) 2
a ^ = P y ¯ k ^ P x ¯
The line slope angle is equal to the heading angle, considering that the field of view of the laser scanner is 70° ( 0.389 π ):
θ p a ^ = t a n 1 k ^ ,   θ p a ^ [ 0.194 π ,   0.194 π ]
so we can get the position and heading q = ( X , Y , θ ) T from the plate based on the laser scanner. The rotation angle ϕ of the mobile robot during interval t e n d t 0 is:
ϕ = θ p a ^ ( t e n d ) θ p a ^ ( t 0 )
A set of experiments are executed to get the relationship between the ICR coefficient and the radius of path curvature and speed of the robot. On each path, the skid-steering wheeled vehicle is in constant velocity circular motion. The encoders equipped on the left and right motors give the left and right wheels’ moving distance, that is ω l r d t and ω r r d t . The laser scanner measures the rotation angle change during entire cycle of motion. As in Figure 9, the robot moves clockwise from position (1) to (3), and the laser scanner get the distance data between the thin plate and the laser scanner center at a time interval of 3.7 ms. With Equations (15), (25) and (36), we can get the ICR coefficient χ .
Figure 9. The laser scanner measurement during an entire cycle Ω run from (1) start to (3) end with the mobile robot.
Figure 9. The laser scanner measurement during an entire cycle Ω run from (1) start to (3) end with the mobile robot.
Sensors 15 09681 g009

3.3. Errors Analysis

The Sick laser scanner measurements errors are given by ρ = 0.003  m and α = 0.1 π 180 = 0.00174  rad [21], so the point data errors in orthogonal coordinates from Equation (28) are:
P x = | ( ρ ) c o s α | ρ + | ( c o s α ) ρ | α ρ + | ρ | α = 0.008   m
Similarly, P y = 0.008   m . When the robot moves, the maximum speed v m a x 0.7  m / s , and the laser sample time t s = 1 f = 1 135 s . The dynamic error when the robot moves is:
P x d y n a m i c v m a x ;   t s = 0.7 × 1 135 = 0.005   m
Note that P . x s t a t i c = P x , so the total point data measurement error is:
P x t o t a l = P x s t a t i c + P x d y n a m i c = 0.013   m
In Figure 8, with Equations (31), (33) and (36), denote ϕ [ π 4 ,     π 4 ] and ρ [ 1 ,   3 ] , so the heading angle ϕ is:
ϕ = ϕ ( x , y ) = t a n 1 ( y / x ) , x [ 0 ,   3 2 ] , y [ 1 2 ,   3 ]
and we have the heading angle error:
ϕ = | ϕ x | x + | ϕ x | y = | y x 2 + y 2 | x + | x x 2 + y 2 | y 2 x = 0.018   r a d
With Equation (25), we obtain:
y 0 ( ω l , ω r ) = ω r r d t ω l r d t 2 ϕ = f ( S l , S r , ϕ ) = S r S l 2 ϕ
where S r and S l are the displacement distance measured by the left and right wheel encoders, respectively, expressed in millimeters after correction. We note that the position errors are S l and S r , S l and S r are obtained by measuring the actual traveled distance d in straight motion, and the results are S l = 0.00026     m ,   S r = 0.00020     m . Note that ϕ = 0.018  rad with Equation (41). Let y 0 denote the ICR value error for y 0 :
y 0 = | f S l | S l + | f S r | S r + | f ϕ | ϕ = 0.007   m
Note that y 0 is not less than 0.2 m with a width of robot B = 0.40  m . The ICR value error y 0 = 0.007   m , corresponding to extremely small estimate error, is sufficient for further testing.

3.4. Results

Data are collected in real time and processed off line with MATLAB. Figure 10a shows a comparison of the measured width of the plate from the laser scanner and the actual value. The measured ones, shown as a dot line red line, lies close enough to the actual value (a solid blue line). In Figure 10b, the mean difference between measured width and actual value is  shown . In Table 2, it shows that the mean value of measured width μ is 0.289 m and the standard deviation σ is 0.003 m, and the maximum error is −0.01 m, corresponding to an extremely small ICR value estimatation error. The results demonstrate the effectiveness and the feasibility of the proposed laser scanner-based method.
Figure 10. (a) A comparison of the measured width of the plate from the laser scanner and the actual value; (b) Error between measured width and actual one.
Figure 10. (a) A comparison of the measured width of the plate from the laser scanner and the actual value; (b) Error between measured width and actual one.
Sensors 15 09681 g010
Table 2. Mean value and errors of measured width of the plate from the laser scanner.
Table 2. Mean value and errors of measured width of the plate from the laser scanner.
Test Parameters μ   (m) σ   (m)Max. Error (m)
Width of the Plate ( L p a )0.28900.003−0.01
Figure 11 shows the position and heading and velocity of robots calculated by the laser scanner-based localization algorithm during the experiment for speed of 0.25 m/s and curvature radius of 0.475 m.
Figure 11. Position and velocity of robots calculated by the proposed algorithm. (a) position and heading; (b) velocity.
Figure 11. Position and velocity of robots calculated by the proposed algorithm. (a) position and heading; (b) velocity.
Sensors 15 09681 g011
Figure 12 depicts that the ICR coefficient χ for various path curvatures and vehicle velocity. In Table 3, the mean values μ and standard derivations σ of the ICR coefficient χ are shown. It shows that the maximum relative error is less than 1%, and the maximum σ is no larger than 0.01, so the differences between different   χ  with respect to corresponding λ can be distinguished, with this ICR coefficient measurement accuracy. Furthermore we can find that Figure 12a represents the similar trends as in Figure 5. By increasing the path curvature (increasing λ ), the ICR coefficient χ decreases. This implies a specific behavior for χ with respect to λ . Meanwhile, in Figure 12b, the ICR coefficient χ remains almost constant with increasing velocity v, at certain λ .
Figure 12. The calculated ICR coefficient χ for various: (a) path curvatures with v = 0.1 ,     0.2 ,   0.5   m / s ; and (b) robot speeds with v = 0.1 ,     0.2 ,     0.5   m / s with λ = 0 ,   1 ,   2 ,   ,   7 .
Figure 12. The calculated ICR coefficient χ for various: (a) path curvatures with v = 0.1 ,     0.2 ,   0.5   m / s ; and (b) robot speeds with v = 0.1 ,     0.2 ,     0.5   m / s with λ = 0 ,   1 ,   2 ,   ,   7 .
Sensors 15 09681 g012
Table 3. The calculated ICR coefficient χ for various λ .
Table 3. The calculated ICR coefficient χ for various λ .
Parameters λ μ σ Max. Relative Error
01.46620.00330.34%
11.44800.00650.59%
21.43940.00550.62%
31.43410.00680.71%
41.42150.0080−0.92%
51.42320.00500.52%
61.41650.00770.77%
71.41150.00430.30%
In order to reveal the relationship, an approximate function is then used to define χ as a function of the non-dimensional path curvature variable λ :
χ ( λ ) = 1 + a 1 + b | λ | 1 2   ,   λ [ 0 ,   10 ]
where a and b are determined by a curve fit of the experimental data, a > 0 ,   b > 0 . We run 10 sets of experiments with various λ on the lab surface. Numerical values of parameters a = 0.4728 ,   b = 0.0538 are obtained using a nonlinear least-square algorithm for the function given in Equation (44), and substituted as:
χ ( λ ) = 1 + 0.4728 1 + 0.0538 | λ | 1 2   ,   λ [ 0 ,   10 ]
Figure 13 shows χ versus λ using the approximating function and experimental data when v = 0.3   m / s . The solutions obtained from the simulated and experimental methods are also summarized in this figure. From a qualitative standpoint, experimental results are coherent with those obtained in simulation. The simulation data are a little bigger than experimental results because of uncertain model parameters, e.g., the coefficient of rolling resistance, coefficient of friction, and shear modulus.
Figure 13. Experimental data curve, simulation data curve and data-fitted curve for χ with respect to λ , when v = 0.3   m / s .
Figure 13. Experimental data curve, simulation data curve and data-fitted curve for χ with respect to λ , when v = 0.3   m / s .
Sensors 15 09681 g013

3.5. Dead-Reckoning Validation

To verify the developed kinematics model with the relationship between ICR coefficient χ and λ , an example path is estimated by two alternative kinematics models: the default P3-AT symmetric model with that χ is a constant value of 1.5, and the proposed approximating model with that χ changes with the nondimensional path curvature variable λ . The example path is different from the ones used in the former model experimental procedure, but it runs in the same environment.
During the dead-reckoning validation, with Equation (11), we have the default P3-AT kinematics model:
{ v x = v l + v r 2 v y = 0 ω z = v l + v r 2 y 0 = v l + v r 2 B χ       , χ 1.5
and with Equations (11) and (13), the proposed kinematics model is:
{ v x = v l + v r 2 v y = 0 ω z = v l + v r 2 y 0 = v l + v r 2 B χ     , χ ( λ ) = 1 + 0.4728 1 + 0.0538 | λ | 1 2
Consider that the center of the robot moves as the following velocity inputs during 6 s. The acceleration is below 3 m / s 2 , which is nearly the maximum acceleration for the P3-AT mobile robot and the velocity is less than 0.5   m / s , which is nearly the effective maximum velocity of the robot.
{ v l = 0 ,     v r = 0 ,     t = 0 ; v l = 0.2 ,     v r = 0.15 ,     0 < t 1 ; v l = 0.2 ,   v r = 0.1 ,     1 < t 2 ; v l = 0.3 ,   v r = 0.1 ,     2 < t 3 ; v l = 0.4 ,   v r = 0 ,     3 < t 4 ; v l = 0.3 ,   v r = 0.2 ,     4 < t 5 ; v l = 0.3 ,   v r = 0.25 ,     5 < t 6 ; v l = 0 ,   v r = 0 ,     t > 6 ;
Figure 14. Dead-reckoning performance using proposed model and P3-AT model for an example path with the mobile robot.
Figure 14. Dead-reckoning performance using proposed model and P3-AT model for an example path with the mobile robot.
Sensors 15 09681 g014
Figure 14 shows the estimation of the path based on dead-reckoning (only drive shaft encoders are used) according to the default P3-AT model and the proposed model, and the LMS400 laser scanner data provide the actual position and heading. It can be seen that the proposal model achieves better dead reckoning estimation accuracy than that of the default P3-AT model.
Cartesian error and its norm are depicted in Figure 15. The proposed model has a smaller position error within 0.03 m, and a smaller angle error within 0.1 rad. Also, mean squared performance values obtained in the validation path are show in Table 4.
Figure 15. Dead-reckoning errors using the proposed model and the P3-AT model for an example path with the mobile robot. (a) Magnitude of position errors in X axis and Y axis; (b) position magnitude errors and heading errors.
Figure 15. Dead-reckoning errors using the proposed model and the P3-AT model for an example path with the mobile robot. (a) Magnitude of position errors in X axis and Y axis; (b) position magnitude errors and heading errors.
Sensors 15 09681 g015
Table 4. Mean squared performance values of position and heading errors.
Table 4. Mean squared performance values of position and heading errors.
NO. x   (m) y   (m) Φ   (rad)
P3-AT model0.01690.01010.0438
Proposed model0.02730.01190.0778
Meanwhile, estimated ICR coefficient χ during the example path is presented in Figure 16. In fact, the ICR coefficient χ varies as the path changes (it is not a constant value of 1.5).
Figure 16. ICR coefficient χ using the proposed model and the P3-AT model for an example path with the mobile robot.
Figure 16. ICR coefficient χ using the proposed model and the P3-AT model for an example path with the mobile robot.
Sensors 15 09681 g016

4. Conclusions/Outlook

We develop an analysis and experimental kinematics scheme of a skid-steering wheeled vehicle based-on a laser scanner sensor. The ICR coefficient χ and a nondimensional path curvature variable λ are introduced to describe the potential model relationship. The dynamic models based simulation results show that there is some relationship between these two parameters. The laser-scanner-based method experimentally derives the approximating function between χ and λ . The obtained function is validated on a sample path. It was shown that the proposed kinematics model estimated for a skid-steering mobile robot improves the system performance in terms of reduced dead-reckoning errors, with a smaller position error within 0.03 m, and a smaller angle error within 0.1 rad with respect to the default P3-AT model. This test method is easy to operate without adding extra sensors or changing the vehicle mechanical structure and control system. The proposed model and analysis approach can be further used for odometry or to map desired vehicle motion, such as vehicle speed and angular rate, to required wheel speeds.
However, we use the assumptions 2 and 3, which the robot is running on a firm ground surface, and four wheels with the same speed are always in contact with the ground surface. Some mobile robots run on loose soil and in many 4/6 wheels drive (4/6WD) mobile robots, the wheels of each side rotate at different speeds, raising the question of whether a similar result be obtained in a different environment using this method? For future work, it would be interesting to validate the model on different terrains. The current experimental testing results are obtained when acceleration a < 3 m / s 2 and velocity v < 0.5 m / s due to the limitations of the robotic platform. Thus, further experiments will be implemented to discuss this problem at higher acceleration and velocity in the future.

Acknowledgments

This research is supported by the National High-Tech Research & Development Program of China (Grant NO. 2011AA040202).

Author Contributions

All authors have significant contributions to this article. Tianmiao Wang and Yao Wu conceived and designed the activity. Yao Wu, the corresponding author, was mainly responsible for the dynamics model and kinematics model method with Jianhong Liang. Chenhao Han, was responsible for the dynamics model and simulation for this model. Jiao Chen and Qiteng Zhao, performed the experiment and data collection. Yao Wu and Chenhao Han wrote the paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Yi, J.; Wang, H.P.; Zhang, J.; Song, D. Kinematic modeling and analysis of skid-steered mobile robots with applications to low-cost inertial-measurement-unit-based motion estimation. IEEE Trans. Robot. 2009, 25, 1087–1097. [Google Scholar] [CrossRef]
  2. Mandow, A.; Martinez, J.L.; Morales, J.; Blanco, J.; García-Cerezo, A.J.; Gonzalez, J. Experimental kinematics for wheeled skid-steer mobile robots. In Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems, San Diego, CA, USA, 29 October–2 November 2007; pp. 1222–1227.
  3. Yi, J.; Zhang, J.; Song, D.; Jayasuriya, S. IMU-based localization and slip estimation for skid-steered mobile robots. In Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems, San Diego, CA, USA, 29 October–2 November 2007; pp. 2845–2850.
  4. Caracciolo, L.; Luca, A.D.; Iannitti, S. Trajectory tracking control of a four-wheel differentially driven mobile robot. In Proceedings of IEEE/RSJ International Conference on Robotics and Automation, Detroit, MI, USA, 10–15 May 1999; pp. 2632–2638.
  5. Yi, J.; Song, D.; Zhang, J.; Goodwin, Z. Adaptive trajectory tracking control of skid-steered mobile robots. In Proceedings of IEEE/RSJ International Conference on Robotics and Automation, Rome, Italy, 10–14 April 2007; pp. 2605–2610.
  6. Kozlowski, K.; Pazderski, D. Modeling and control of a 4-wheel skid-steering mobile robot. Int. J. Appl. Math. Comput. Sci. 2004, 14, 477–496. [Google Scholar]
  7. Martinez, J.L.; Mandow, A.; Morales, J.; Pedraza, S.; García-Cerezo, A.J. Approximating kinematics for tracked mobile robots. Int. J. Robot. Res. 2005, 24, 867–878. [Google Scholar] [CrossRef]
  8. Yu, W.; Chuy, O.; Collins, E.G.; Hollis, P. Dynamic Modeling of a Skid-Steered Wheeled Vehicle with Experimental Verification. In Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems, St. Louis, MO, USA, 11–15 October 2009; pp. 4211–4219.
  9. Yu, W.; Chuy, O.; Collins, E.G.; Hollis, P. Analysis and experimental verification for dynamic modeling of a skid-steered wheeled vehicle. IEEE Trans. Robot. 2010, 26, 340–353. [Google Scholar] [CrossRef]
  10. Maalouf, E.; Saad, M.; Saliah, H. A higher level path tracking controller for a four-wheel differentially steered mobile robot. Robot. Auton. Syst. 2006, 54, 23–33. [Google Scholar] [CrossRef]
  11. Kozlowski, K.; Pazderski, D. Practical stabilization of a skid-steering mobile robot—A kinematic-based approach. In Proceedings of IEEE 3rd Conference on Mechatronics, Budapest, Hungary, 3 July 2006; pp. 519–524.
  12. Le, A.; Rye, D.; Durrant-Whyte, H. Estimation of track-soil interactions for autonomous tracked vehicles. In Proceedings of IEEE/RSJ International Conference on Robotics and Automation, Albuquerque, NM, USA, 10–14 April 1997; pp. 1388–1393.
  13. Moosavian, S.A.A.; Kalantari, A. Experimental slip estimation for exact kinematics modeling and control of a tracked Mobile Robot. In Proceedings of IEEE/RSJ International Conference on Intelligent Robots and Systems, Nice, France, 22–26 September 2008; pp. 95–100.
  14. Anousaki, G.; Kyriakopoulos, K. A dead-reckoning scheme for skid-steered vehicles in outdoor environments. In Proceedings of IEEE/RSJ International Conference on Robotics and Automation, New Orleans, LA, USA, 26 April–1 May 2004; pp. 580–585.
  15. Anousaki, G.; Kyriakopoulos, K. Simultaneous localization and map building of skid-steered robots. IEEE Robot. Autom. Mag. 2007, 14, 79–89. [Google Scholar] [CrossRef]
  16. Wong, J.; Chiang, C. A general theory for skid steering of tracked vehicles on firm ground. Proceedings of the Institution of Mechanical Engineers. Available online: http://pid.sagepub.com/content/215/3/343.full.pdf (accessed on 23 April 2015).
  17. Wong, J. Theory of Ground Vehicles, 3rd ed.; Wong, J., Ed.; John Wiley & Sons, Inc.: New York, NY, USA, 2001; pp. 389–418. [Google Scholar]
  18. Martinez, J.L.; Gonzalez, J.; Morales, J.; Mandow, A.; García-Cerezo, A.J. Mobile robot motion estimation by 2D scan matching with genetic and iterative closest point algorithms. J. Field Robot. 2006, 23, 21–34. [Google Scholar] [CrossRef]
  19. Duan, Z.; Cai, Z.; Min, H. Robust Dead Reckoning System for Mobile Robots Based on Particle Filter and Raw Range Scan. Sensors 2014, 14, 16532–16562. [Google Scholar] [CrossRef] [PubMed]
  20. Technical Description: Pioneer P3-AT Mobile Robot. Available online: http://www.mobilerobots.com (accessed on 11 February 2015).
  21. Technical Description: LMS400 Laser Measurement Sensor. Available online: http://www.sick.com (accessed on 11 February 2015).

Share and Cite

MDPI and ACS Style

Wang, T.; Wu, Y.; Liang, J.; Han, C.; Chen, J.; Zhao, Q. Analysis and Experimental Kinematics of a Skid-Steering Wheeled Robot Based on a Laser Scanner Sensor. Sensors 2015, 15, 9681-9702. https://doi.org/10.3390/s150509681

AMA Style

Wang T, Wu Y, Liang J, Han C, Chen J, Zhao Q. Analysis and Experimental Kinematics of a Skid-Steering Wheeled Robot Based on a Laser Scanner Sensor. Sensors. 2015; 15(5):9681-9702. https://doi.org/10.3390/s150509681

Chicago/Turabian Style

Wang, Tianmiao, Yao Wu, Jianhong Liang, Chenhao Han, Jiao Chen, and Qiteng Zhao. 2015. "Analysis and Experimental Kinematics of a Skid-Steering Wheeled Robot Based on a Laser Scanner Sensor" Sensors 15, no. 5: 9681-9702. https://doi.org/10.3390/s150509681

Article Metrics

Back to TopTop