CN113608529A - Wheel type mobile platform motion track preview tracking control system and method - Google Patents
Wheel type mobile platform motion track preview tracking control system and method Download PDFInfo
- Publication number
- CN113608529A CN113608529A CN202110825317.9A CN202110825317A CN113608529A CN 113608529 A CN113608529 A CN 113608529A CN 202110825317 A CN202110825317 A CN 202110825317A CN 113608529 A CN113608529 A CN 113608529A
- Authority
- CN
- China
- Prior art keywords
- point
- mobile platform
- aiming
- control
- wheel type
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000007246 mechanism Effects 0.000 claims abstract description 18
- 238000004364 calculation method Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 4
- 230000001105 regulatory effect Effects 0.000 claims description 4
- 238000004891 communication Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 238000004590 computer program Methods 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008685 targeting Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种轮式移动平台运动轨迹预瞄跟踪控制系统、方法。该系统包括车载定位装置、运动参考曲线生成器、预瞄准量调节器和处理器，首先加载车载定位装置的定位位姿、运动参考曲线生成器的路径方程、预瞄准量调节器的调整量数据，并将数据输入处理器；利用定位位姿、路径方程、调整量数据计算轮式移动平台预瞄点位姿误差；利用轮式移动平台与目标点的剩余路程规划当前点的线速度和角速度；根据预瞄点位姿误差、规划的线速度与角速度计算轮式移动平台运动的控制线速度和控制角速度；再将控制线速度和控制角速度作为轮式移动平台的当前控制值，输入给执行机构单元，调整轮式移动平台的位姿，达到目标姿态，提高轮式移动平台行走的控制精度。
The invention discloses a motion trajectory preview tracking control system and method of a wheeled mobile platform. The system includes an on-board positioning device, a motion reference curve generator, a pre-aiming amount adjuster and a processor. First, the positioning pose of the on-board positioning device, the path equation of the motion reference curve generator, and the adjustment amount data of the pre-aiming amount adjuster are loaded. , and input the data into the processor; use the positioning pose, path equation, and adjustment data to calculate the position and attitude error of the preview point of the wheeled mobile platform; use the remaining distance between the wheeled mobile platform and the target point to plan the linear velocity and angular velocity of the current point ; Calculate the control linear speed and control angular speed of the wheeled mobile platform movement according to the position and attitude error of the preview point, the planned linear speed and angular speed; then use the control linear speed and control angular speed as the current control value of the wheeled mobile platform and input it to the execution The mechanism unit adjusts the posture of the wheeled mobile platform to achieve the target posture and improves the control accuracy of the wheeled mobile platform.
Description
Technical Field
The invention belongs to the technical field of automatic control, and particularly relates to a wheel type mobile platform motion track preview tracking control system and method.
Background
The method is a wheel type mobile platform based on a trackless navigation mode, and is the most important navigation mode of autonomous navigation equipment such as an AGV intelligent vehicle, an inspection robot and the like. Compared with the rail magnetic navigation, the autonomous mobile platform provided with the trackless navigation system moves more flexibly and is more suitable for a flexible production line for ordinary adjustment of process flows.
In laser or visual navigation wheeled mobile platform devices, a reference curve is often used to guide the vehicle to move to a target location.
Referring to the attached figure 5 of the specification, in the prior art, a closest point trajectory tracking control technology is generally adopted to regulate and control the pose of a wheel type moving platform. The track tracking control technology firstly determines the position of the wheeled mobile platform in an absolute coordinate system according to positioning devices such as laser or vision, then calculates the point of the center point of the wheeled mobile platform, which is closest to a reference curve, as a reference point for calculating the regulation and control of the pose error, and then controls the error by a motion controller, so that the wheeled mobile platform can track the reference curve.
The error calculation method is a pure ideal state, namely, the positioning device has no delay, and the driving mechanism has no delay. However, it is obviously difficult to meet the requirement for most of the existing wheeled mobile platforms. In order to enable the existing wheel-type moving platform to accurately track the track, the most effective wheel-type moving platform position and pose calculation should have a certain prediction function.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provides a wheel type mobile platform motion track preview tracking control system and a wheel type mobile platform motion track preview tracking control method. For a given reference path, the pre-aiming pose deviation of the wheeled mobile platform relative to the reference curve can be calculated according to a parameter equation of the reference curve, the current pose and the pre-aiming distance of the wheeled mobile platform, and then the pre-aiming pose deviation is transmitted to a track tracking control system of the wheeled mobile platform, so that the walking control precision of the wheeled mobile platform is improved.
The invention is realized by the following technical scheme:
a wheel type mobile platform motion trail preview tracking control system comprises a vehicle-mounted preview control device and an actuating mechanism unit, wherein the vehicle-mounted preview control device and the actuating mechanism unit are arranged on a wheel type mobile platform;
the vehicle-mounted pre-aiming control equipment comprises a vehicle-mounted positioning device, a motion reference curve generator, a pre-aiming amount regulator, a processor, a data memory and a program memory, wherein the vehicle-mounted positioning device is used for measuring the current pose of the wheeled mobile platform, the motion reference curve generator is used for generating a path which can be executed by the wheeled mobile platform, the pre-aiming amount regulator is used for dynamically regulating the aiming distance according to the linear speed of the wheeled mobile platform, the program memory stores a pre-aiming point pose error resolving and control program, the data memory is used as an intermediate data carrier generated in the running process of the pre-aiming point pose error resolving and control program, and the program memory and the data memory are both in communication connection with the processor so as to calculate the current pre-aiming point pose error, control line speed and control angular speed of the wheeled mobile platform; the processor is connected with the execution mechanism unit, and the execution mechanism unit drives the wheel type mobile platform to move according to the control linear velocity and the control angular velocity output by the processor.
In the technical scheme, the processor comprises a pre-aiming point pose error calculation unit, a motion control unit, a speed planning unit and a speed feedback unit, wherein the pre-aiming point pose error calculation unit is used for calculating the pre-aiming point pose error of the wheel type mobile platform according to the wheel type mobile platform positioning pose provided by the vehicle-mounted positioning device, the path curve equation provided by the motion reference curve generator and the adjustment data provided by the pre-aiming amount adjuster; the speed feedback unit is used for feeding the current speed data of the wheel type mobile platform back to the speed planning unit; the speed planning unit plans the linear speed and the angular speed of the current point on the basis of the current speed data fed back by the speed feedback unit according to the remaining distance between the wheeled mobile platform and the target point; and the motion control unit calculates the track control data of the counter wheel type moving platform according to the pre-aiming point pose error and the planned linear velocity and angular velocity, and transmits the track control data to the actuating mechanism unit.
In the above technical solution, the vehicle-mounted positioning device outputs the current pose of the wheel-type moving platform center point P: p ═ a, b, θ, where a is the abscissa of the wheel center point P in the absolute coordinate system XOY, b is the ordinate of the wheel center point P in the absolute coordinate system XOY, and θ is X of the following coordinate system0The angle between the axis (i.e. the forward direction of the wheeled mobile platform) and the X-axis of the absolute coordinate system.
In the technical scheme, the motion reference curve generator outputs a curve equation F (t) of a feasible path of the wheel type mobile platform in an absolute coordinate system,
α refers to the upper bound of t, β refers to the lower bound of t.
In the technical scheme, the pre-aiming amount regulator outputs the pre-aiming adjustment amount delta L of the wheel type moving platform, wherein the delta L is the arc length from a point Q to a point R, the point Q is the closest point of the center point P of the wheel type moving platform on a distance curve equation, and the point R is the pre-aiming point on the curve equation.
In the above technical solution, the method for solving the pre-aiming point pose error is as follows:
suppose 1, the equation parameter corresponding to point Q on curve equation F (t) is tQ；
Suppose 2, the equation parameter corresponding to the point R on the curve equation F (t) is tR；
Assume 3 that, for curve equation F (t), the arc length between any two points is represented as L (t)1，t2)，L(t1，t2) The gaussian-legendre integration method is applied to calculate the following:
in the formula, ωiIs the integral coefficient, τiIs a Gaussian point, t1,t2∈[α,β]。
By iterating continuously on the parameter tQAnd tRSo that
And L (t)Q,tR)≈ΔL，
Is a vector pointing the line between P and point Q, F (t)Q) ' refers to the tangent vector at point Q: f (t)Q)′＝[x′(tQ),y′(tQ)]；
Then, the parameter t can be obtainedQAnd tRExpressed as
And
therefore, the calculation formula of the pre-aiming point pose error is as follows:
wherein:
EPRis a pre-aiming point pose error representation, EPR＝(xe,ye,θe)，xeIs the abscissa deviation value y from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeIs the vertical coordinate deviation amount theta from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeThe angular deviation value between the angular pose of the current wheeled mobile platform and the direction angle of the vector of the R-cut pre-aiming point on the motion reference curve in the absolute coordinate system;
p is the current pose representation of the wheel center point P, where a is the abscissa of the wheel center point P in the absolute coordinate system XOY, and b is the ordinate of the wheel center point P in the absolute coordinate system XOYAnd theta is X of the following coordinate system0The angle between the axis (i.e. the forward direction of the wheeled mobile platform) and the X-axis of the absolute coordinate system.
In the above technical solution, the position and pose of the wheel-type mobile platform is regulated according to the position and pose error of the pre-aiming point, and the obtained control law of the wheel-type mobile platform is as follows:
in the formula, vrIs the planned linear speed value of the robot, which is obtained by the distance from the point Q to the terminal point T and the speed constraint, omegarIs the planned angular velocity, omega, of the robotrBy vrMultiplied by the curvature of the Q point, [ v, [ omega ]]TIs the linear and angular velocity control quantity, the control parameter k1＞0，k2＞0，k3＞0。
A motion trail preview tracking control method comprises the following steps:
s100: loading the positioning pose of the vehicle-mounted positioning device, a path equation of the motion reference curve generator and the adjustment data of the pre-aiming quantity adjuster, and inputting the data into the processor;
s200: calculating the pre-aiming point position error of the wheel type mobile platform by using the positioning position, the path equation and the adjustment data;
s300: planning the linear velocity and the angular velocity of the current point by using the remaining distance between the wheeled mobile platform and the target point;
s400: calculating a control linear velocity and a control angular velocity of the motion of the wheeled mobile platform according to the pointing position error of the pre-pointing point, the planned linear velocity and the planned angular velocity;
s500: and the control linear velocity and the control angular velocity are used as current control values of the wheel type mobile platform and are input to the execution mechanism unit, and the pose of the wheel type mobile platform is adjusted to achieve the target pose.
The invention has the advantages and beneficial effects that:
the invention calls a prealignment point pose error resolving and controlling program in the program memory through the processor, thereby calculating the prealignment point pose error, the control linear velocity and the control angular velocity of the wheel type mobile platform at the current position. The processor takes the control linear velocity and the control angular velocity as the current control values of the wheel type mobile platform, inputs the current control values to the execution mechanism unit, adjusts the pose of the wheel type mobile platform, achieves the target pose, and improves the control precision of the walking of the wheel type mobile platform.
Drawings
FIG. 1 is a schematic diagram of a wheel-type mobile platform motion trajectory preview tracking control system;
FIG. 2 is a connection block diagram of the vehicle-mounted pre-aiming control device and the actuating mechanism unit in the invention;
FIG. 3 is a schematic diagram of the control of pre-targeting trajectory tracking according to the present invention;
FIG. 4 is a flow chart of a control method for preview tracking of a motion trajectory according to the present invention;
fig. 5 is a schematic diagram of a control method for tracking a nearest point trajectory in the related art.
Reference numerals: 1. a vehicle-mounted positioning device; 2. a motion reference curve generator; 3. a pre-aiming amount adjuster; 4. a processor; 5. a data storage; 6. a program memory; 7. an actuator unit.
For a person skilled in the art, other relevant figures can be obtained from the above figures without inventive effort.
Detailed Description
In order to make the technical solution of the present invention better understood, the technical solution of the present invention is further described below with reference to specific examples.
Referring to fig. 1 and fig. 2, the wheel type mobile platform motion trajectory preview tracking control system disclosed by the invention comprises a vehicle-mounted preview control device and an execution mechanism unit 7 which are arranged on the wheel type mobile platform.
The vehicle-mounted pre-aiming control equipment comprises a vehicle-mounted positioning device 1, a motion reference curve generator 2, a pre-aiming amount regulator 3, a processor 4, a data memory 5 and a program memory 6, wherein the vehicle-mounted positioning device 1 is used for measuring the current pose of the wheeled mobile platform, the motion reference curve generator 2 is used for generating a path which can be executed by the wheeled mobile platform, the pre-aiming amount regulator 3 is used for dynamically adjusting the aiming distance according to the linear speed of the wheeled mobile platform, the program memory 6 is stored with a pre-aiming point pose error resolving and control program, the data memory 5 is used as an intermediate data carrier generated in the running process of the pre-aiming point pose error resolving and control program, and the program memory 6 and the data memory 5 are both in communication connection with the processor 4, calculating the current pre-aiming point pose error, control linear velocity and control angular velocity of the wheel type mobile platform; the processor 4 is connected with an actuator unit 7, and the actuator unit 7 can drive the wheel type mobile platform to move according to the control linear velocity and the control angular velocity output by the processor 5.
To explain the motion of the wheeled mobile platform, the concepts of an absolute coordinate system and a following coordinate system need to be introduced, referring to fig. 3, the absolute coordinate system is an XOY plane, and the following coordinate system X is a following coordinate system0PY0Taking the central point P of the wheel type moving platform as the origin, and establishing X in the forward direction of the wheel type moving platform0Axes on which Y is established according to the right-hand rule0The axes form a coordinate system.
The vehicle-mounted positioning device 1 outputs the position and posture of the central point P of the wheel type moving platform: p ═ a, b, θ, where a is the abscissa of the wheel center point P in the absolute coordinate system, b is the ordinate of the wheel center point P in the absolute coordinate system, and θ is X0The angle between the axis (i.e. the forward direction of the wheeled mobile platform) and the X-axis of the absolute coordinate system.
The motion reference curve generator 2 outputs a curve equation F (t) of the feasible path of the wheel type mobile platform in the absolute coordinate system,
α refers to the upper bound of t, β refers to the lower bound of t.
The pre-aiming quantity regulator 3 outputs a pre-aiming regulating quantity delta L of the wheel type moving platform, wherein the delta L is the arc length from a point Q to a point R, the point Q is the closest point of the center point P of the wheel type moving platform to the curve equation, and the point R is the pre-aiming point on the curve equation.
Then, the method for solving the pre-aiming point pose error is as follows:
suppose 1, the equation parameter corresponding to point Q on curve equation F (t) is tQ；
Suppose 2, the equation parameter corresponding to the point R on the curve equation F (t) is tR；
Assume 3 that, for curve equation F (t), the arc length between any two points is represented as L (t)1,t2)，L(t1,t2) The gaussian-legendre integration method is applied to calculate the following:
in the formula, ωiIs the integral coefficient, τiIs a Gaussian point, parameter t1,t2Represents the parameters corresponding to two endpoints of the arc on the curve and t1,t2∈[α,β]。
By iterating continuously on the parameter tQAnd tRSo that
And L (t)Q,tR)≈ΔL，
Is a vector pointing the line between P and point Q, F (t)Q) ' refers to the tangent vector at point Q: f (t)Q)′＝[x′(tQ),y′(tQ)]；
Then, the parameter t can be obtainedQAnd tRExpressed as
And
therefore, the calculation formula of the pre-aiming point pose error is as follows:
wherein: ePRIs a pre-aiming point pose error representation, EPR＝(xe,ye,θe)，xeIs the abscissa deviation value y from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeIs the vertical coordinate deviation amount theta from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeThe angular deviation value from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate system;
is a pose representation of the pre-aiming point R on the motion reference curve,
xRis the abscissa, y, of the pre-aiming point R in an absolute coordinate systemRIs the ordinate, theta, of the pre-aiming point R in an absolute coordinate systemRIs the included angle between the tangential direction of the pre-aiming point R in the absolute coordinate system and the X axis of the absolute coordinate system; p is the current pose representation of the wheel type mobile platform central point P, and P is equal to(a, b, theta), wherein a is the abscissa of the center point P of the wheel-type moving platform in the absolute coordinate system XOY, b is the ordinate of the center point P of the wheel-type moving platform in the absolute coordinate system XOY, and theta is X of the following coordinate system0The angle between the axis (i.e. the forward direction of the wheeled mobile platform) and the X-axis of the absolute coordinate system.
Further, the processor 4 includes a pre-aiming point pose error calculation unit, a motion control unit, a velocity planning unit, and a velocity feedback unit (see fig. 1). The pre-aiming point position error calculation unit is used for calculating the wheel type mobile platform pre-aiming point position error E according to the wheel type mobile platform positioning position provided by the vehicle-mounted positioning device 1, the path curve equation provided by the motion reference curve generator 2 and the adjustment data provided by the pre-aiming amount adjuster 3PR(ii) a The speed feedback unit is used for feeding the current speed data of the wheel type mobile platform back to the speed planning unit; the speed planning unit plans the linear speed and the angular speed of the current point on the basis of the current speed information fed back by the speed feedback unit according to the remaining distance between the wheeled mobile platform and the target point; the motion control unit is used for carrying out pose regulation and control on the wheel type mobile platform according to the pose error of the pre-aiming point, is a core unit for realizing the accurate tracking of the wheel type mobile platform on a reference curve, and obtains the control law of the wheel type mobile platform according to the kinematics law and the Lyapunov stability theorem as follows:
in the formula, vrIs the planned linear speed value of the robot, which is obtained by the distance from the point Q to the terminal point T and the speed constraint, omegarIs the planned angular velocity, omega, of the robotrBy vrMultiplied by the curvature of the Q point, [ v, [ omega ]]TIs the linear and angular velocity control quantity, the control parameter k1＞0，k2＞0，k3Is greater than 0. Will EPR、[vr,ωr]TAnd (4) carrying the above formula, obtaining the track control data of the wheel type mobile platform, and transmitting the track control data to the actuating mechanism unit.
Referring to fig. 4, a method for controlling a preview tracking of a motion trajectory according to the present invention includes the following steps:
s100: and loading the positioning pose of the vehicle-mounted positioning device 1, the path equation of the motion reference curve generator 2 and the adjustment data of the pre-aiming quantity adjuster 3, and inputting the data into the processor 4.
S200: and calculating the pre-aiming point position error of the wheel type mobile platform by using the positioning position, the path equation and the adjustment data.
S300: and planning the linear speed and the angular speed of the current point by using the remaining distance between the wheeled mobile platform and the target point.
S400: and calculating the control linear velocity and the control angular velocity of the motion of the wheeled mobile platform according to the pointing position error of the pre-pointing point, the planned linear velocity and the planned angular velocity.
S500: the control linear velocity and the control angular velocity are used as current control values of the wheel type moving platform and input to the execution mechanism unit 7, and the pose of the wheel type moving platform is adjusted to achieve the target pose.
The invention also discloses a computer readable storage medium, on which a computer program is stored, wherein the computer program is a preview point pose error resolving and controlling program, and when the computer program is executed by the processor 4, the preview tracking control method of the motion trail of the wheeled mobile platform disclosed by the invention can be realized.
Spatially relative terms, such as "upper," "lower," "left," "right," and the like, may be used in the embodiments for ease of description to describe one element or feature's relationship to another element or feature as illustrated in the figures. It will be understood that the spatial terms are intended to encompass different orientations of the device in use or operation in addition to the orientation depicted in the figures. For example, if the device in the figures is turned over, elements described as "below" other elements or features would then be oriented "above" the other elements or features. Thus, the exemplary term "lower" can encompass both an upper and a lower orientation. The device may be otherwise oriented (rotated 90 degrees or at other orientations) and the spatially relative descriptors used herein interpreted accordingly.
Moreover, relational terms such as "first" and "second," and the like, may be used solely to distinguish one element from another element having the same name, without necessarily requiring or implying any actual such relationship or order between such elements.
The invention has been described in an illustrative manner, and it is to be understood that any simple variations, modifications or other equivalent changes which can be made by one skilled in the art without departing from the spirit of the invention fall within the scope of the invention.
Claims (7)
1. The utility model provides a wheeled moving platform motion trail preview tracking control system which characterized in that: the device comprises a vehicle-mounted pre-aiming control device and an actuating mechanism unit which are arranged on a wheel type mobile platform;
the vehicle-mounted pre-aiming control equipment comprises a vehicle-mounted positioning device, a motion reference curve generator, a pre-aiming amount regulator, a processor, a data memory and a program memory, wherein the vehicle-mounted positioning device is used for measuring the current pose of the wheeled mobile platform, the motion reference curve generator is used for generating a path which can be executed by the wheeled mobile platform, the pre-aiming amount regulator is used for dynamically regulating the aiming distance according to the linear speed of the wheeled mobile platform, the program memory stores a pre-aiming point pose error resolving and control program, the data memory is used as an intermediate data carrier generated in the running process of the pre-aiming point pose error resolving and control program, and the program memory and the data memory are both in communication connection with the processor so as to calculate the current pre-aiming point pose error, control line speed and control angular speed of the wheeled mobile platform; the processor is connected with the execution mechanism unit, and the execution mechanism unit drives the wheel type mobile platform to move according to the control linear velocity and the control angular velocity output by the processor.
2. The wheeled mobile platform motion trail preview tracking control system according to claim 1, characterized in that: the processor comprises a pre-aiming point pose error calculation unit, a motion control unit, a speed planning unit and a speed feedback unit, wherein the pre-aiming point pose error calculation unit is used for calculating the wheel type mobile platform pre-aiming point pose error according to the wheel type mobile platform positioning pose provided by the vehicle-mounted positioning device, a path curve equation provided by the motion reference curve generator and adjustment data provided by the pre-aiming amount regulator; the speed feedback unit is used for feeding the current speed data of the wheel type mobile platform back to the speed planning unit; the speed planning unit plans the linear speed and the angular speed of the current point on the basis of the current speed data fed back by the speed feedback unit according to the remaining distance between the wheeled mobile platform and the target point; and the motion control unit calculates the track control data of the counter wheel type moving platform according to the pre-aiming point pose error and the planned linear velocity and angular velocity, and transmits the track control data to the actuating mechanism unit.
3. The wheeled mobile platform motion trail preview tracking control system according to claim 1, characterized in that: and the vehicle-mounted positioning device outputs the current pose of the central point P of the wheel type mobile platform.
4. The wheeled mobile platform motion trail preview tracking control system of claim 3, wherein: the motion reference curve generator outputs a curve equation F (t) of the feasible path of the wheel type moving platform in the absolute coordinate system.
5. The wheeled mobile platform motion trail preview tracking control system of claim 4, wherein: the pre-aiming amount regulator outputs a pre-aiming adjustment amount delta L of the wheel type moving platform, wherein the delta L is the arc length from a point Q to a point R, the point Q is the closest point of a central point P of the wheel type moving platform to a curve equation, and the point R is a pre-aiming point on the curve equation; the method for solving the pose error of the pre-aiming point comprises the following steps:
suppose 1, the equation parameter corresponding to point Q on curve equation F (t) is tQ；
Suppose 2, the equation parameter corresponding to the point R on the curve equation F (t) is tR；
Assume 3 that, for curve equation F (t), the arc length between any two points is represented as L (t)1，t2)，L(t1，t2) Calculating by using a Gauss-Legendre integral method;
by iterating continuously on the parameter tQAnd tRSo that
And L (t)Q，tR)≈ΔL，
Is a vector pointing the line between P and point Q, F (t)Q) ' refers to the tangent vector at point Q: f (t)Q)′＝[x′(tQ)，y′(tQ)]；
Then, the parameter t can be obtainedQAnd tRExpressed as
And
therefore, the calculation formula of the pre-aiming point pose error is as follows:
wherein:
EPRis a pre-aiming point pose error representation, EPR＝(xe，ye，θe)，xeIs the abscissa deviation value y from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeIs the vertical coordinate deviation amount theta from the current wheel type moving platform center point P to the pre-aiming point R on the motion reference curve in the absolute coordinate systemeThe angular deviation value between the angular pose of the current wheeled mobile platform and the direction angle of the vector of the R-cut pre-aiming point on the motion reference curve in the absolute coordinate system;
and P is the current pose representation of the center point P of the wheel type moving platform, and P is (a, b, theta), wherein a is the abscissa of the center point P of the wheel type moving platform in the absolute coordinate system XOY, b is the ordinate of the center point P of the wheel type moving platform in the absolute coordinate system XOY, and theta is the included angle between the advancing direction of the wheel type moving platform and the X axis of the absolute coordinate system.
6. The wheeled mobile platform motion trail preview tracking control system of claim 5, wherein: and (3) carrying out pose regulation and control on the wheel type mobile platform according to the pose error of the pre-aiming point, wherein the obtained control law of the wheel type mobile platform is as follows:
in the formula, vrIs the planned linear speed value of the robot, which is obtained by the distance from the point Q to the terminal point T and the speed constraint, omegarIs the planned angular velocity, omega, of the robotrBy vrMultiplied by the curvature of the Q point, [ v, [ omega ]]TIs the linear and angular velocity control quantity, the control parameter k1＞0，k2＞0，k3＞0。
7. A motion trail preview tracking control method is characterized by comprising the following steps:
s100: loading the positioning pose of the vehicle-mounted positioning device, a path equation of the motion reference curve generator and the adjustment data of the pre-aiming quantity adjuster, and inputting the data into the processor;
s200: calculating the pre-aiming point position error of the wheel type mobile platform by using the positioning position, the path equation and the adjustment data;
s300: planning the linear velocity and the angular velocity of the current point by using the remaining distance between the wheeled mobile platform and the target point;
s400: calculating a control linear velocity and a control angular velocity of the motion of the wheeled mobile platform according to the pointing position error of the pre-pointing point, the planned linear velocity and the planned angular velocity;
s500: and the control linear velocity and the control angular velocity are used as current control values of the wheel type mobile platform and are input to the execution mechanism unit, and the pose of the wheel type mobile platform is adjusted to achieve the target pose.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110825317.9A CN113608529B (en) | 2021-07-21 | 2021-07-21 | Wheel type mobile platform motion trail pre-aiming tracking control system and method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110825317.9A CN113608529B (en) | 2021-07-21 | 2021-07-21 | Wheel type mobile platform motion trail pre-aiming tracking control system and method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113608529A true CN113608529A (en) | 2021-11-05 |
| CN113608529B CN113608529B (en) | 2024-08-23 |
Family
ID=78305028
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110825317.9A Active CN113608529B (en) | 2021-07-21 | 2021-07-21 | Wheel type mobile platform motion trail pre-aiming tracking control system and method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113608529B (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114137972A (en) * | 2021-11-24 | 2022-03-04 | 广州小鹏自动驾驶科技有限公司 | Route generation method, apparatus, vehicle and storage medium |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110244735A (en) * | 2019-06-24 | 2019-09-17 | 安徽农业大学 | A Heuristic Dynamic Programming Control Method for Mobile Robots Tracking Predetermined Trajectories |
| CN111596671A (en) * | 2020-06-23 | 2020-08-28 | 青岛科技大学 | An unmanned intelligent sweeper trajectory tracking control method and system |
| CN112051864A (en) * | 2019-06-06 | 2020-12-08 | 北京京东尚科信息技术有限公司 | Method, device, equipment and readable medium for tracking moving target track |
| CN112109732A (en) * | 2020-09-03 | 2020-12-22 | 南京理工大学 | An adaptive curve preview method for intelligent driving |
| CN112486176A (en) * | 2020-12-02 | 2021-03-12 | 吉林大学 | Unmanned frame vehicle track tracking control method considering disturbance |
| CN112731932A (en) * | 2020-12-24 | 2021-04-30 | 哈尔滨工业大学芜湖机器人产业技术研究院 | Path tracking method of mobile robot |
-
2021
- 2021-07-21 CN CN202110825317.9A patent/CN113608529B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112051864A (en) * | 2019-06-06 | 2020-12-08 | 北京京东尚科信息技术有限公司 | Method, device, equipment and readable medium for tracking moving target track |
| CN110244735A (en) * | 2019-06-24 | 2019-09-17 | 安徽农业大学 | A Heuristic Dynamic Programming Control Method for Mobile Robots Tracking Predetermined Trajectories |
| CN111596671A (en) * | 2020-06-23 | 2020-08-28 | 青岛科技大学 | An unmanned intelligent sweeper trajectory tracking control method and system |
| CN112109732A (en) * | 2020-09-03 | 2020-12-22 | 南京理工大学 | An adaptive curve preview method for intelligent driving |
| CN112486176A (en) * | 2020-12-02 | 2021-03-12 | 吉林大学 | Unmanned frame vehicle track tracking control method considering disturbance |
| CN112731932A (en) * | 2020-12-24 | 2021-04-30 | 哈尔滨工业大学芜湖机器人产业技术研究院 | Path tracking method of mobile robot |
Non-Patent Citations (4)
| Title |
|---|
| HUA LIU, ET AL,: "Trajectory Tracking Control of Differential Driving Double-Wheeled Mobile Robot", 《ICETCI)》, 1 November 2022 (2022-11-01), pages 943 - 947 * |
| 聂枝根;王万琼;赵伟强;黄震;宗长富;: "基于轨迹预瞄的智能汽车变道动态轨迹规划与跟踪控制", 交通运输工程学报, no. 02, 15 April 2020 (2020-04-15), pages 151 - 164 * |
| 赵凯;朱愿;冯明月;苏致远;郭宏达;: "基于多点序列预瞄的自动驾驶汽车路径跟踪算法研究", 汽车技术, no. 11, 30 July 2018 (2018-07-30), pages 5 - 9 * |
| 阮久宏;李贻斌;杨福广;荣学文;: "无人驾驶高速4WID-4WIS车辆路径跟踪单点预瞄控制", 重庆大学学报, no. 10, 15 October 2011 (2011-10-15), pages 25 - 30 * |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114137972A (en) * | 2021-11-24 | 2022-03-04 | 广州小鹏自动驾驶科技有限公司 | Route generation method, apparatus, vehicle and storage medium |
| CN114137972B (en) * | 2021-11-24 | 2023-10-31 | 广州小鹏自动驾驶科技有限公司 | Path generation method, device, vehicle and storage medium |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113608529B (en) | 2024-08-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Li et al. | Development of a new integrated local trajectory planning and tracking control framework for autonomous ground vehicles | |
| Pecora et al. | A loosely-coupled approach for multi-robot coordination, motion planning and control | |
| CN112518753A (en) | Industrial robot trajectory tracking system and method based on neural network iterative compensation | |
| CN113625702B (en) | Simultaneous path tracking and obstacle avoidance method for unmanned vehicles based on quadratic planning | |
| US20240227793A1 (en) | Adaptive path following algorithm for heavy-duty vehicles | |
| BR112017022955B1 (en) | Computer-readable non-transient system, method and means for calculating a drivable trajectory plan for an autonomous vehicle and computer-readable non-transient system, method and means for controlling an autonomous vehicle | |
| CN108196554A (en) | A kind of AGV Integrated guidance systems based on magnetic inductor and gyroscope | |
| CN113126644A (en) | Unmanned aerial vehicle three-dimensional track tracking method based on adaptive line-of-sight method | |
| Oliveira et al. | Trajectory generation using sharpness continuous dubins-like paths with applications in control of heavy-duty vehicles | |
| CN115236973A (en) | AGV trajectory tracking control method based on PSO Lyapunov function | |
| CN114442491A (en) | Local path planning and tracking control method, device and medium for indoor robot | |
| CN110900613A (en) | Non-stop control method and system for mobile robot | |
| CN111487976A (en) | A reversing trajectory tracking method | |
| Liu et al. | An improved hybrid error control path tracking intelligent algorithm for omnidirectional AGV on ROS | |
| CN113608529B (en) | Wheel type mobile platform motion trail pre-aiming tracking control system and method | |
| Shin et al. | Explicit path tracking by autonomous vehicles | |
| CN113885514B (en) | AGV path tracking method and system based on fuzzy control and geometric tracking | |
| CN112731915A (en) | Direct track control method for optimizing NMPC algorithm based on convolutional neural network | |
| CN112486018B (en) | Model-free unmanned vehicle path tracking method based on speed adaptive preview | |
| CN113110500B (en) | Transverse control method for low-speed automatic parking of automatic-driving automobile | |
| Bacha et al. | Autonomous vehicle path tracking using nonlinear steering control and input-output state feedback linearization | |
| CN111830980B (en) | Laser navigation path following method | |
| CN115729241A (en) | Heavy-load AGV double-vehicle linkage motion control method and device | |
| CN114291117A (en) | Four-wheel steering unmanned vehicle trajectory tracking control method | |
| Avanzini et al. | A control strategy taking advantage of inter-vehicle communication for platooning navigation in urban environment |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |