CN107943049A - A kind of unmanned vehicle control method and unmanned grass-cutting vehicle - Google Patents
A kind of unmanned vehicle control method and unmanned grass-cutting vehicle Download PDFInfo
- Publication number
- CN107943049A CN107943049A CN201711331721.0A CN201711331721A CN107943049A CN 107943049 A CN107943049 A CN 107943049A CN 201711331721 A CN201711331721 A CN 201711331721A CN 107943049 A CN107943049 A CN 107943049A
- Authority
- CN
- China
- Prior art keywords
- unmanned
- vehicle
- steering angle
- steering
- deviation
- 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 42
- 230000007246 mechanism Effects 0.000 claims abstract description 20
- 238000013461 design Methods 0.000 abstract description 2
- 230000006870 function Effects 0.000 description 24
- 238000005516 engineering process Methods 0.000 description 8
- 238000004422 calculation algorithm Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000009966 trimming Methods 0.000 description 1
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/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
-
- 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
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Guiding Agricultural Machines (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The present invention relates to unmanned vehicle and its design of control method, more particularly to a kind of unmanned vehicle control method and unmanned grass-cutting vehicle.Unmanned vehicle control method includes the following steps：Obtain the positional information and attitude information at unmanned vehicle current time；Calculate current time described in unmanned vehicle position and course and path planning between be range deviation and angular deviation；When range deviation is not less than range deviation threshold value and more than range deviation threshold value, the steering angle of unmanned vehicle steering mechanism is obtained respectively；The steering angle of the unmanned vehicle steering mechanism of acquisition is sent in the form of control instruction to unmanned vehicle.The unmanned vehicle control method of the present invention and unmanned grass-cutting vehicle, can obtain unmanned grass-cutting vehicle exact position and attitude information, and the position deviation being calculated with reference to path planning and angular deviation are more accurate effective；Furthermore it is possible to different correct is taken to turn to strategy according to different situations, it can be ensured that to be more turning quickly back on correct track.
Description
Technical Field
The invention relates to an unmanned vehicle and a control method design thereof, in particular to an unmanned vehicle control method and an unmanned mowing vehicle.
Background
With the rapid development of science and technology, unmanned vehicles are more and more concerned about development, and various automobile manufacturers and technology companies at home and abroad put a great deal of energy into the research and development of unmanned vehicles. The unmanned vehicle is a comprehensive robot system integrating multiple functions of environment perception, path planning, decision control and the like.
The decision control is equivalent to the brain of the unmanned vehicle, and the decision control has the main function of carrying out decision judgment according to the information obtained by the sensing system, further carrying out decision on the next action and controlling the vehicle to move. Therefore, decision control technology is a critical technology in unmanned vehicle systems. The behavior of decision control systems is divided into reactive, reflective and synthetic. The reactive control is a feedback control process, which continuously adjusts the steering wheel angle and the vehicle speed according to the deviation of the current position of the vehicle and the expected path until the destination is reached. However, it is not possible to smoothly control the unmanned vehicle by simply obtaining the trajectory tracking control by the positional deviation.
In order to solve the problems, some existing unmanned vehicles observe information of surrounding roads and obstacles through a high-definition camera, a laser scanner, a radar sensor and the like so as to establish a track tracking control algorithm, but the method is complex in algorithm, high in implementation difficulty and not suitable for being used in outdoor occasions.
In addition, the unmanned mowing vehicle is an application example of unmanned vehicle technology in a specific occasion, and is mainly applied to large airport lawn trimming operation. The unmanned mowing vehicle collects boundary information of an operation map through a GPS satellite navigator, and plans an optimal traveling path to perform traversal mowing operation in an area. Therefore, how to control the unmanned mowing vehicle to travel according to the planned path to realize the track tracking control method of the full-coverage traversing mowing operation in the area becomes a central priority.
Disclosure of Invention
The invention aims to provide an unmanned vehicle control method and an unmanned mowing vehicle, and aims to solve at least one problem of the existing unmanned vehicle and the existing unmanned mowing vehicle control method.
The technical scheme of the invention is as follows:
an unmanned vehicle control method comprises the following steps:
the method comprises the steps of firstly, obtaining position information and posture information of an unmanned vehicle at the current moment;
step two, calculating the distance deviation and the angle deviation between the position and the course of the unmanned vehicle and the planned path at the current moment;
step three, comparing the distance deviation with a set distance deviation threshold value, and combining the angle deviation to obtain the steering angle of the steering mechanism of the unmanned vehicle, wherein the method specifically comprises the following steps:
when the distance deviation is not less than the distance deviation threshold value, the steering angle θ is obtained by the following formula (1):
wherein, a 1 、b 1 Is a coefficient, θ max Maximum steering angle of steering mechanism of unmanned vehicle, d t D is the vertical distance between the center point of the unmanned vehicle and the planned path, and alpha is the angle deviation between the unmanned vehicle and the planned path at the current moment;
when the distance deviation is larger than a distance deviation threshold value, a steering angle θ is obtained by the following relation (2):
wherein, theta is a positive value to indicate left steering, and theta is a negative value to indicate right steering;
and step four, sending the obtained steering angle of the steering mechanism of the unmanned vehicle to a steering motor of the unmanned vehicle in a control instruction form.
Optionally, after the third step and before the fourth step, the method further includes the following steps:
the steering angle obtained is corrected by the following step function (3):
wherein θ is the steering angle corrected in this step;
and in the fourth step, the corrected steering angle is sent to a steering motor of the unmanned vehicle in a control command form.
Optionally, the step of correcting the obtained steering angle by the step function further includes:
and adding a loop function on the basis of the step function so as to correct the obtained steering angle.
Optionally, after the third step and before the fourth step, the method further includes the following steps:
correcting the steering angle according to the current vehicle speed condition of the unmanned vehicle, specifically adopting the following relational expression (4) to correct:
wherein, a 2 、b 2 And v is the coefficient of the current speed of the unmanned vehicle.
Optionally, the distance deviation threshold is equal to the maximum speed of the unmanned vehicle at the current time multiplied by the instruction period.
The invention also provides an unmanned mowing vehicle which is controlled by adopting any one of the unmanned vehicle control methods, wherein the unmanned mowing vehicle comprises:
the first satellite receiving antenna is fixedly arranged at the center of a rear wheel shaft of the unmanned mowing vehicle;
the second satellite receiving antenna is fixedly arranged at the center of the front wheel shaft of the unmanned mowing vehicle;
the GPS-RTK receiver is fixedly arranged on the unmanned mowing vehicle and used for acquiring the position information and the posture information of the unmanned mowing vehicle at the current moment according to the information received by the first satellite receiving antenna and the second satellite receiving antenna which are connected with the GPS-RTK receiver;
the controller is fixedly arranged on the unmanned mowing vehicle and is used for:
calculating distance deviation and angle deviation between the position and the course of the unmanned mowing vehicle and a planned path at the current moment according to the position information and the posture information of the unmanned mowing vehicle at the current moment;
calculating a steering angle of a steering mechanism of the unmanned mowing vehicle by comparing the distance deviation with a set distance deviation threshold value and combining the angle deviation;
and sending the obtained steering angle of the steering mechanism of the unmanned mowing vehicle to a steering motor of the unmanned mowing vehicle in a control instruction form.
Optionally, the controller is further configured to correct the obtained steering angle through a step function, and send the corrected steering angle to a steering motor of the unmanned mowing vehicle in a control instruction form.
Optionally, the controller is further configured to add a loop function to the step function, so as to correct the obtained steering angle.
Optionally, the controller is further configured to correct the steering angle according to the current vehicle speed of the unmanned mowing vehicle.
Optionally, the effective swath and the actual swath of the header of the unmanned mowing vehicle are determined by using the following relation (5):
L≤S-2·D(5)；
wherein L is an effective cutting width, S is an actual cutting width, and D is the deviation of the track tracking control precision of the unmanned mowing vehicle.
The invention has the following effects:
according to the unmanned mowing vehicle control method and the unmanned mowing vehicle, accurate position and posture information of the unmanned mowing vehicle can be obtained, and position deviation and angle deviation obtained by combining with planning path calculation are more accurate and effective; in addition, different deviation rectifying and steering strategies can be adopted according to different situations, and the user can be ensured to return to the correct track more quickly.
Drawings
FIG. 1 is a schematic view of the unmanned mowing vehicle for deviation rectification and turning;
FIG. 2 is a schematic view of the large deviation rectifying steering of the unmanned mowing vehicle of the invention;
FIG. 3 is another schematic view of the large deviation rectifying steering of the unmanned mowing vehicle of the invention;
FIG. 4 is a schematic view of a step function of the steering angle of the unmanned mowing vehicle;
FIG. 5 is a schematic view of the steering angle dead zone setting of the unmanned mowing vehicle of the invention;
FIG. 6 is a diagram of the effect of the track following control simulation of the unmanned mowing vehicle.
Detailed Description
In order to make the implementation objects, technical solutions and advantages of the present invention clearer, the technical solutions in the embodiments of the present invention will be described in more detail below with reference to the accompanying drawings in the embodiments of the present invention. In the drawings, the same or similar reference numerals denote the same or similar elements or elements having the same or similar functions throughout. The described embodiments are illustrative of some, but not all embodiments of the invention. The embodiments described below with reference to the drawings are illustrative and intended to be illustrative of the invention and are not to be construed as limiting the invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention. Embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
In the description of the present invention, it is to be understood that the terms "center", "longitudinal", "lateral", "front", "rear", "left", "right", "vertical", "horizontal", "top", "bottom", "inner", "outer", etc., indicate orientations or positional relationships based on those shown in the drawings, and are used merely for convenience in describing the present invention and for simplifying the description, and do not indicate or imply that the device or element being referred to must have a particular orientation, be constructed and operated in a particular orientation, and therefore, should not be taken as limiting the scope of the present invention.
The unmanned vehicle control method and the unmanned mowing vehicle of the invention are further described in detail with reference to fig. 1 to 6.
The invention provides an unmanned vehicle control method (unmanned vehicle trajectory tracking control method), which is a process for controlling the steering angle and speed of an unmanned vehicle to enable the unmanned vehicle to run along a planned trajectory. The GPS-RTK satellite navigation technology is adopted, a satellite receiving antenna is arranged on the unmanned vehicle to acquire the accurate position and attitude information of the unmanned vehicle, and the position deviation (namely distance deviation) and the angle deviation are calculated by combining a planned path. And establishing a track tracking and deviation rectifying algorithm of the unmanned mowing vehicle on the basis of the position deviation and the angle deviation, setting a plurality of position deviation threshold values and angle deviation threshold values, linearly and continuously changing the steering angle within a small deviation range, and controlling the unmanned vehicle to return to a correct running track as soon as possible by adopting a large steering angle when the steering angle exceeds the threshold range. The steering angle can be optimized by selectively adding a step function, a loop function and a speed function to the steering angle control aiming at different steering actuators.
It should be noted that the unmanned vehicle control method of the present invention can be applied to various suitable unmanned vehicles according to the needs; the following description will be made in detail by taking an unmanned mowing vehicle as an example.
The unmanned mowing vehicle adopts a GPS-RTK technology to obtain positioning navigation information, and adopts double receiving antennas; specifically, a first satellite receiving antenna T1, a second satellite receiving antenna T2, a GPS-RTK receiver, and a controller, etc. may be included. The first satellite receiving antenna T1 is fixedly arranged at the center of a rear axle of the unmanned mowing vehicle; the second satellite receiving antenna T2 is fixedly arranged at the center of the front axle of the unmanned mowing vehicle.
The GPS-RTK receiver is fixedly arranged at a preset position on the unmanned mowing vehicle, and is mainly used for calculating and obtaining the position information and the attitude information of the unmanned mowing vehicle at the current moment according to the information received by the first satellite receiving antenna and the second satellite receiving antenna which are connected with the GPS-RTK receiver, and sending the position information and the attitude information to the controller.
The controller is fixedly arranged at a preset position on the unmanned mowing vehicle, and various known suitable controller devices such as a single chip microcomputer, a microcomputer and the like can be selected according to requirements; the controller is configured to calculate distance deviation and angle deviation between the position and the course of the unmanned mowing vehicle at the current moment and a planned path according to the position information and the posture information of the unmanned mowing vehicle at the current moment, which are sent by the GPS-RTK receiver, and send control instructions (such as a steering angle instruction and a speed instruction) for controlling the unmanned mowing vehicle.
Further, the controller is further configured for:
the steering angle of the steering mechanism of the unmanned mowing vehicle is obtained by comparing the distance deviation with a set distance deviation threshold value and combining the angle deviation; sending the obtained steering angle of the steering mechanism of the unmanned mowing vehicle to a steering motor of the unmanned mowing vehicle in a control instruction form; correcting the obtained steering angle through a step function, and sending the corrected steering angle to a steering motor of the unmanned mowing vehicle in a control instruction form; adding a loop function on the basis of the step function so as to correct the obtained steering angle; and correcting the steering angle according to the current speed condition of the unmanned mowing vehicle.
The control method of the unmanned mowing vehicle comprises the following steps of:
the method comprises the following steps that firstly, a GPS-RTK receiver obtains position information and attitude information of the unmanned vehicle at the current moment according to received information received by a first satellite receiving antenna and a second satellite receiving antenna.
In particular, GPS-RTK receiverThe current high-precision position signals of the two receiving antennas can be obtained through calculation, and course information of the T1 pointing to the T2 direction is obtained, namely the current course attitude of the unmanned mowing vehicle is obtained. Course angleCan pass through the T1 position (x) 1 ,y 1 ) And the T2 position (x) 2 ,y 2 ) And (3) calculating to obtain:
the position precision obtained by adopting the GPS-RTK technology is centimeter level, and if the precision error is s, the course angle precision error isIt can be known that the larger the positions of the antennas T1 and T2 are, the higher the heading angle accuracy is.
And secondly, calculating distance deviation and angle deviation between the position and the course of the unmanned vehicle and the planned path at the current moment by the controller according to the position information and the attitude information of the unmanned vehicle at the current moment transmitted by the GPS-RTK receiver.
As shown in fig. 1, a schematic diagram of the unmanned mowing vehicle for controlling the small deviation correction steering angle is given, wherein the planned path is 1, an arrow indicates a path direction, a vertical distance between a midpoint of the unmanned mowing vehicle and the planned path is d, and a distance deviation threshold value d is set t And alpha is the angle deviation between the current unmanned mowing vehicle and the planned path.
Step three, the controller is through comparing distance deviation and the distance deviation threshold value that sets up to combine the angle deviation, acquire unmanned car steering mechanism's steering angle, specifically include:
1) When the distance deviation is not less than the distance deviation threshold (i.e., d ≦ d) t Time), the steering angle θ is obtained by the following formula (1):
wherein, a 1 、b 1 The coefficient is set according to the actual debugging condition and is generally set as 1; theta.theta. max The maximum steering angle of the steering mechanism of the unmanned vehicle. In addition, in the present embodiment, the distance deviation threshold d is preferable t Equal to maximum speed V max Multiplied by the instruction period T.
2) When the distance deviation is greater than the distance deviation threshold (i.e., d)>d t ) The steering angle θ is obtained by the following relation (2):
where θ is positive for left turn and negative for right turn.
And step four, the controller sends the obtained steering angle of the steering mechanism of the unmanned vehicle to a steering motor of the unmanned vehicle in a control instruction form.
According to the unmanned mowing vehicle control method and the unmanned mowing vehicle, accurate position and posture information of the unmanned mowing vehicle can be obtained, and position deviation and angle deviation obtained by combining with planning path calculation are more accurate and effective; in addition, different correction steering strategies can be adopted according to different situations, and the correct track can be quickly returned to.
Further, since the steering motor will get a new steering angle command in each command cycle, and the steering mechanism will be damaged if a steering command is given frequently, the control method of the unmanned mowing vehicle further comprises the following steps after the third step and before the fourth step:
the steering angle obtained is corrected by the following step function (3):
wherein θ is the steering angle corrected in this step; and in addition, the controller sends the corrected steering angle to a steering motor of the unmanned vehicle in a control command form.
Fig. 4 is a schematic diagram of a steering angle step function, i.e. discretizing the original continuous steering angle output. The unmanned vehicle can avoid frequently operating the steering motor in the process of controlling the steering angle to realize the track tracking, thereby reducing the loss of the steering mechanism.
Further, a steering mechanism shake phenomenon still exists at the boundary value of the step function, and in order to eliminate the shake phenomenon, in the control method of the unmanned mowing vehicle of the invention, the step of correcting the obtained steering angle by the step function further comprises:
and adding a loop function on the basis of the step function so as to correct the obtained steering angle. Fig. 5 is a schematic diagram showing the effect of the increasing loop function, that is, a dead zone is arranged at the edge of the change of the output steering angle to prevent the jitter.
Further, in the control method of the unmanned mowing vehicle, when the unmanned mowing vehicle executes the trajectory tracking algorithm to output the steering angle, the current vehicle speed condition should be considered. Specifically, the method further comprises the following steps after the third step and before the fourth step:
correcting the steering angle according to the current vehicle speed condition of the unmanned vehicle, specifically adopting the following relational expression (4) to correct:
wherein, a 2 、b 2 The coefficient is set according to field debugging, so that the steering angle is correspondingly reduced when the speed is higher; v the current speed of the unmanned vehicle.
In the unmanned mowing vehicle of the invention, if the deviation of the trajectory tracking control precision of the unmanned mowing vehicle is D, the relationship between the distance L (namely, the effective swath) between two adjacent lines of the unmanned mowing vehicle and the actual swath S of the header is required to be set as follows:
L≤S-2·D (5)；
therefore, the unmanned mowing vehicle can be fully covered, and the phenomenon of missed cutting is avoided. At this time, the mowing coverage efficiency F of the unmanned mowing vehicle is as follows:
as shown in fig. 6, in an embodiment of the unmanned mowing vehicle of the present invention, the cutting header swath is 2.4 meters, and the unmanned mowing vehicle implements trajectory tracking control after adopting the control method, starts to run from a position with a deviation of-1 m, and quickly returns to a planned trajectory to run, and the overshoot deviation is less than 0.1m. Therefore, the effective cutting width L of the unmanned mowing vehicle is set to be 2m, and full-coverage mowing operation can be guaranteed.
The above description is only for the specific embodiment of the present invention, but the scope of the present invention is not limited thereto, and any changes or substitutions that can be easily conceived by those skilled in the art within the technical scope of the present invention are included in the scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.
Claims (10)
1. An unmanned vehicle control method is characterized by comprising the following steps:
the method comprises the steps of firstly, obtaining position information and posture information of an unmanned vehicle at the current moment;
step two, calculating the distance deviation and the angle deviation between the position and the course of the unmanned vehicle and the planned path at the current moment;
step three, comparing the distance deviation with a set distance deviation threshold value, and combining the angle deviation to obtain the steering angle of the steering mechanism of the unmanned vehicle, wherein the method specifically comprises the following steps:
when the distance deviation is not less than the distance deviation threshold value, a steering angle θ is obtained by the following formula (1):
wherein, a 1 、b 1 Is a coefficient of θ max Is the maximum steering angle of the steering mechanism of the unmanned vehicle, d t D is the vertical distance between the center point of the unmanned vehicle and the planned path, and alpha is the angle deviation between the unmanned vehicle and the planned path at the current moment;
when the distance deviation is larger than a distance deviation threshold value, a steering angle θ is obtained by the following relation (2):
wherein, theta is a positive value to indicate left steering, and theta is a negative value to indicate right steering;
and step four, sending the obtained steering angle of the steering mechanism of the unmanned vehicle to a steering motor of the unmanned vehicle in a control instruction form.
2. The unmanned vehicle control method of claim 1, further comprising, after step three and before step four, the steps of:
the steering angle obtained is corrected by the following step function (3):
wherein, theta ， The steering angle after this step of revising;
and in the fourth step, the corrected steering angle is sent to a steering motor of the unmanned vehicle in a control command form.
3. The unmanned vehicle control method according to claim 2, wherein in the step of correcting the obtained steering angle by the step function, further comprising:
and adding a loop function on the basis of the step function so as to correct the obtained steering angle.
4. The unmanned vehicle control method of claim 3, further comprising, after the third step and before the fourth step, the steps of:
correcting the steering angle according to the current speed condition of the unmanned vehicle, specifically adopting the following relational expression (4):
wherein, a 2 、b 2 And v is the coefficient of the current speed of the unmanned vehicle.
5. The unmanned aerial vehicle control method of claim 1, wherein the distance deviation threshold is equal to a maximum vehicle speed of the unmanned aerial vehicle at a current time multiplied by a command period.
6. An unmanned mowing vehicle, characterized by being controlled by the unmanned vehicle control method according to any one of claims 1 to 5, wherein the unmanned mowing vehicle comprises:
the first satellite receiving antenna is fixedly arranged at the center of a rear wheel shaft of the unmanned mowing vehicle;
the second satellite receiving antenna is fixedly arranged at the center of the front wheel shaft of the unmanned mowing vehicle;
the GPS-RTK receiver is fixedly arranged on the unmanned mowing vehicle and is used for acquiring the position information and the posture information of the unmanned mowing vehicle at the current moment according to the information received by the first satellite receiving antenna and the second satellite receiving antenna which are connected with the GPS-RTK receiver;
the controller is fixedly arranged on the unmanned mowing vehicle and is used for:
calculating distance deviation and angle deviation between the position and the course of the unmanned mowing vehicle and a planned path at the current moment according to the position information and the posture information of the unmanned mowing vehicle at the current moment;
calculating a steering angle of a steering mechanism of the unmanned mowing vehicle by comparing the distance deviation with a set distance deviation threshold value and combining the angle deviation;
and sending the obtained steering angle of the steering mechanism of the unmanned mowing vehicle to a steering motor of the unmanned mowing vehicle in a control instruction form.
7. The unmanned mowing vehicle of claim 6, wherein the controller is further configured to modify the obtained steering angle by a step function, and send the modified steering angle to a steering motor of the unmanned mowing vehicle in the form of a control command.
8. The unmanned mowing vehicle of claim 7, wherein the controller is further configured to add a sigmoid function to the step function to modify the obtained steering angle.
9. The unmanned mowing vehicle of claim 8, wherein the controller is further configured to modify the steering angle according to a current vehicle speed of the unmanned mowing vehicle.
10. The unmanned mowing vehicle according to claim 6, wherein the effective swath and the actual swath of the mowing platform of the unmanned mowing vehicle are determined according to the following relation (5):
L≤S-2·D (5)；
wherein L is an effective cutting width, S is an actual cutting width, and D is the deviation of the track tracking control precision of the unmanned mowing vehicle.
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711331721.0A CN107943049B (en) | 2017-12-13 | 2017-12-13 | Unmanned vehicle control method and unmanned mowing vehicle |
| PCT/CN2017/116120 WO2019113877A1 (en) | 2017-12-13 | 2017-12-14 | Unmanned vehicle control method and unmanned lawn mowing vehicle |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711331721.0A CN107943049B (en) | 2017-12-13 | 2017-12-13 | Unmanned vehicle control method and unmanned mowing vehicle |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107943049A true CN107943049A (en) | 2018-04-20 |
| CN107943049B CN107943049B (en) | 2020-04-21 |
Family
ID=61942951
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201711331721.0A Active CN107943049B (en) | 2017-12-13 | 2017-12-13 | Unmanned vehicle control method and unmanned mowing vehicle |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN107943049B (en) |
| WO (1) | WO2019113877A1 (en) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108536135A (en) * | 2017-03-06 | 2018-09-14 | 苏州宝时得电动工具有限公司 | Controlling of path thereof, device and clean robot |
| CN109976341A (en) * | 2019-03-21 | 2019-07-05 | 驭势科技（北京）有限公司 | A kind of method, mobile unit and the storage medium of automatic driving vehicle attachment road network |
| CN110045727A (en) * | 2018-12-03 | 2019-07-23 | 江西洪都航空工业集团有限责任公司 | A kind of garden unmanned vehicle path planning and control method |
| CN111103880A (en) * | 2019-12-23 | 2020-05-05 | 江苏大学 | Collaborative navigation operation path planning system and method for unmanned grain combine harvester |
| CN111137298A (en) * | 2020-01-02 | 2020-05-12 | 中车株洲电力机车有限公司 | Vehicle automatic driving method, device, system and storage medium |
| CN111422191A (en) * | 2020-04-14 | 2020-07-17 | 中国科学院计算技术研究所 | Automatic driving control system and method and electronic equipment |
| CN111650622A (en) * | 2020-05-30 | 2020-09-11 | 广东省现代农业装备研究所 | Universal target direction optimizing method for unmanned vehicle |
| CN111897322A (en) * | 2020-06-23 | 2020-11-06 | 北京旷视机器人技术有限公司 | Method and product for adjusting orientation of transport vehicle |
| CN111976703A (en) * | 2019-05-24 | 2020-11-24 | 北京京东尚科信息技术有限公司 | Unmanned driving control method and device |
| CN112462747A (en) * | 2019-08-19 | 2021-03-09 | 苏州宝时得电动工具有限公司 | Automatic walking equipment, control method and device |
| CN113207412A (en) * | 2021-04-15 | 2021-08-06 | 深圳拓邦股份有限公司 | Target tracking method of visual servo mowing robot and visual servo mowing robot |
| CN114460931A (en) * | 2021-12-23 | 2022-05-10 | 广东嘉腾机器人自动化有限公司 | Ribbon navigation deviation rectifying method, storage medium and electronic equipment |
| CN114721375A (en) * | 2022-03-14 | 2022-07-08 | 常州江苏大学工程技术研究院 | Agricultural machinery single-antenna navigation path tracking method |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115733867B (en) * | 2022-12-29 | 2024-04-16 | 阿维塔科技(重庆)有限公司 | Vehicle-mounted GPS data uploading method, system and equipment |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20020099481A1 (en) * | 2001-01-22 | 2002-07-25 | Masaki Mori | Travel controlling apparatus of unmanned vehicle |
| CN105022404A (en) * | 2015-06-18 | 2015-11-04 | 北京矿冶研究总院 | Underground unmanned scraper running positioning system and method |
| CN105716619A (en) * | 2016-02-18 | 2016-06-29 | 江西洪都航空工业集团有限责任公司 | Unmanned mowing vehicle outdoor navigation and control method based on GPS-RTK technology |
| CN106092054A (en) * | 2016-05-30 | 2016-11-09 | 广东能飞航空科技发展有限公司 | A kind of power circuit identification precise positioning air navigation aid |
| CN107247459A (en) * | 2017-07-24 | 2017-10-13 | 桂林航天工业学院 | Anti-interference flight control method and device |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103149938A (en) * | 2013-04-08 | 2013-06-12 | 中国航天空气动力技术研究院 | Emergency landing method of unmanned aerial vehicle based on radio and laser guiding |
-
2017
- 2017-12-13 CN CN201711331721.0A patent/CN107943049B/en active Active
- 2017-12-14 WO PCT/CN2017/116120 patent/WO2019113877A1/en active Application Filing
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20020099481A1 (en) * | 2001-01-22 | 2002-07-25 | Masaki Mori | Travel controlling apparatus of unmanned vehicle |
| CN105022404A (en) * | 2015-06-18 | 2015-11-04 | 北京矿冶研究总院 | Underground unmanned scraper running positioning system and method |
| CN105716619A (en) * | 2016-02-18 | 2016-06-29 | 江西洪都航空工业集团有限责任公司 | Unmanned mowing vehicle outdoor navigation and control method based on GPS-RTK technology |
| CN106092054A (en) * | 2016-05-30 | 2016-11-09 | 广东能飞航空科技发展有限公司 | A kind of power circuit identification precise positioning air navigation aid |
| CN107247459A (en) * | 2017-07-24 | 2017-10-13 | 桂林航天工业学院 | Anti-interference flight control method and device |
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108536135A (en) * | 2017-03-06 | 2018-09-14 | 苏州宝时得电动工具有限公司 | Controlling of path thereof, device and clean robot |
| CN110045727A (en) * | 2018-12-03 | 2019-07-23 | 江西洪都航空工业集团有限责任公司 | A kind of garden unmanned vehicle path planning and control method |
| CN110045727B (en) * | 2018-12-03 | 2022-08-05 | 江西洪都航空工业集团有限责任公司 | Park unmanned vehicle path planning and control method |
| CN109976341A (en) * | 2019-03-21 | 2019-07-05 | 驭势科技（北京）有限公司 | A kind of method, mobile unit and the storage medium of automatic driving vehicle attachment road network |
| CN111976703A (en) * | 2019-05-24 | 2020-11-24 | 北京京东尚科信息技术有限公司 | Unmanned driving control method and device |
| CN112462747A (en) * | 2019-08-19 | 2021-03-09 | 苏州宝时得电动工具有限公司 | Automatic walking equipment, control method and device |
| CN111103880A (en) * | 2019-12-23 | 2020-05-05 | 江苏大学 | Collaborative navigation operation path planning system and method for unmanned grain combine harvester |
| CN111137298A (en) * | 2020-01-02 | 2020-05-12 | 中车株洲电力机车有限公司 | Vehicle automatic driving method, device, system and storage medium |
| CN111137298B (en) * | 2020-01-02 | 2021-11-16 | 中车株洲电力机车有限公司 | Vehicle automatic driving method, device, system and storage medium |
| CN111422191A (en) * | 2020-04-14 | 2020-07-17 | 中国科学院计算技术研究所 | Automatic driving control system and method and electronic equipment |
| CN111650622A (en) * | 2020-05-30 | 2020-09-11 | 广东省现代农业装备研究所 | Universal target direction optimizing method for unmanned vehicle |
| CN111650622B (en) * | 2020-05-30 | 2023-08-11 | 广东省现代农业装备研究所 | Unmanned vehicle universal target direction optimizing method |
| CN111897322A (en) * | 2020-06-23 | 2020-11-06 | 北京旷视机器人技术有限公司 | Method and product for adjusting orientation of transport vehicle |
| CN113207412A (en) * | 2021-04-15 | 2021-08-06 | 深圳拓邦股份有限公司 | Target tracking method of visual servo mowing robot and visual servo mowing robot |
| CN114460931A (en) * | 2021-12-23 | 2022-05-10 | 广东嘉腾机器人自动化有限公司 | Ribbon navigation deviation rectifying method, storage medium and electronic equipment |
| CN114721375A (en) * | 2022-03-14 | 2022-07-08 | 常州江苏大学工程技术研究院 | Agricultural machinery single-antenna navigation path tracking method |
| CN114721375B (en) * | 2022-03-14 | 2024-03-26 | 常州江苏大学工程技术研究院 | Agricultural machinery single antenna navigation path tracking method |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107943049B (en) | 2020-04-21 |
| WO2019113877A1 (en) | 2019-06-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107943049B (en) | Unmanned vehicle control method and unmanned mowing vehicle | |
| US10696301B2 (en) | Vehicle control device | |
| CN102393744B (en) | Navigation method of pilotless automobile | |
| US20180102058A1 (en) | High-precision autonomous obstacle-avoidance flying method for unmanned aerial vehicle | |
| US10401856B2 (en) | Vehicle travel control apparatus | |
| US9428187B2 (en) | Lane change path planning algorithm for autonomous driving vehicle | |
| US9499197B2 (en) | System and method for vehicle steering control | |
| Wooden et al. | Autonomous navigation for BigDog | |
| WO2016178294A1 (en) | Induction control system for autonomous-traveling vehicle | |
| Saska et al. | Coordination and navigation of heterogeneous UAVs-UGVs teams localized by a hawk-eye approach | |
| US8306727B2 (en) | Method and system for coordinated vehicle control with wireless communication | |
| CN109987092A (en) | A kind of determination method on vehicle obstacle-avoidance lane-change opportunity and the control method of avoidance lane-change | |
| CN111006667B (en) | Automatic driving track generation system under high-speed scene | |
| CN109976329A (en) | A kind of planing method in vehicle obstacle-avoidance lane-change path | |
| CN105752154B (en) | Vehicle steering control system and method | |
| CN111650958A (en) | Online path planning method for switching in route points of take-off section of fixed-wing unmanned aerial vehicle | |
| CN113815646B (en) | Intelligent driving method of vehicle, vehicle and readable storage medium | |
| Rodriguez-Castaño et al. | High-speed autonomous navigation system for heavy vehicles | |
| CN112731934B (en) | Method for quickly returning intelligent mower to charging station based on region segmentation | |
| JP4939170B2 (en) | Tracking system | |
| Cheng et al. | Curve path tracking control for tractor-trailer mobile robot | |
| Avanzini et al. | Manual convoying of automated urban vehicles relying on monocular vision | |
| CN114281109A (en) | Multi-machine cooperation control system guided by unmanned aerial vehicle | |
| CN114137988A (en) | Robot path navigation deviation rectifying method, system and storage medium | |
| CN111930115A (en) | Big data-based robot path planning data management system |
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 |