Movatterモバイル変換


[0]ホーム

URL:


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
 
 
Search for Articles:
Title / Keyword
Author / Affiliation / Email
Journal
Article Type
 
 
Section
Special Issue
Volume
Issue
Number
Page
 
Logical OperatorOperator
Search Text
Search Type
 
add_circle_outline
remove_circle_outline
 
 
Journals
Sensors
Volume 15
Issue 5
10.3390/s150509681
Font Type:
ArialGeorgiaVerdana
Font Size:
AaAaAa
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.
Sensors2015,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 SectionPhysical 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 speedv), 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 speedv. 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, Maaloufet 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. InSection 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.
    Sensors 15 09681 g001 1024
    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 inFigure 1. Suppose that the robot moves on a plane with a linear velocity expressed in the local frame asv=(vx,vy,0)T and rotates with an angular velocity vectorω=(0,0,ωz)T. Ifq=(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), thenq˙=(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˙θ˙]=[cosθsinθ0sinθcosθ0001][vxvyω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:
    [vxvyωz]=f[ωlrωrr]
    wherev=(vx,vy) 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 asICRl,ICRr andICRG, respectively. It is known thatICRl,ICRr andICRG lie on a line parallel to thex-axis [7,16]. We define thex-y coordinates forICRl,ICRr andICRG as(xl,yl), (xr,yr), and(xG,yG), respectively.
    Note that treads have the same angular velocityωz as the robot body. We can get the geometrical relation:
    yG=vxωz
    yl=vxωlrωz
    yr=vxωrrωz
    xG=xl=xr=vyωz
    From Equations (4)–(7), the kinematics relation (3) can be represented as:
    [vxvyωz]=Jω[ωlrωrr]
    Where the elements of matrixJω depend on the tread ICR coordinates:
    Jω=1ylyr[yrylxGxG11]
    If the mobile robot is symmetrical, we can get a symmetrical kinematics model (i.e., the ICRs lie symmetrically on thex-axis andxG  = 0), so matrixJω can be written as the following form:
    Jω=12y0[y0y00011]
    wherey0=yl=yr is the instantaneous tread ICR value. Noted thatvl=ωlr,   vr=ωrr, for the symmetrical model, the following equations can be obtained:
    {vx=ωlr+ωrr2=vl+vr2vy=0ωz=ωlr+ωrr2y0=vl+vr2y0
    Notedvy=0, so thatvG=vx. We can get the instantaneous radius of the path curvature:
    R=vGωz=vGωz=vl+vrvl+vry0
    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:
    λ=vl+vrvl+vr 
    and we can rewrite Equation (12) as:
    R=vl+vrvl+vry0=λy0
    We use a similar index as in Mandow’s work [2,7], then an ICR coefficientχ can be defined as:
    χ =ylyrB=2y0B,  χ1
    where B denotes the lateral wheel bases, as illustrated inFigure 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 matrixJω has no inverse.
    It is noted that the above expressions also present the kinematics for ideal wheeled differential drive vehicles, as illustrated inFigure 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.
    Sensors 15 09681 g002 1024
    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:ICRl andICRr. 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

    InSection 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.
    Sensors 15 09681 g003 1024
    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 inFigure 3, following Wong’s model [16], the dynamic model is given by:
    {Fxfr+Fxrr+Fxfl+FxrlRxmvG2Rsinβ=0Fyfr+Fyrr+Fyfl+Fyrl=mvG2RcosβMdMr=0
    wherevG is the vehicle velocity, andβ is the angle between the vehicle velocity andx-axis on the local frame.Fxfr, Fxrr, Fxfl, Fxrl are the longitudinal (friction) forces andFyfr, Fyrr, Fyfl, Fyrl are the lateral forces.Rfr, Rrr, Rfl, Rrl are external motion resistances on the four wheels. Md is the drive moment and Mr is the resistance moment.
    Based on the wheel-ground interaction theory [16,17], the shear stressτss  and shear displacementj relationship can be described as:
      τss =pμ(1ejK)
    wherep is the normal pressure,μ is the coefficient of friction andK is the shear deformation modulus.
    Figure 4 depicts a skid-steering wheeled vehicle moving counterclockwise (CCW) at constant linear velocityv and angular velocityϕ˙ in a circle centered atO from position (1) to position (2). The four contact patches of the wheels with the ground are shadows inFigure 4.L andC are the patch-related distances. In the inertial X-Y frame, we define thatjfr, jrr, jfl, jrl andγfr, γrr, γfl, γrl 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:
    {Fxfr=C/2L/2b/2b/2prμr(1ejfrKr)sin(π+γfr)dxrdyrFyfr=C/2L/2b/2b/2prμr(1ejfrKr)cos(π+γfr)dxrdyr,
    {Fxrr=L/2C/2b/2b/2prμr(1ejrrKr)sin(π+γrr)dxrdyrFyrr=C/2L/2b/2b/2prμr(1ejrrKr)cos(π+γrr)dxrdyr,
    {Fxfl=C/2L/2b/2b/2plμl(1ejflKl)sin(π+γfl)dxldylFyfl=C/2L/2b/2b/2plμl(1ejflKl)cos(π+γfl)dxldyl,
    {Fxrl=L/2C/2b/2b/2plμl(1ejrlKr)sin(π+γrl)dxldylFyrl=L/2C/2b/2b/2plμl(1ejrlKr)cos(π+γrl)dxldyl,
    wherepl,μl andKl are respectively the normal pressure, coefficient of friction, and shear deformation modulus of the left wheels, andpr,μr andKr 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 andC, width of wheel,b,pl andpr can be determined bymg/2(LC)b when a uniform normal pressure distributions assumption used (pl=pr). We share some parameters:μl,  μr,Kl andKr as in Yu’s research [9], because the same platform (Pioneer P3-AT robot) and similar lab surface are used for the simulation.
    Sensors 15 09681 g004 1024
    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μroll. We can obtain the resistance force, such that:
    Rx=mgμroll

    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 inTable 1.
    Table
    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 ParametersSymbolValue
    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)Kl,Kr0.00054
    Coefficient of rolling resistanceμroll,lab0.0371
    Coefficient of friction, ofμsaμsa0.4437
    Coefficient of friction, ofμopμop0.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):
    minλ,χi=1N[ΔFxi2+ΔFyi2]
    wherei denotes theith 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=λR0(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 inFigure 5.
    Sensors 15 09681 g005 1024
    Figure 5. The dynamic simulated results ofχvs.λ with Pioneer P3-AT robot using parameters inTable 1.
    Figure 5. The dynamic simulated results ofχvs.λ with Pioneer P3-AT robot using parameters inTable 1.
    Sensors 15 09681 g005
    InFigure 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 ofK,μsa, andμop. 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:
    y0(ωl,ωr)=ωrrdtωlrdt2ϕ
    whereϕ is the actual rotation angle. We can gety0 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=λR0(m),   λ=0, 1, 2,, 7
    Note thatλ is denoted in Equation (13). We can choose one of the experimentaly0 data asR0, and on each path, five different speeds:
    υ=0.1n(m/s),   n=1, 2, , 5
    With Equations (26) and (27), we can get different(vl,vr) 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 inFigure 6—is used for all testing in this research [20], the parameters for the Pioneer P3-AT robot are listed inTable 1 inSection 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.
    Sensors 15 09681 g006 1024
    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 inFigure 7. In order to localize the robot a thin plate (indicated as (1) inFigure 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.
    Sensors 15 09681 g007 1024
    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° with0.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.
    Sensors 15 09681 g008 1024
    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
    InFigure 8, the laser scanner is at origin point O in the inertial frame (X,Y), the actual width of the thin plate isLpa=290.0 mm, that is from pointPStart toPend (the solid blue line) in the laser scanner image region. AndPmid is the middle point of plate. The red dot dash lineΩ is the planning trajectory of the robot’s center. The coordinates ofPmid are the position of the robot’s center coordinates in inertial frame. The angleθpa betweenX-axis and line PStartPend¯, is the heading angle of the mobile robot. We can get point data from the laser scanner from polar coordinates to orthogonal coordinates:
    Px=ρ cosα, Py=ρ sinα
    whereρ andα are the distance and corresponding angle of pointP measured by the laser scanner, respectively. The measured width of the thin plateLpa^ is:
    Lpa^=(PendxPStartx)2+(PendyPStarty)2
    All the data on the plate acquired by the laser scanner can be written in orthogonal coordinates:
    Pxi=ρi cosαi, Pyi=ρi sinα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):
    Py=kPx+a
    Px¯=i=1nPxin, Py¯=i=1nPyin
    k^=i=1nPxiPyinPx¯Py¯i=1n(Pxi)2n(Px¯)2
    a^=Py¯k^Px¯
    The line slope angle is equal to the heading angle, considering that the field of view of the laser scanner is 70° (0.389π):
    θpa^=tan1k^, θpa^[0.194π, 0.194π]
    so we can get the position and headingq=(X,Y,θ)T from the plate based on the laser scanner. The rotation angleϕ of the mobile robot during intervaltendt0 is:
    ϕ=θpa^(tend)θpa^(t0)
    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ωlrdt andωrrdt. The laser scanner measures the rotation angle change during entire cycle of motion. As inFigure 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χ.
    Sensors 15 09681 g009 1024
    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:
    Px=|(ρ)cosα|ρ+|(cosα)ρ|αρ+|ρ|α=0.008 m
    Similarly,Py=0.008 m. When the robot moves, the maximum speedvmax0.7 m/s, and the laser sample timets=1f=1135s. The dynamic error when the robot moves is:
    Pxdynamicvmax; ts=0.7×1135=0.005 m
    Note thatP.xstatic=Px, so the total point data measurement error is:
    Pxtotal=Pxstatic+Pxdynamic=0.013 m
    InFigure 8, with Equations (31), (33) and (36), denoteϕ[π4,  π4] andρ[1, 3], so the heading angleϕ is:
    ϕ=ϕ(x,y)=tan1(y/x),x[0, 32],y[12, 3]
    and we have the heading angle error:
    ϕ=|ϕx|x+|ϕx|y=|yx2+y2|x+|xx2+y2|y2x=0.018 rad
    With Equation (25), we obtain:
    y0(ωl,ωr)=ωrrdtωlrdt2ϕ=f(Sl,Sr,ϕ)=SrSl2ϕ
    whereSr andSl are the displacement distance measured by the left and right wheel encoders, respectively, expressed in millimeters after correction. We note that the position errors areSl andSr ,Sl andSr are obtained by measuring the actual traveled distanced in straight motion, and the results areSl=0.00026  m, Sr=0.00020  m. Note thatϕ=0.018 rad with Equation (41). Lety0 denote the ICR value error fory0:
    y0=|fSl|Sl+|fSr|Sr+|fϕ|ϕ=0.007 m
    Note thaty0 is not less than 0.2 m with a width of robotB=0.40 m. The ICR value errory0=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). InFigure 10b, the mean difference between measured width and actual value is shown. InTable 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.
    Sensors 15 09681 g010 1024
    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
    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 (Lpa)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.
    Sensors 15 09681 g011 1024
    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. InTable 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 thatFigure 12a represents the similar trends as inFigure 5. By increasing the path curvature (increasingλ), the ICR coefficientχ decreases. This implies a specific behavior forχ with respect toλ. Meanwhile, inFigure 12b, the ICR coefficientχ remains almost constant with increasing velocityv, at certainλ.
    Sensors 15 09681 g012 1024
    Figure 12. The calculated ICR coefficientχ for various: (a) path curvatures withv=0.1,  0.2, 0.5 m/s; and (b) robot speeds withv=0.1,  0.2,  0.5 m/s withλ=0, 1, 2, , 7.
    Figure 12. The calculated ICR coefficientχ for various: (a) path curvatures withv=0.1,  0.2, 0.5 m/s; and (b) robot speeds withv=0.1,  0.2,  0.5 m/s withλ=0, 1, 2, , 7.
    Sensors 15 09681 g012
    Table
    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+a1+b|λ|12 , λ[0, 10]
    wherea andb 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 parametersa=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.47281+0.0538|λ|12 , λ[0, 10]
    Figure 13 showsχ versusλ using the approximating function and experimental data whenv=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.
    Sensors 15 09681 g013 1024
    Figure 13. Experimental data curve, simulation data curve and data-fitted curve forχ with respect toλ, whenv=0.3 m/s.
    Figure 13. Experimental data curve, simulation data curve and data-fitted curve forχ with respect toλ, whenv=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:
    {vx=vl+vr2vy=0ωz=vl+vr2y0=vl+vr2Bχ   ,χ1.5
    and with Equations (11) and (13), the proposed kinematics model is:
    {vx=vl+vr2vy=0ωz=vl+vr2y0=vl+vr2Bχ   ,χ(λ)=1+0.47281+0.0538|λ|12
    Consider that the center of the robot moves as the following velocity inputs during 6 s. The acceleration is below 3m/s2, 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.
    {vl=0,  vr=0,  t=0;vl=0.2,  vr=0.15,  0<t1;vl=0.2, vr=0.1,  1<t2;vl=0.3, vr=0.1,  2<t3;vl=0.4, vr=0,  3<t4;vl=0.3, vr=0.2,  4<t5;vl=0.3, vr=0.25,  5<t6;vl=0, vr=0,  t>6;
    Sensors 15 09681 g014 1024
    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 inFigure 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 inTable 4.
    Sensors 15 09681 g015 1024
    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 inX axis andY 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 inX axis andY axis; (b) position magnitude errors and heading errors.
    Sensors 15 09681 g015
    Table
    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 inFigure 16. In fact, the ICR coefficientχ varies as the path changes (it is not a constant value of 1.5).
    Sensors 15 09681 g016 1024
    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 accelerationa<3m/s2 and velocityv<0.5m/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.Sensors2014,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).

    © 2015 by the authors; licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution license (http://creativecommons.org/licenses/by/4.0/).

    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.Sensors2015,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

    APA Style

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

    Article Metrics

    No
    No

    Article Access Statistics

    For more information on the journal statistics, clickhere.
    Multiple requests from the same IP address are counted as one view.
    Sensors, EISSN 1424-8220, Published by MDPI
    RSSContent Alert

    Further Information

    Article Processing Charges Pay an Invoice Open Access Policy Contact MDPI Jobs at MDPI

    Guidelines

    For Authors For Reviewers For Editors For Librarians For Publishers For Societies For Conference Organizers

    MDPI Initiatives

    Sciforum MDPI Books Preprints.org Scilit SciProfiles Encyclopedia JAMS Proceedings Series

    Follow MDPI

    LinkedIn Facebook X
    MDPI

    Subscribe to receive issue release notifications and newsletters from MDPI journals

    © 1996-2025 MDPI (Basel, Switzerland) unless otherwise stated
    Terms and Conditions Privacy Policy
    We use cookies on our website to ensure you get the best experience.
    Read more about our cookieshere.
    Accept
    Back to TopTop
    [8]ページ先頭

    ©2009-2025 Movatter.jp