CN109746922A - A kind of nonholonomic mobile robot control method based on finite time switching control - Google Patents
A kind of nonholonomic mobile robot control method based on finite time switching control Download PDFInfo
- Publication number
- CN109746922A CN109746922A CN201910179184.5A CN201910179184A CN109746922A CN 109746922 A CN109746922 A CN 109746922A CN 201910179184 A CN201910179184 A CN 201910179184A CN 109746922 A CN109746922 A CN 109746922A
- Authority
- CN
- China
- Prior art keywords
- mobile robot
- nonholonomic
- finite time
- target
- formula
- 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.)
- Pending
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention discloses a kind of nonholonomic mobile robot control methods based on finite time switching, and tracing control process is divided into the following steps: (1) portraying nonholonomic mobile robot using polar coordinates and move target at a distance from plane and azimuth；(2) trace model is converted by error model based on coordinate transform under polar coordinates, and one sensor is installed in nonholonomic mobile robot vehicle body, for constantly transmitting it and moving distance and azimuth between target；(3) constantly collected position data is transferred in finite-time control algoritic module sensor, so that nonholonomic mobile robot adjusts the movement of oneself constantly to set tracking range and bearing null tracked mobile target.A kind of of the invention pure geometric operation of nonholonomic mobile robot control algolithm based on finite time switching is easily understood, algorithmic stability, requires hardware device lower, and tracking is stablized, practical, is easy to be commercialized.
Description
Technical field
The present invention relates to nonholonomic mobile robot movement control technology fields, and in particular to one kind is based on finite time switching control
The control method of system.
Background technique
All trades and professions are almost permeated in the application of nonholonomic mobile robot at present.Nonholonomic mobile robot have estimate one's own ability light, carrying is big,
It drives and controls the advantages that relatively convenient, the speed of travel are fast, work efficiency is high, to show one's talent from all kinds of robots.
It solves the problems, such as that tracked mobile target is a challenging task using nonholonomic mobile robot, is led in control
Domain causes more and more concerns.Pursuit movement target has the complexity of its own, is mainly manifested in: target movement is more more
Sample, density is bigger, and clutter density is bigger.Before being always of greatest concern using nonholonomic mobile robot tracking mobile surface targets
Along one of project.Because it is scouted in cooperation robot, multirobot forms and has very important application in track following.Nothing
Man-machine (UAR) and unmanned ground robot (UGR) are commonly used in tracked mobile target.It is directed to the control of nonholonomic mobile robot at present
Algorithm substantially there are two types of: (1) self adaptive control, (2) robust control；But these algorithms calculate it is complicated, computationally intensive, to system
Requirement of real-time it is high, this will increase algorithm cost of implementation, be unfavorable for practical application.
Therefore, the above problem is not solved, needs to propose that a kind of calculation amount is small, real-time is good, at low cost, utilizes practical application
Nonholonomic mobile robot tracking and controlling method.
Summary of the invention
The purpose of the present invention is to solve the drawbacks described above in existing nonholonomic mobile robot control technology, provide a kind of base
In the nonholonomic mobile robot control method of finite time switching control, this method calculation amount is small, real-time is good, cost of implementation is low,
Convenient for practical application.
The invention is characterized in that following technical solution obtains:
A kind of nonholonomic mobile robot control method based on finite time switching, including the following steps:
(1), nonholonomic mobile robot is portrayed using polar coordinates with mobile target at a distance from plane and azimuth；It is non-complete
The kinematics model of whole robot, mobile target movement model and the two positional relationship are obtained by formula (1):
In formula (1), [x, y]T∈R2Position coordinates of the nonholonomic mobile robot in plane XOY are represented, θ is before robot
Into directional velocity and X-axis forward direction angle, v indicates its advance space rate, and w indicates the angular speed of its rotation；[xt,yt]T∈
R2Represent position coordinates of the mobile target in plane XOY, vxAnd vyRespectively represent mobile target in the planes forward speed in X
Component velocity on axis and Y-axis；D represents the linear distance between nonholonomic mobile robot and mobile target, and σ represents incomplete machine
Azimuth between people and mobile target；
(2), trace model is converted by error model based on coordinate transform under polar coordinates, and in nonholonomic mobile robot vehicle
Body installs a sensor, for real-time Transmission its distance and azimuth between mobile target；
Error model is provided by formula (2):
In formula (2), X and Y are nonholonomic mobile robot and the horizontal distance and vertical direction distance for moving target respectively
Error variance after coordinate transform；σ+θ-β=π, d and σ obtain the form of following formula (3) about the derivative of time:
(3), finite time switch controller, finite time switching control are designed for the error model in step (2)
The step of device, is divided into following three step:
(3-1), the first module design of finite time switch controller are as follows:
In formula (4), κ1And ζ1Meet0≤ζ1≤ 1, it is obtained according to Lyapunov stability theory
σ will converge to 0 in finite time；
(3-2), the second module design of finite time switch controller are as follows:
In formula (5), κ2And ζ2Meet0≤ζ2≤ 1, according to Lyapunov stability theory obtain d with
The time constantly decay, in order to avoid nonholonomic mobile robot and mobile target collide, d should be made to converge to a set reason
Think tracking range dρ, therefore consider following two situation:
If situation one, | d-dρ| < ε1, wherein ε1It is an arbitrary positive number, then enters step (3-3)；
Situation two, if there is a positive number ε2So that | d-dρ| > ε2, then step (3-2) is reentered, until meeting
Situation enters step (3-3) again and again；
(3-3), the second module design of finite time switch controller are as follows:
Under this controller, can guarantee σ and | d-dρ| it is always held in zero neighborhood, so far entire incomplete machine
The finite time switch controller of people's tracked mobile target, which designs, to be completed；
By sensor, collected position data is transferred in finite time switch controller in real time, so that incomplete machine
People adjusts the movement of oneself in real time to set tracking range and bearing null tracked mobile target.
Above-mentioned tracking range d should converge to set ideal tracking range dρ。
The present invention has the following advantages that relative to existing control technology and effect:
Nonholonomic mobile robot control algolithm proposed by the present invention is based on polar coordinates and is obtained using geometry direct derivation, parameter letter
List, physical meaning are clear；Calculating in nonholonomic mobile robot control algolithm is to calculate to complete before tracing control starts, and is tracked
Cheng Wuxu manual intervention, calculation amount is small, real-time is good, and cost of implementation is low, is convenient for practical application.
Detailed description of the invention
Fig. 1 is nonholonomic mobile robot tracked mobile target schematic diagram.
Specific embodiment
As shown in Figure 1, a kind of nonholonomic mobile robot control method based on finite time switching, including the following steps:
(1), nonholonomic mobile robot is portrayed using polar coordinates with mobile target at a distance from plane and azimuth；It is non-complete
The kinematics model of whole robot, mobile target movement model and the two positional relationship are obtained by formula (1):
In formula (1), [x, y]T∈R2Position coordinates of the nonholonomic mobile robot in plane XOY are represented, θ is before robot
Into directional velocity and X-axis forward direction angle, v indicates its advance space rate, and w indicates the angular speed of its rotation；[xt,yt]T∈
R2Represent position coordinates of the mobile target in plane XOY, vxAnd vyRespectively represent mobile target in the planes forward speed in X
Component velocity on axis and Y-axis；D represents the linear distance between nonholonomic mobile robot and mobile target, and σ represents incomplete machine
Azimuth between people and mobile target；
(2), trace model is converted by error model based on coordinate transform under polar coordinates, and in nonholonomic mobile robot vehicle
Body installs a sensor, for real-time Transmission its distance and azimuth between mobile target；
Error model is provided by formula (2):
In formula (2), X and Y are nonholonomic mobile robot and the horizontal distance and vertical direction distance for moving target respectively
Error variance after coordinate transform；Following formula is obtained about the derivative of time according to the available σ+θ-β of Fig. 1=π, d and σ
(3) form:
(3), finite time switch controller, finite time switching control are designed for the error model in step (2)
The step of device, is divided into following three step:
(3-1), the first module design of finite time switch controller are as follows:
In formula (4), κ1And ζ1Meet0≤ζ1≤ 1, it is obtained according to Lyapunov stability theory
σ will converge to 0 in finite time；
(3-2), the second module design of finite time switch controller are as follows:
In formula (5), κ2And ζ2Meet0≤ζ2≤ 1, according to Lyapunov stability theory obtain d with
The time constantly decay, in order to avoid nonholonomic mobile robot and mobile target collide, d should be made to converge to a set reason
Think tracking range dρ, therefore consider following two situation:
If situation one, | d-dρ| < ε1, wherein ε1It is an arbitrary positive number, then enters step (3-3)；
Situation two, if there is a positive number ε2So that | d-dρ| > ε2, then step (3-2) is reentered, until meeting
Situation enters step (3-3) again and again；
(3-3), the second module design of finite time switch controller are as follows:
Under this controller, can guarantee σ and | d-dρ| it is always held in zero neighborhood, so far entire incomplete machine
The finite time switch controller of people's tracked mobile target, which designs, to be completed；
By sensor, collected position data is transferred in finite time switch controller in real time, so that incomplete machine
People adjusts the movement of oneself in real time to set tracking range and bearing null tracked mobile target.
Above-mentioned tracking range d should converge to set ideal tracking range dρ。
The above is only a preferred embodiment of the present invention, it is noted that for the ordinary skill people of the art
For member, various improvements and modifications may be made without departing from the principle of the present invention, these improvements and modifications are also answered
It is considered as protection scope of the present invention.
Claims (2)
1. a kind of nonholonomic mobile robot control method based on finite time switching, it is characterised in that include the following steps:
(1), nonholonomic mobile robot is portrayed using polar coordinates with mobile target at a distance from plane and azimuth；Incomplete machine
The kinematics model of device people, mobile target movement model and the two positional relationship are obtained by formula (1):
In formula (1), [x, y]T∈R2Position coordinates of the nonholonomic mobile robot in plane XOY are represented, θ is what robot advanced
The angle of directional velocity and X-axis forward direction, v indicate its advance space rate, and w indicates the angular speed of its rotation；[xt,yt]T∈R2Generation
Position coordinates of the mobile target of table in plane XOY, vxAnd vyRespectively represent mobile target in the planes forward speed in X-axis and Y
Component velocity on axis；D represents the linear distance between nonholonomic mobile robot and mobile target, σ represent nonholonomic mobile robot with
Azimuth between mobile target；
(2), trace model is converted by error model based on coordinate transform under polar coordinates, and pacified in nonholonomic mobile robot vehicle body
A sensor is filled, for real-time Transmission its distance and azimuth between mobile target；
Error model is provided by formula (2):
In formula (2), X and Y are the horizontal distance of nonholonomic mobile robot and mobile target and the coordinate of vertical direction distance respectively
Transformed error variance；σ+θ-β=π, d and σ obtain the form of following formula (3) about the derivative of time:
(3), finite time switch controller is designed for the error model in step (2), finite time switch controller
Step is divided into following three step:
(3-1), the first module design of finite time switch controller are as follows:
In formula (4), κ1And ζ1Meet0≤ζ1≤ 1, it is obtained according to Lyapunov stability theory limited
σ will converge to 0 in time；
(3-2), the second module design of finite time switch controller are as follows:
In formula (5), κ2And ζ2Meet0≤ζ2≤ 1, according to Lyapunov stability theory obtain d with when
Between constantly decay, in order to avoid nonholonomic mobile robot and mobile target collide, should make d converge to one it is set it is ideal with
Track distance dρ, therefore consider following two situation:
If situation one, | d-dρ| < ε1, wherein ε1It is an arbitrary positive number, then enters step (3-3)；
Situation two, if there is a positive number ε2So that | d-dρ| > ε2, then step (3-2) is reentered, until meeting situation
(3-3) is entered step again and again；
(3-3), the second module design of finite time switch controller are as follows:
Under this controller, can guarantee σ and | d-dρ| be always held in zero neighborhood, so far entire nonholonomic mobile robot with
The finite time switch controller of the mobile target of track, which designs, to be completed；
By sensor, collected position data is transferred in finite time switch controller in real time, so that nonholonomic mobile robot is real
When adjust the movement of oneself to set tracking range and bearing null tracked mobile target.
2. a kind of nonholonomic mobile robot control method based on finite time switching control according to claim 1, special
Sign is that the tracking range d should converge to set ideal tracking range dρ。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910179184.5A CN109746922A (en) | 2019-03-11 | 2019-03-11 | A kind of nonholonomic mobile robot control method based on finite time switching control |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910179184.5A CN109746922A (en) | 2019-03-11 | 2019-03-11 | A kind of nonholonomic mobile robot control method based on finite time switching control |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN109746922A true CN109746922A (en) | 2019-05-14 |
Family
ID=66408367
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910179184.5A Pending CN109746922A (en) | 2019-03-11 | 2019-03-11 | A kind of nonholonomic mobile robot control method based on finite time switching control |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109746922A (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111477003A (en) * | 2020-04-13 | 2020-07-31 | 联陆智能交通科技(上海)有限公司 | Calculation method and system for acquiring time of collision with weak traffic and medium |
| CN112907625A (en) * | 2021-02-05 | 2021-06-04 | 齐鲁工业大学 | Target following method and system applied to four-footed bionic robot |
| CN114211173A (en) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | Method, device and system for determining welding position |
| CN114211173B (en) * | 2022-01-27 | 2024-05-31 | 上海电气集团股份有限公司 | Method, device and system for determining welding position |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH1055214A (en) * | 1996-08-09 | 1998-02-24 | Daihen Corp | Control method for industrial robot |
| EP2789430A1 (en) * | 2013-04-12 | 2014-10-15 | Sabanci University | A series elastic holonomic mobile platform for upper extremity rehabilitation |
| CN104932506A (en) * | 2015-06-09 | 2015-09-23 | 东南大学 | Wheel type moving robot track tracking method based on fast terminal sliding mode |
| CN105904458A (en) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | Non-integrate teleoperation constraint control method based on complex operation tasks |
| CN106707749A (en) * | 2016-12-14 | 2017-05-24 | 北京科技大学 | Control method for bionic flapping-wing aerial robot |
-
2019
- 2019-03-11 CN CN201910179184.5A patent/CN109746922A/en active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH1055214A (en) * | 1996-08-09 | 1998-02-24 | Daihen Corp | Control method for industrial robot |
| EP2789430A1 (en) * | 2013-04-12 | 2014-10-15 | Sabanci University | A series elastic holonomic mobile platform for upper extremity rehabilitation |
| CN104932506A (en) * | 2015-06-09 | 2015-09-23 | 东南大学 | Wheel type moving robot track tracking method based on fast terminal sliding mode |
| CN105904458A (en) * | 2016-05-16 | 2016-08-31 | 西北工业大学 | Non-integrate teleoperation constraint control method based on complex operation tasks |
| CN106707749A (en) * | 2016-12-14 | 2017-05-24 | 北京科技大学 | Control method for bionic flapping-wing aerial robot |
Non-Patent Citations (1)
| Title |
|---|
| HUA CHEN 等: "Finite-Time Switching Control of Nonholonomic Mobile Robots for Moving Target Tracking Based on Polar Coordinates", 《COMPLEXITY》 * |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111477003A (en) * | 2020-04-13 | 2020-07-31 | 联陆智能交通科技(上海)有限公司 | Calculation method and system for acquiring time of collision with weak traffic and medium |
| CN112907625A (en) * | 2021-02-05 | 2021-06-04 | 齐鲁工业大学 | Target following method and system applied to four-footed bionic robot |
| CN114211173A (en) * | 2022-01-27 | 2022-03-22 | 上海电气集团股份有限公司 | Method, device and system for determining welding position |
| CN114211173B (en) * | 2022-01-27 | 2024-05-31 | 上海电气集团股份有限公司 | Method, device and system for determining welding position |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106094835B (en) | The dynamic formation control method of front-wheel drive vehicle type mobile robot | |
| EP3633480B1 (en) | Point stabilization control method and device for mobile robot | |
| CN104570938A (en) | Double-arm robot system in plug-in mounting production and intelligent control method of double-arm robot system | |
| CN109746922A (en) | A kind of nonholonomic mobile robot control method based on finite time switching control | |
| CN103568012B (en) | A kind of planing method of arc welding robot biplane swinging arc track | |
| CN109839934A (en) | Unmanned water surface ship default capabilities tracking and controlling method based on RISE technology | |
| CN112256001B (en) | Visual servo control method for mobile robot under visual angle constraint | |
| CN108614563A (en) | A method of realizing that mobile robot target follows by location navigation | |
| CN105929849B (en) | One kind is based on point quelling wheeled mobile robot target following control method | |
| CN108614560A (en) | A kind of mobile robot visual servo guaranteed cost tracking and controlling method | |
| CN104236456A (en) | Robot hand-eye calibration method based on two-degree-of-freedom three-dimensional visual sensor | |
| CN113625702B (en) | Unmanned vehicle simultaneous path tracking and obstacle avoidance method based on quadratic programming | |
| CN104298244A (en) | Industrial robot three-dimensional real-time and high-precision positioning device and method | |
| Wang et al. | Research on logistics autonomous mobile robot system | |
| CN113721639B (en) | Path planning method and control method for docking of small underwater robot | |
| CN113325852B (en) | Leader follower mode-based multi-agent formation change control method in advancing process | |
| CN112650217B (en) | Robot trajectory tracking strategy dynamic optimization method based on evaluation function | |
| Srivastava et al. | Range estimation and visual servoing of a dynamic target using a monocular camera | |
| CN111251303A (en) | Robot motion control method for periodic attitude adjustment | |
| CN113110458B (en) | Unmanned ship virtual target tracking control system | |
| CN109946970A (en) | A kind of acquisition methods of the nonholonomic mobile robot velocity information based on observer | |
| CN111830832B (en) | Bionic gliding machine dolphin plane path tracking method and system | |
| CN115061142A (en) | AGV positioning method and system based on laser radar | |
| CN110083059A (en) | A kind of nonholonomic mobile robot stabilized control method of Discrete-time Sliding Mode | |
| CN210605481U (en) | Indoor target positioning and tracking system based on track holder |
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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190514 |
|
| RJ01 | Rejection of invention patent application after publication |