尋線搬運機器人模型及其控制系統(tǒng)設(shè)計含開題及6張CAD圖
尋線搬運機器人模型及其控制系統(tǒng)設(shè)計含開題及6張CAD圖,搬運,機器人,模型,及其,控制系統(tǒng),設(shè)計,開題,cad
A precise curved motion planning for a differential driving mobile robot
abstract
A single curvature trajectory with a fixed rotation radius is proposed for an optimal trajectory plan for a differential driving mobile robot to capture a moving object. Generally, when the differential driving mobile robot moves along a path whose rotation radius is not constant, the tracking error of the mobile robot increases with the travel distance. Also, tracking errors increase greatly when the mobile robot follows a trajectory, with a small rotation radius. Based on these two observations, a single curvature trajectory, which has a constant and large rotation radius, is proposed as an optimal trajectory, in order to minimize the tracking error of the differential driving mobile robot.
This paper first reviews the characteristics of a single curvature trajectory. Next, an algorithm to capture a moving object precisely is proposed using the single curvature trajectory. With the pre-determined initial states (i.e., position and orientation of the mobile robot and the final states), the mobile robot is made to capture a moving object.
Through simulations and real experiments using a two DOF wheel-based mobile robot, the effectiveness of the proposed algorithm is verified.
1. Introduction
Research on mobile robots can be globally classified into three categories: path planning, position estimation, and driving control. The trajectory planning of a mobile robot aims at providing an optimal path from an initial position to a target
position. Optimal trajectory planning for a mobile robot provides a path, which has minimal tracking error and the shortest driving time and distance.
Tracking errors of mobile robots cause collisions with obstacles due to deviations from the planned path and also cause the robot to fail to accomplish the mission successfully. Tracking error can be reduced through feedback control. However, this requires excessive control efforts due to high control gains. Tracking errors also cause an increase of traveling time, as well as travel distance, due to the additional adjustments needed to satisfy the driving states. Therefore, trajectory planning to decrease tracking error is very important and needs to be handled carefully.
One of the major reasons for tracking error is the discontinuity of the rotation radius on the path of the differential driving mobile robot. The rotation radius changes at the connecting point of the straight line route and curved route, or at a point of inflection.
At these points, it can be easy for the differential driving mobile robot to secede from its determined orbit due to the rapid change of direction. Therefore, in order to decrease tracking error, the trajectory of the mobile robot must be planned so that the rotation radius is maintained at a constant , if possible.
The increase of tracking error due to the small rotation radius interferes with the accurate driving of the mobile robot. The path of the mobile robot can be divided into curved and straight-line segments, globally. While tracking error is not generated in the straight-line segment, significant error is produced in the curved segment due to centrifugal and centripetal forces, which cause the robot to slide over the surface. Also, tracking error increases when the rotation radius is small. In fact, the straight line segment can be considered as a curved segment whose rotation radius is infinity. As the tracking error becomes larger at the curved segment, the possibility of a tracking error increases with the decrease of the rotation radius of the curved path. Note that a relatively small error occurs at the straight-line path.
Therefore, it is important to maintain simultaneously a large and constant rotation radius in order to decrease the tracking error of the differential driving mobile robot.
This paper proposes a single-curvature trajectory, which has a constant and large rotation radius. In view of the size and discontinuity of the rotation radius,a single-curvature trajectory and a double-curvature trajectory are compared to show that the tracking error increases with the decrease of the rotation radius. Through the tracking experiments along each trajectory, it is proved that a single-curvature trajectory has the least tracking error. With precise trajectory planning, an algorithm for the mobile robot to capture a moving object is proposed.
With the pre-specified initial position and orientation of a mobile robot and the final states, and assuming that the velocity of the moving object is pre-estimated, an optimal capturing path of a mobile robot is produced as a result of this research.
In Section 2, the driving characteristics of a mobile robot are analyzed using a kinematics analysis while the mobile robot is making curved motions. The single-curvature trajectory and double-curvature trajectory are described in detail in Section3. In Section4, a curved trajectory formation algorithm, according to a single-curvature trajectory, is introduced with theoretical formulas. Section 5 shows a comparison between a single-curvature and a double-curvature trajectory, with respect to tracking error,in real capturing experiments. Section 6 concludes this paper and provides an agenda for future work.
2. Moving characteristics of a differential driving mobile robot
To form a trajectory for a differential driving mobile robot, a kinematics analysis first needs to be conducted. Based on the kinematics analysis, the driving characteristics of a mobile robot with a differential driving mechanism are modeled, which provides the theoretical basis for trajectory planning.
2.1. Kinematics analysis of the mobile robot
As shown in Fig. 1a, a mobile robot with a differential driving mechanism has two wheels on the same axis, and each wheel is controlled by an independent motor. Let us define vL as the velocity of the left wheel, vR as that of the right wheel, and l as the distance between the two wheels. The robot’s motion can be determined by the two wheel velocities, vL and vR, and the linear and angular velocities, vl and , of the mobile robot can be described in terms of vL and vR as follows :
A kinematics model of a mobile robot with a differential driving mechanism can be described as shown in Fig. 1b.
In two-dimensional X _ Y Cartesian coordinates, the position of the mobile robot is described by (t) and (t), whereas the orientation is represented as (t). Then, and represent the linear velocities, whereas represents the angular velocity. The velocity vector of the mobile robot is defined as
Now, the kinematics model of the mobile robot can be represented
as
2.2. Driving principle of the mobile robot
Through the kinematics analysis, it can be recognized that the motion states of a mobile robot with a differential driving mechanism change according to the velocities of the two wheels. When a robot with multiple wheels rotates about a rotation center instantaneously, this rotation center is defined as the ICC (Instantaneous Center for Curvature). As shown in Fig. 2a, the ICC is located at the cross-section point of the extension-lines of the wheel centers. For a mobile robot with a differential driving mechanism, as shown in Fig. 2b, the ICC can be located at any point on the wheel axis, since the two wheel axes are on the same line. In this case, the ICC will be determined by the velocity ratio between the two wheels. Fig. 3 illustrates the ICC along with the robot’s motion and position. There is a proportional relationship between the wheel velocities and the distance from the wheel to the ICC, which is represented as
In addition, Eq. (5) can be simply represented as：
Note that the rotation radius of the mobile robot is determined by the values of the left and right wheel velocities. When the robot is following a straight line, R =1 and vR = vL. When vR != vL, the robot follows a curved trajectory of a certain rotation radius. Therefore, the velocity and acceleration of the robot is changed if the rotation radius is varied. When the mobile robot is moving from A, where the robot is locatedon at time = t, to B, where the position is
at time = t + d t, the coordinates of the ICC can be dynamically determined as
Also, the mobile robot’s position，at time = t + dt, can
be expressed according to the position of the ICC and the angular velocity, vx, as follows:
，
Now, the total distance, d, and the rotation angle, u, of the mobile robot’s movement from location A to B can be obtained as follows:
Using these equations, when the rotation radius, the distance of movement, and the rotation angle of the mobile robot are determined beforehand, the desired linear and angular velocities, vL, vR, and vx can be dynamically obtained while the robot is moving in a curved path [16].
3. Curvature trajectory
3.1. Curved motion characteristics
The curvature, k, is defined as the ratio of Dh to Ds when a mobile robot is rotating from a point P to Q, as illustrated in Fig. 4. That is, the curvature is defined as [17]
The rotation radius can be defined as the inverse of the curvature,
p=1/k, where k > 0. From Eq. (11), the total traveling distance along the curve, Ds, is the length of the arc and is proportional to the curveradius. Since the curvature, k, is inversely proportional to Ds, the curvature k is also inversely proportional to the curve-radius. If k = 0, then the curve-radius, that is, the rotation radius, becomes infinite. Note that k = 0 implies a straight line, which is a circle of infinite radius.
When the mobile robot is moving along a curved trajectory, the rotation radius has a severe effect on tracking error. Generally, a mobile robot has a smaller chance of error along a straight line (k = 0) than on a curved path (k – 0). Theoretically, a curved trajectory can be calculated with Eqs. (6)–(8), assuming pure-rolling and non-slipping conditions.
However, practical driving might result in some divergences from the theoretical values. When a mobile robot is following a curved path, there are combined centrifugal and centripetal forces. The friction force between the surface and the wheels acts as a centripetal force on the ICC and maintains the curved motion of the mobile robot. Under ideal conditions without slippage, the tracking error becomes zero. However, in practical circumstances, there is always a tracking error caused by slippage. The centrifugal force can be formulated as a function of rotation radius, R, and velocity, v,
where m is the mass of the robot and c is a proportional constant. Fig. 5 illustrates a driving situation of a mobile robot, starting from A and following a curved path. Under ideal conditions, the estimated position of the robot becomes B1. However, in practical circumstances, the robot arrives at B2 via a tracking error. There have been many studies conducted to reduce the tracking error caused by a small rotation radius and high traveling velocity. Fig. 6 shows the error characteristics of a real mobile robot, according to the traveling radius and speed [19]. The speed of the right wheel is maintained at a constant, whereas that of the left wheel is changed in order to move the mobile robot in a curved motion.
With increases of the left wheel velocity, the tracking error increases as well. Also note that the tracking error increases with a small rotation radius even though the speed is kept constant. From an analysis of Fig. 6, it can be concluded that the tracking error of a mobile robot increases with a smaller rotation radius and with a higher speed while the mobile robot is traveling along a curved path.
3.2. Single-curvature trajectory
Fig. 7a and b represent single-curvature and double-curvature trajectories, respectively. The double-curvature trajectory has a symmetrical shape with respect to the point of inflection. The single- curvature trajectory keeps the same curvature, while the double- curvature trajectory changes its traveling direction and curvature at the point of inflection. Fig. 7c represents a trajectory that changes its curvature randomly; that is, the points of inflection exist at several locations. While a mobile robot is moving along the trajectory of Fig. 7c, the wheel velocities need to be changed whenever the rotation radius and traveling direction are changed, according to Eq. (7).
For the same travel distance, Fig. 7a shows the biggest rotation radius, whereas the others have various smaller radii. Therefore, it can be predicted that when a mobile robot is traveling along a single- curvature trajectory, it has the least tracking error. Fig. 8 shows the simulation shapes of single-curvature and double-curvature trajectories.
Using Eqs. (6)–(11), the rotation radius, traveling distance, rotation angle, and location of the ICC are obtained and are presented in Table 1. The total traveling distances are the same for the single-curvature and double-curvature trajectories. However, the rotation radius of the single-curvature trajectory is two times larger than that of the double-curvature trajectory. Specifically, the rotation radius of the single-curvature trajectory is 5.0 m, whereas that of the double-curvature is 2.5 m, which has the point of inflection at (2.5, 2.5). Close observations of Figs. 6 and 7, led to the expectation that the single-curvature trajectory will have a smaller tracking error than the double-curvature trajectory. Through real experiments, the tracking errors of the single-curvature trajectory and double-curvature trajectory can be compared to each other quantitatively.
The orientation of the mobile robot at the final position is not restricted for the double-curvature trajectory since another point of inflection is needed in order to match the orientation of the mobile robot to the single-curvature trajectory.
4. Algorithm for curved trajectory planning
As a typical example for the precise curved motion, the capturing of a moving object by the mobile robot has been demonstrated. This section has proposed an algorithm to produce an optimal trajectory path for capturing a moving object. The proposed algorithm is decomposed into four processes.
4.1. Pre-assumptions
Depending on the states of a moving object and a mobile robot, the optimal trajectory for the mobile robot may be different. Therefore, in this paper, an optimal trajectory for a mobile robot has been planned, which considers the restrictions of the motion of the moving object and the mobile robot.
First, the linear velocity of moving object, , and angular velocity,
;
From Eqs. (14) and (15), the motion of the moving object is limited to a straight-line motion in constant velocity from the initial position. It is assumed that the mobile robot is kept static at the beginning, and it should have the same velocity and orientation as the moving object at the capturing moment. For the optimal path planning of a mobile robot, there are two major factors to be considered: the traveling time and the tracking error. If the mobile robot moves rapidly for the minimum driving time, the tracking error will increase in a curved path. Therefore, the conditions for minimum driving time and smallest tracking error can be obtained within the range of the mobile robot’s linear velocity and
acceleration, which are represented as follows:
where is the maximum allowable linear velocity and is the maximum allowable acceleration.
For the minimum driving time with a given path, the acceleration of a mobile robot is selected at the maximum speed within the range of allowable acceleration. Also, the maximum velocity of the mobile robot is limited to minimize the tracking error within the maximum allowable range.
4.2. Acquisition of the states of a moving object and mobile robot
Since the optimal path of a mobile robot can be created according to the states of a moving object and mobile robot, the states of the mobile robot and the moving object need to be defined precisely for the successful trajectory planning of the mobile robot.
As shown in Fig. 9, the position of a moving object and the mobile robot is defined by two-dimensional X _ Y Cartesian variables, x and y, and an orientation variable, h. Then, the orientation of the moving object, is represented as
The initial position of moving object,, can be represented as
Now, the linear velocity of the moving object, , can be calculated as follows:
The initial position of the mobile robot is represented as
The mission of the mobile robot requires that it start to capture a moving object with a constant velocity from the stationary initial position. If the mobile robot has the same velocity and orientation with the moving object at the final position, it is natural to assume that the moving object will be captured by the mobile robot.
4.3. Determination of path
According to the initial states of the mobile robot and moving object, either a single-curvature or a double-curvature trajectory is going to be selected. The existence condition for the single curvature trajectory is obtained as, which is an interesting observation that arose from this research. As shown in Fig. 10, when the mobile robot moves along the single-curvature trajectory, the tracking error from A to D can be minimized, since the slippage of the curved motion can be minimized.
As a result, the mobile robot can capture the moving object precisely when it has the same velocity and orientation as the moving object. If the trajectory and location of the moving object can be estimated accurately, the expected capturing position, , is obtained as
In that case, the coordinates of C (xC,yC), can be obtained from the initial states of a moving object and the mobile robot as follows:
where (xI,yI) represents the initial position of the moving object. The ICC coordinates of the single-curvature trajectory, , and the rotation radius, R, can be represented as follows:
There are some cases where a single-curvature trajectory cannot be produced, since the trajectory depends on the states of the mobile robot and the moving object. As shown in Fig. 11, if the difference between the orientation angles of a moving object and a mobile robot is non-positive, a single-curvature trajectory cannot satisfy the capturing condition at the final position. In this case, a double-curvature trajectory is selected as the optimal path, instead of a single-curvature one. In such a case, the trajectory of a mobile robot is decomposed into path-1 and path-2. The rotation radius and the coordinates of the ICC are also determined according to the states of the moving object and the mobile robot (see Fig. 12).
From the initial states, the coordinates of ICC1, ,and ICC2, , can be represented as follows:
The rotation radius of Path-1 and Path-2 are selected to be identical to decrease tracking error, and the rotation radius can be represented as
Note that the direction of the mobile robot is changed at the point of inflection in a double-curvature trajectory.
4.4. Design of velocity profile
The velocity of a mobile robot is determined according to the velocity of the moving object and the driving distance to capture the object. In the single-curvature trajectory, the linear velocity of the mobile robot is divided into three sections: acceleration, uniform velocity, and deceleration. The linear velocity of the mobile robot can be represented as follows:
where T is the total driving time of the mobile robot.
From the kinematics of a mobile robot, the wheel velocities, and , and the angular velocity of the mobile robot, , are determined as follows:
For the double-curvature trajectory, two velocity profiles are necessary. That is, at the point of inflection, the mobile robot
收藏