CN113848905A - Mobile robot trajectory tracking method based on neural network and adaptive control - Google Patents
Mobile robot trajectory tracking method based on neural network and adaptive control Download PDFInfo
- Publication number
- CN113848905A CN113848905A CN202111121940.2A CN202111121940A CN113848905A CN 113848905 A CN113848905 A CN 113848905A CN 202111121940 A CN202111121940 A CN 202111121940A CN 113848905 A CN113848905 A CN 113848905A
- Authority
- CN
- China
- Prior art keywords
- wmrs
- vector
- representing
- control
- motion
- 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 35
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 11
- 230000003044 adaptive effect Effects 0.000 title claims description 5
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000006870 function Effects 0.000 claims description 14
- 238000005457 optimization Methods 0.000 claims description 7
- 230000005484 gravity Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 claims description 3
- 230000007613 environmental effect Effects 0.000 claims description 3
- 210000002569 neuron Anatomy 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 230000001131 transforming effect Effects 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 2
- 230000009286 beneficial effect Effects 0.000 abstract description 4
- 230000000694 effects Effects 0.000 description 6
- 238000004422 calculation algorithm Methods 0.000 description 5
- 239000002245 particle Substances 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
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)
- Feedback Control In General (AREA)
Abstract
The invention discloses a mobile robot trajectory tracking method based on a neural network and self-adaptive control, which comprises the steps of firstly carrying out dynamics and kinematics modeling on WMRs under the conditions of incomplete constraint and speed limitation constraint; next, adopting an MPC method to realize track tracking under speed limitation; then fitting a kinetic equation of WMRs parameters by using an RBF network, and designing a control law based on an MRAC method; and finally, realizing accurate track tracking of the WMRs according to a designed control law. The invention can realize the motion control of the WMRs under specific conditions, improves the track tracking and anti-interference capability of the WMRs under special working conditions, and is beneficial to expanding the working space of the WMRs.
Description
Technical Field
The invention belongs to the technical field of robots, and particularly relates to a mobile robot trajectory tracking method.
Background
Robotics is an important branch in the field of automation and control, and has found wide application in industrial production and daily life. Robots can be divided into two major categories, namely fixed robots and mobile robots, wherein the mobile robots move in the environment by using wheels or 'simulated legs', and the application range and the working radius of the robot are greatly improved compared with those of the fixed robots. Wheeled Mobile Robots (WMRs) are the most common type of Mobile Robots in daily life, play an important role in military, civil and scientific exploration, and can perform information acquisition and processing tasks instead of people even in some severe environments (such as planet exploration, earthquake relief and the like). Currently, exploring the autonomous movement of WMRs in a complex dynamic environment is a hot topic of research.
The trajectory tracking is the basis of autonomous movement, and aims to control the WMRs to quickly and stably track one or more curves which are planned in advance and take time as a variable function by a reasonably designed controller. The traditional method for solving WMRs trajectory tracking comprises PID control, backstepping control, sliding mode control or self-adaptive control and the like, which all achieve good tracking effect, but when the conditions of non-integrity constraint, unknown dynamic model parameters, limited motion speed and the like exist, the ideal tracking effect is often not achieved. In recent years, with the development of artificial intelligence, a Model-Reference Adaptive Control (MRAC) technology which integrates the strong function fitting capability of a neural network has a good application effect in the Control field, realizes end-to-end information perception and intelligent Control facing complex environments, and provides a new idea for solving the problem of trajectory tracking of complex nonlinear systems.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention provides a mobile robot track tracking method based on a neural network and self-adaptive control, firstly, the WMRs are subjected to dynamics and kinematics modeling under the conditions of incomplete constraint and speed limitation constraint; next, adopting an MPC method to realize track tracking under speed limitation; then fitting a kinetic equation of WMRs parameters by using an RBF network, and designing a control law based on an MRAC method; and finally, realizing accurate track tracking of the WMRs according to a designed control law. The invention can realize the motion control of the WMRs under specific conditions, improves the track tracking and anti-interference capability of the WMRs under special working conditions, and is beneficial to expanding the working space of the WMRs.
The technical scheme adopted by the invention for solving the technical problem comprises the following steps:
step 1: performing dynamics and kinematics modeling on the WMRs under the conditions of incomplete constraint and speed limitation constraint;
setting the radius of a wheel of WMRs as r, the distance between two driving wheels as 2b, the center of the distance between the two wheels as a point G, the center of mass of the WMRs is concentrated on a point C, the mass of the WMRs is m, the moment of inertia of the WMRs is J, and the distance between the point C and the point G is d; the global coordinate system xoy is a Cartesian inertial coordinate system for WMRs to move in, is used for representing environmental information and corresponds to a global environment map; local coordinate system xccycThe center of mass C of the WMRs is used as an origin, and the direction with the forward linear velocity of the movement of the center of mass of the WMRs as upsilon is cxcA shaft; the rotation angular velocity of the mass center motion of WMRs is omega, the direction of upsilon and cxcThe axes are always in the same direction, and the included angle between the axes and the ox axis is defined as a forward angle theta, and omega represents that WMRs can rotate for 360 degrees around a point C;
step 1-1: the kinetic equation for WMRs is expressed as:
wherein p represents a system pose vector, M (p) represents a system symmetric positive definite inertia matrix,a matrix of centripetal and coriolis forces is represented,representing the surface dynamic friction vector, G (p) representing the gravity vector, τdRepresenting finite uncertainty factor, b (p) representing input transformation matrix, τ ═ τr,τl]TRepresenting input torque vector, τr,τlA component representing τ, a (p) represents an incomplete constraint matrix, and λ represents a constraint force vector;
when the wheel-ground contact surface has no sliding or sideslip phenomenon, the motion state of the WMRs meets the non-integrity constraint condition:
constructing an incomplete constraint matrix A (p) and an arbitrary tensor S (p) in a non-zero state space, and satisfying the relation:
ST(p)A(p)=0 (3)
the forward linear velocity of the mass center motion of the WMRs is upsilon, the rotation angular velocity is omega, and a control vector u of the motion of the WMRs is formed, namely u is [ upsilon, omega)]TAnd satisfies the relation:
by substituting equation (1) after deriving equation (4) and then combining equations (2) and (3), the following relation (5) is obtained in the absence of surface dynamic friction and neglecting gravity:
Step 1-2: position coordinate (x) at centroid C position for pose of WMRsc,yc) And a forward direction angle θ, the coordinate positional relationship satisfies:
wherein v iscRepresenting the linear velocity of the forward motion of the center of mass;
namely:
simultaneously obtaining:
A(p)=[cosθ,-sinθ,0]T (8)
step 1-3: given the desired tracking trajectory vector p for WMRsr=[xr,yr,θr]TAnd a desired motion velocity vector ur=[υr,ωr]TAnd it satisfies the relation:
assuming that the velocity vector u satisfies the relation:
0<u≤umax (11)
therefore, the objective of trajectory tracking is to solve the control moment τ so that p → p as the moving time of WMRs increases, while satisfying the relations (5), (7) to (11)rAnd u → urNamely:
defining the pose error as follows:
whereinLocal coordinate system x representing slave WMRsccycA transformation matrix to the global coordinate system xoy; e.g. of the typep1、ep2、ep3Respectively representing error components of the pose error along the x direction, the y direction and the forward angle direction;
derivation of equation (13) yields:
equation (12) is equivalent to:
step 2: the method adopts an MPC method to realize the track tracking under the speed limitation;
step 2-1: carrying out linearization and discretization on the formula (14), and taking the time k as the current time;
step 2-2: the design objective function is:
where Q and R are both weight matrices, N1Representing a prediction time domain, p (k + i | t) represents a value of a system actual motion pose vector for predicting k + i moment forward by taking a t moment value as a reference, and pr(k + i | t) represents the value of the reference trajectory pose vector at the k + i moment, t represents the current moment, N represents the forward prediction of the reference trajectory pose vector based on the t moment value2Represents a control time domain, and delta u (k + i | t) represents a value of a control vector increment for predicting k + i time forward by taking a t time value as a reference;
step 2-3: solving an optimization problem that satisfies an objective function (16) and a velocity constraint (11)To obtain the time domain [ k, k + N ] in the control time domain2]A series of control sequences are included, the first element of the control sequence is used as the actual control quantity of the controlled object, the process is repeated at the moment of k +1, the whole solving process is finished in a rolling way, and the optimal control quantity is obtained
Wherein k is1、k2And k3Are all different parameters;
and step 3: fitting a kinetic equation of WMRs parameters by using an RBF network, and designing a control law based on an MRAC method;
step 3-1: transforming equation (5) yields:
in the formula (18)Andare all related to the structural parameters of WMRs, there are unmeasured or unknown items,the method belongs to unknown items, and therefore, a radial basis function RBF is used for carrying out approximation processing on the unknown items;
wherein upsilon is*Represents the optimal value of the linear velocity of the forward motion of the system, omega*Representing the optimum value of the angular velocity of rotation of the system, hiFor the output of a single neuron, g (.) represents the mapping relation of a radial basis kernel function, l is the weight of the neural network, and h (z) represents hiA finite linear combination of; by setting a parameter ciAnd biSetting learning rate and momentum factor to obtain new weight l when initial weight l is 0Infinitely approaches u satisfying equation (18);
wherein k is4Is a control rate parameter;
based on the MRAC method, a reference self-adaptive control law is designed as follows:
wherein: represents the Kronecker product; v. ofmaxRepresents the maximum value of the linear velocity of the forward motion of the system, omegamaxRepresenting the maximum value, x, of the angular velocity of rotation of the systemmaxDenotes vmaxOr ωmax;
And 4, step 4: and 3, realizing accurate track tracking of the WMRs according to the control law designed in the step 3.
Preferably, said τ isdThe finite uncertainty factors represented include unmodeled errors and bounded disturbances.
The invention has the following beneficial effects:
the invention can realize the motion control of the WMRs under specific conditions (non-integrity constraint, limited speed, unknown or partially unknown structural parameters), improves the track tracking and anti-interference capability of the WMRs under special working conditions, and is beneficial to expanding the working space of the WMRs.
Drawings
Fig. 1 is a planar structural model of typical WMRs of the present invention.
FIG. 2 is a path for solving the trajectory tracking problem of the present invention.
FIG. 3 is a control law block diagram of the present invention.
FIG. 4 illustrates the tracking effect of an embodiment of the present invention on circular and linear trajectories, wherein (a) is a circle and (b) is a straight line.
Detailed Description
The invention is further illustrated with reference to the following figures and examples.
When the wheeled mobile robot is driven in a differential mode, the wheeled mobile robot is simple in structure and flexible in steering, and is a good platform for verifying various advanced control algorithms. The invention aims at a Differential Drive (Differential Drive) wheel type mobile robot, and solves the technical problems that: when the WMRs move on the hard ground, the non-integrity constraint is not damaged because no sliding or sliding phenomenon exists between the wheel lands; for stability and safety of the movement, the movement speed of the WMRs must be properly limited; structural parameters of WMRs are unknown or vary due to limitations in measurement means or increased wear with increasing service life; therefore, in the presence of non-integrity constraints, limited motion speed and unknown or partially unknown structural parameters, how to control the motion state of WMRs enables tracking a pre-planned time-varying trajectory, thereby stably traveling according to the expected state.
A mobile robot track tracking method based on a neural network and self-adaptive control comprises the following steps:
step 1: performing dynamics and kinematics modeling on the WMRs under the conditions of incomplete constraint and speed limitation constraint;
a planar structural model of typical WMRs is shown in fig. 1. In the figure, WMRs are generally powered by two differential driving wheels coaxially mounted as rear wheels, and by universal wheels as front wheels to control direction and control balance, and can realize arbitrary movement and rotation in the horizontal plane (but only longitudinal movement and rotation back and forth, but not lateral movement left and right). Setting the radius of a wheel of WMRs as r (the diameter is 2r correspondingly), the distance between two driving wheels as 2b, the center of the distance between the two wheels as a point G, the center of mass of the WMRs is concentrated on a point C, the mass of the WMRs is m (the mass of the wheel is not contained), the moment of inertia is J, and the distance between the point C and the point G is d (in the actual design process, the center of mass point C can be coincided with the center point G through a method of measuring the center of mass, so that d can be determined as 0 in calculation); the Global coordinate system xoy is a cartesian inertial coordinate system for the WMRs to move therein for representing environmental information, corresponding to a Global environment Map (GM); local coordinate system xccycThe center of mass C of the WMRs is used as an origin, and the direction with the forward linear velocity of the movement of the center of mass of the WMRs as upsilon is cxcAxial, local coordinate system xccycThe motion coordinate system is fixedly connected on WMRs to represent the motion state of the WMRs and corresponds to a Local environment Map (LM); the rotation angular velocity of the mass center motion of WMRs is omega, the direction of upsilon and cxcThe axes are always in the same direction, and the included angle between the axes and the ox axis is defined as a forward angle theta, and omega represents that WMRs can rotate for 360 degrees around a point C;
step 1-1: according to the relevant knowledge of robot kinematics, the kinetic equation of the WMRs is expressed as:
wherein p represents a system pose vector, M (p) represents a system symmetric positive definite inertia matrix,a matrix of centripetal and coriolis forces is represented,representing the surface dynamic friction vector, G (p) representing the gravity vector, τdRepresenting finite uncertainty factor, b (p) representing input transformation matrix, τ ═ τr,τl]TRepresenting an input torque vector, A (p) representing an incomplete constraint matrix, and lambda representing a constraint force vector;
when the wheel-ground contact surface has no sliding or sideslip phenomenon, the motion state of the WMRs meets the non-integrity constraint condition:
constructing an incomplete constraint matrix A (p) and an arbitrary tensor S (p) in a non-zero state space, and satisfying the relation:
ST(p)A(p)=0 (3)
the forward linear velocity of the mass center motion of the WMRs is upsilon, the rotation angular velocity is omega, and a control vector u of the motion of the WMRs is formed, namely u is [ upsilon, omega)]TAnd satisfies the relation:
after the derivation of the formula (4), the formula (1) is substituted, then the formulas (2) and (3) are combined, and in consideration of the actual situation (the non-integrity constraint conditions determine that no surface dynamic friction exists, and gravity can be ignored during plane motion), the following relation (5) is obtained:
Step 1-2: in fig. 1, the position coordinates (x) of WMRs at the centroid C position for posec,yc) And a forward direction angle θ, the coordinate positional relationship satisfies:
namely:
simultaneously obtaining:
A(p)=[cosθ,-sinθ,0]T (8)
step 1-3: given the desired tracking trajectory vector p for WMRsr=[xr,yr,θr]TAnd a desired motion velocity vector ur=[υr,ωr]TAnd it satisfies the relation:
in order to ensure the stability of WMRs during motion, the actual motion velocity needs to be limited, assuming that the velocity vector u satisfies the relation:
0<u≤umax (11)
therefore, the objective of trajectory tracking is to solve the control moment τ so that p → p as the moving time of WMRs increases, while satisfying the relations (5), (7) to (11)rAnd u → urNamely:
the solution idea is shown in fig. 2.
Defining the pose error as follows:
whereinLocal coordinate system x representing slave WMRsccycA transformation matrix to the global coordinate system xoy;
derivation of equation (13) yields:
equation (12) is equivalent to:
step 2: adopting a Model Predictive Control (MPC) method to realize the track tracking under the speed limitation;
step 2-1: carrying out linearization and discretization on the formula (14), and taking the time k as the current time;
step 2-2: the design objective function is:
wherein Q and R are both weight matrices;
step 2-3: on the basis of the current pose state measurement value and the speed control quantity measurement value, a future section of time domain [ k, k + N ] of the system is predicted by combining a formula (4)1](prediction time domain) output, and solving the optimization problem which meets the objective function (16) and the speed constraint formula (11) to obtain the optimization problem in the control time domain [ k, k + N ]2]A series of control sequences are included, the first element of the control sequence is used as the actual control quantity of the controlled object, the process is repeated at the moment of k +1, the whole solving process is finished in a rolling way, and the optimal control quantity is obtained
Wherein k is1、k2And k3Are all different parameters;
and step 3: as shown in fig. 3, fitting a kinetic equation of WMRs parameters by using RBF network, and designing a control law based on the MRAC method;
step 3-1: transforming equation (5) yields:
in the formula (18)Andare all related to the structural parameters of WMRs, there are unmeasured or unknown items,the method belongs to unknown items, and therefore, a radial basis function RBF is used for carrying out approximation processing on the unknown items;
wherein h isiIs the output of a single neuron, and l is the weight of the neural network; by setting a parameter ciAnd biSetting learning rate and momentum factor to obtain new weight l when initial weight l is 0Infinitely approaches u satisfying equation (18);
wherein k is4Is a control rate parameter;
based on the MRAC method, a reference self-adaptive control law is designed as follows:
the reference adaptive control law meets the Lyapunov global stability law, so that the WMRs can be ensured to realize stable track tracking under the conditions of meeting non-integrity constraint and speed constraint;
when calculating, the unknown parameter k in the control law1~k4The Optimization can be performed by using Particle Swarm Optimization (PSO) algorithm. The PSO algorithm is a powerful tool for function optimization, the problem is intelligently solved by utilizing a possible solution of each particle representative problem and by means of simple behaviors of individual particles and information interaction in particle swarm, and the optimal parameter k is repeatedly iteratediThe searching and positioning of (2) has the advantages of high convergence rate and less parameters to be set.
And 4, step 4: and 3, realizing accurate track tracking of the WMRs according to the control law designed in the step 3.
From this control rate, the WMRs trajectory tracking effect is shown in fig. 4.
The method for tracking the WMRs track can realize accurate track tracking of the WMRs with unknown structural parameters or partially unknown structural parameters in a short time under the conditions of non-integrity constraint and speed limitation, has good tracking effect, and realizes motion control of the WMRs.
Claims (2)
1. A mobile robot track tracking method based on a neural network and self-adaptive control is characterized by comprising the following steps:
step 1: performing dynamics and kinematics modeling on the WMRs under the conditions of incomplete constraint and speed limitation constraint;
setting the radius of a wheel of WMRs as r, the distance between two driving wheels as 2b, the center of the distance between the two wheels as a point G, the center of mass of the WMRs is concentrated on a point C, the mass of the WMRs is m, the moment of inertia of the WMRs is J, and the distance between the point C and the point G is d; the global coordinate system xoy is a Cartesian inertial coordinate system for WMRs to move in, is used for representing environmental information and corresponds to a global environment map; local coordinate system xccycThe center of mass C of the WMRs is used as an origin, and the direction with the forward linear velocity of the movement of the center of mass of the WMRs as upsilon is cxcA shaft; the rotation angular velocity of the mass center motion of WMRs is omega, the direction of upsilon and cxcThe axes are always in the same direction, and the included angle between the axes and the ox axis is defined as a forward angle theta, and omega represents that WMRs can rotate for 360 degrees around a point C;
step 1-1: the kinetic equation for WMRs is expressed as:
wherein p represents a system pose vector, M (p) represents a system symmetric positive definite inertia matrix,a matrix of centripetal and coriolis forces is represented,representing the surface dynamic friction vector, G (p) representing the gravity vector, τdRepresenting finite uncertainty factor, b (p) representing input transformation matrix, τ ═ τr,τl]TRepresenting input torque vector, τr,τlA component representing τ, a (p) represents an incomplete constraint matrix, and λ represents a constraint force vector;
when the wheel-ground contact surface has no sliding or sideslip phenomenon, the motion state of the WMRs meets the non-integrity constraint condition:
constructing an incomplete constraint matrix A (p) and an arbitrary tensor S (p) in a non-zero state space, and satisfying the relation:
ST(p)A(p)=0 (3)
the forward linear velocity of the mass center motion of the WMRs is upsilon, the rotation angular velocity is omega, and a control vector u of the motion of the WMRs is formed, namely u is [ upsilon, omega)]TAnd satisfies the relation:
by substituting equation (1) after deriving equation (4) and then combining equations (2) and (3), the following relation (5) is obtained in the absence of surface dynamic friction and neglecting gravity:
Step 1-2: position coordinate (x) at centroid C position for pose of WMRsc,yc) And a forward direction angle θ, the coordinate positional relationship satisfies:
wherein upsilon iscRepresenting the linear velocity of the forward motion of the center of mass;
namely:
simultaneously obtaining:
A(p)=[cosθ,-sinθ,0]F (8)
step 1-3: given the desired tracking trajectory vector p for WMRsr=[xr,yr,θr]TAnd a desired motion velocity vector ur=[υr,ωr]TAnd it satisfies the relation:
assuming that the velocity vector u satisfies the relation:
0<u≤umax (11)
therefore, the objective of trajectory tracking is to solve the control moment τ so that p → p as the moving time of WMRs increases, while satisfying the relations (5), (7) to (11)rAnd u → urNamely:
defining the pose error as follows:
whereinLocal coordinate system x representing slave WMRsccycA transformation matrix to the global coordinate system xoy; e.g. of the typep1、ep2、ep3Respectively representing error components of the pose error along the x direction, the y direction and the forward angle direction;
derivation of equation (13) yields:
equation (12) is equivalent to:
step 2: the method adopts an MPC method to realize the track tracking under the speed limitation;
step 2-1: carrying out linearization and discretization on the formula (14), and taking the time k as the current time;
step 2-2: the design objective function is:
where Q and R are both weight matrices, N1Representing a prediction time domain, p (k + i | t) represents a value of a system actual motion pose vector for predicting k + i moment forward by taking a t moment value as a reference, and pr(k + i | t) represents the value of the reference trajectory pose vector at the k + i moment, t represents the current moment, N represents the forward prediction of the reference trajectory pose vector based on the t moment value2Represents a control time domain, and delta u (k + i | t) represents a value of a control vector increment for predicting k + i time forward by taking a t time value as a reference;
step 2-3: solving for fullnessThe optimization problem of the foot objective function (16) and the speed constraint formula (11) is obtained in a control time domain [ k, k + N ]2]A series of control sequences are included, the first element of the control sequence is used as the actual control quantity of the controlled object, the process is repeated at the moment of k +1, the whole solving process is finished in a rolling way, and the optimal control quantity is obtained
Wherein k is1、k2And k3Are all different parameters;
and step 3: fitting a kinetic equation of WMRs parameters by using an RBF network, and designing a control law based on an MRAC method;
step 3-1: transforming equation (5) yields:
in the formula (18)Andare all related to the structural parameters of WMRs, there are unmeasured or unknown items,the method belongs to unknown items, and therefore, a radial basis function RBF is used for carrying out approximation processing on the unknown items;
step 3-2: network input vector of RBFRBF network approximation algorithmComprises the following steps:
wherein upsilon is*Represents the optimal value of the linear velocity of the forward motion of the system, omega*Representing the optimum value of the angular velocity of rotation of the system, hiFor the output of a single neuron, g (.) represents the mapping relation of a radial basis kernel function, l is the weight of the neural network, and h (z) represents hiA finite linear combination of; by setting a parameter ciAnd biSetting learning rate and momentum factor to obtain new weight l when initial weight l is 0Infinitely approaches u satisfying equation (18);
wherein k is4Is a control rate parameter;
based on the MRAC method, a reference self-adaptive control law is designed as follows:
wherein: represents the Kronecker product; v. ofmaxRepresents the maximum value of the linear velocity of the forward motion of the system, omegamaxRepresenting the maximum value, x, of the angular velocity of rotation of the systemmaxDenotes vmaxOr ωmax;
And 4, step 4: and 3, realizing accurate track tracking of the WMRs according to the control law designed in the step 3.
2. The method for tracking the trajectory of the mobile robot based on the neural network and the adaptive control as claimed in claim 1, wherein τ is greater than or equal to τdThe finite uncertainty factors represented include unmodeled errors and bounded disturbances.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111121940.2A CN113848905B (en) | 2021-09-24 | 2021-09-24 | Mobile robot track tracking method based on neural network and self-adaptive control |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111121940.2A CN113848905B (en) | 2021-09-24 | 2021-09-24 | Mobile robot track tracking method based on neural network and self-adaptive control |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113848905A true CN113848905A (en) | 2021-12-28 |
CN113848905B CN113848905B (en) | 2024-07-12 |
Family
ID=78979170
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111121940.2A Active CN113848905B (en) | 2021-09-24 | 2021-09-24 | Mobile robot track tracking method based on neural network and self-adaptive control |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113848905B (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114740845A (en) * | 2022-03-31 | 2022-07-12 | 南京航空航天大学 | Vehicle tracking control method based on immersion and invariant manifold |
CN116382101A (en) * | 2023-06-05 | 2023-07-04 | 成都信息工程大学 | Uncertainty-considered self-adaptive control method and system for wheeled mobile robot |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109031947A (en) * | 2018-06-19 | 2018-12-18 | 哈尔滨理工大学 | Trajectory Tracking Control and method based on radial base neural net |
WO2020010626A1 (en) * | 2018-07-13 | 2020-01-16 | 深圳配天智能技术研究院有限公司 | Robot motion control method, robot, and robot motion control system |
CN111736598A (en) * | 2020-06-03 | 2020-10-02 | 东南大学 | Harvester path tracking control method and system based on adaptive neural network |
CN113093548A (en) * | 2021-04-07 | 2021-07-09 | 安徽大学 | Mobile robot trajectory tracking optimal control method based on event trigger mechanism |
-
2021
- 2021-09-24 CN CN202111121940.2A patent/CN113848905B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109031947A (en) * | 2018-06-19 | 2018-12-18 | 哈尔滨理工大学 | Trajectory Tracking Control and method based on radial base neural net |
WO2020010626A1 (en) * | 2018-07-13 | 2020-01-16 | 深圳配天智能技术研究院有限公司 | Robot motion control method, robot, and robot motion control system |
CN111736598A (en) * | 2020-06-03 | 2020-10-02 | 东南大学 | Harvester path tracking control method and system based on adaptive neural network |
CN113093548A (en) * | 2021-04-07 | 2021-07-09 | 安徽大学 | Mobile robot trajectory tracking optimal control method based on event trigger mechanism |
Non-Patent Citations (5)
Title |
---|
BAI, HONGLI: "《Model Predictive Visual Trajectory-Tracking Control of Wheeled Mobile Robots》", 《2019 IEEE 28TH INTERNATIONAL SYMPOSIUM ON INDUSTRIAL ELECTRONICS (ISIE)》, 31 December 2019 (2019-12-31), pages 1 - 6 * |
WANG ZHUPING: "《Simultaneous Stabilization and Tracking...ler Design and Experimental Validation》", 《IEEE》, vol. 66, no. 7, 30 June 2019 (2019-06-30), pages 1 - 10 * |
WANG, XUCHEN: "《Second-order Wheeled Mobile Robot Based on Fractional-Order PD Controller》", 《IEEE 2019 6TH INTERNATIONAL CONFERENCE ON INFORMATION, CYBERNETICS, AND COMPUTATIONAL SOCIAL SYSTEMS (ICCSS)》, 31 December 2019 (2019-12-31), pages 1 - 7 * |
XIANG YU: "《Real-Time Fault-Tolerant Formation control of multiple wmrs based on hybrid ga-pso algorithm》", 《IEEE》, vol. 18, no. 3, 30 June 2021 (2021-06-30), pages 1 - 14 * |
王靖宇: "《基于视听觉信息的机器觉察与仿生智能感知方法研究》", 《西北工业大学博士学位论文》, 31 December 2016 (2016-12-31) * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114740845A (en) * | 2022-03-31 | 2022-07-12 | 南京航空航天大学 | Vehicle tracking control method based on immersion and invariant manifold |
CN116382101A (en) * | 2023-06-05 | 2023-07-04 | 成都信息工程大学 | Uncertainty-considered self-adaptive control method and system for wheeled mobile robot |
CN116382101B (en) * | 2023-06-05 | 2023-09-01 | 成都信息工程大学 | Uncertainty-considered self-adaptive control method and system for wheeled mobile robot |
Also Published As
Publication number | Publication date |
---|---|
CN113848905B (en) | 2024-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106125728B (en) | A kind of 4 wheel driven wheeled mobile robot trace tracking and controlling method | |
Wen et al. | Elman fuzzy adaptive control for obstacle avoidance of mobile robots using hybrid force/position incorporation | |
Koubaa et al. | Adaptive sliding-mode dynamic control for path tracking of nonholonomic wheeled mobile robot | |
CN113848905B (en) | Mobile robot track tracking method based on neural network and self-adaptive control | |
Alouache et al. | Fuzzy logic PD controller for trajectory tracking of an autonomous differential drive mobile robot (ie Quanser Qbot) | |
Abdalla et al. | Trajectory tracking control for mobile robot using wavelet network | |
Ziye et al. | Tracking control of unmanned tracked vehicle in off-road conditions with large curvature | |
Han et al. | Robust optimal control of omni-directional mobile robot using model predictive control method | |
Singh et al. | Control of closed-loop differential drive mobile robot using forward and reverse kinematics | |
Ismaiel et al. | A simulation-based study to calculate all the possible trajectories of differential drive mobile robot | |
Xue et al. | Stewart-inspired vibration isolation control for a wheel-legged robot via variable target force impedance control | |
Mnubi | Motion planning and trajectory for wheeled mobile robot | |
CN108693776A (en) | A kind of robust control method of Three Degree Of Freedom Delta parallel robots | |
EP4394531A1 (en) | Method for constructing controller for robot, motion control method and apparatus for robot, and robot | |
Chang et al. | Adaptive tracking controller based on the PID for mobile robot path tracking | |
Renawi et al. | ROS validation for non-holonomic differential robot modeling and control: Case study: Kobuki robot trajectory tracking controller | |
Ly et al. | Design of neural network-PID controller for trajectory tracking of differential drive mobile robot | |
Kanjanawanishkul | Coordinated path following for mobile robots using a virtual structure strategy with model predictive control | |
Farahat et al. | Adaptive neuro-fuzzy control of autonomous ground vehicle (agv) based on machine vision | |
Zhou et al. | Mowing robot trajectory tracking control algorithm research | |
Yan-dong et al. | Adaptive RBFNN formation control of multi-mobile robots with actuator dynamics | |
Yang et al. | Tracking control of wheeled mobile robot based on RBF network supervisory control | |
Zhou et al. | Sliding mode control for trajectory tracking of AGV based on improved fast stationary power approach law | |
Labakhua et al. | Control of a mobile robot with Swedish wheels | |
Yan et al. | Hierarchical Tracking Control for a Composite Mobile Robot Considering System Uncertainties |
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 |