CN110297502B - Line control chassis track tracking control system and method based on UWB positioning - Google Patents

Line control chassis track tracking control system and method based on UWB positioning Download PDF

Info

Publication number
CN110297502B
CN110297502B CN201910494171.7A CN201910494171A CN110297502B CN 110297502 B CN110297502 B CN 110297502B CN 201910494171 A CN201910494171 A CN 201910494171A CN 110297502 B CN110297502 B CN 110297502B
Authority
CN
China
Prior art keywords
vehicle
control
deviation
positioning
course angle
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.)
Active
Application number
CN201910494171.7A
Other languages
Chinese (zh)
Other versions
CN110297502A (en
Inventor
聂家弘
马芳武
代凯
周煊
史津竹
仲首任
郭荣辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Zhilai Technology Co ltd
Original Assignee
Zhejiang Zhilai Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang Zhilai Technology Co ltd filed Critical Zhejiang Zhilai Technology Co ltd
Priority to CN201910494171.7A priority Critical patent/CN110297502B/en
Publication of CN110297502A publication Critical patent/CN110297502A/en
Application granted granted Critical
Publication of CN110297502B publication Critical patent/CN110297502B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/12Target-seeking control

Abstract

The invention discloses a track tracking control system and a track tracking control method of a drive-by-wire chassis based on UWB positioning, which are characterized in that real-time positioning data of a vehicle is obtained based on a UWB positioning technology, and a high-order perturbation filtering method is adopted to subtract the positioning data from a reference track to obtain the control quantity of the current moment, including transverse position deviation and course angle deviation; two subsystems are decomposed based on an inversion method: the system comprises a transverse position deviation control subsystem and a course angle deviation control subsystem, wherein the transverse position deviation control subsystem and the course angle deviation control subsystem form a closed-loop control system, and according to control quantity, the wheel rotation angle and the driving moment are calculated and obtained to drive the vehicle to move forwards, so that the tracking of a reference track is completed. According to the invention, good data fusion is carried out between UWB and vehicle track tracking control, and the track tracking control of the invention has good system robustness and safety by using a high-order perturbation filtering method.

Description

Line control chassis track tracking control system and method based on UWB positioning
Technical Field
The invention belongs to the field of track tracking, and particularly relates to a track-by-wire chassis track tracking control system and method based on UWB positioning.
Background
Regarding UWB near-field location technology: as a perception link in an unmanned vehicle perception-decision-making-execution system, a plurality of high and new technologies such as SLAM, high-precision maps, GPS-RTK and the like are developed at present. But the SLAM technology is not mature, the high-precision map cooperation is too few, and the GPS cost is higher.
The Ultra Wide Band (UWB) is a novel wireless communication technology, according to the specification of the Federal communications Commission in the United states, the working frequency Band of the UWB is 3.1-10.6 GHz, the ratio of the system-10 dB bandwidth to the system center frequency is more than 20% or the system bandwidth is at least 500 MHz. The generation of the UWB signal can be realized by modulating a narrow pulse (such as a secondary Gaussian pulse) with extremely short transmission time (such as 2ns) to a UWB working frequency band in an up-conversion mode such as differentiation or frequency mixing.
The ultra-wideband has the main advantages of low power consumption, insensitivity to channel fading (such as multipath and non-line-of-sight channels), strong anti-interference capability, no interference to other equipment in the same environment, strong penetrability (positioning can be performed in an environment penetrating through a brick wall), and very high positioning accuracy and positioning precision.
The technology adopts TDOA (time difference of arrival principle), and utilizes UWB technology to measure the time difference of the propagation of radio signals between a positioning tag and two different positioning base stations, thereby obtaining the distance difference of the positioning tag relative to four groups of positioning base stations. By using the TDOA technology, the positioning tags do not need to carry out reciprocating communication with the positioning base stations, and only the positioning tags need to transmit or receive UWB signals, so that higher positioning dynamic and positioning capacity can be achieved.
Regarding the automobile trajectory tracking technology: as one of several key technologies of the smart car, the trajectory following control of the smart car mainly studies how to realize the unmanned operation of the vehicle by controlling a steering system and a braking/driving system of the vehicle so that the vehicle can travel along a desired route at a desired speed. Considering that various parts constituting a vehicle, such as tires, suspensions, steering systems, etc., are nonlinear systems, there are couplings between different parts, and uncertainty of parameters of the vehicle, such as mass, etc., it is difficult to establish an accurate vehicle dynamics model; in addition, the running working conditions are complex and changeable, which brings great difficulty to the track following control of the vehicle.
In most of the current research methods for trajectory following, the method is mainly derived from the predictive theory and the model predictive theory in principle. In order to facilitate the processing of constraints and simultaneously consider the influence of road curvature on the track following effect, a track following controller based on model predictive control is gradually becoming a hot point of research. The MPC controller is also called a rolling time domain controller, predicts the output behavior of the system in a future period of time according to a dynamic model of the control system, considers the dynamic characteristic constraint and the state constraint of each actuator in the system, and solves the optimal control problem with the constraint to minimize the tracking error of the system in the future period of time so as to obtain the optimal control input. As the model prediction control algorithm has the excellent characteristics of model prediction, rolling optimization, feedback correction and the like, the MPC controller has good adaptivity and robustness.
The disadvantages of the prior art are summarized as follows:
1. for realizing vehicle positioning in the track tracking technology, the existing positioning method is difficult to balance between cost and precision; some positioning methods (such as RTK-GPS) have higher cost, and the positioning accuracy is insufficient by using the GPS alone, so that the positioning method is difficult to be applied in a fixed scene;
2. for a track tracking algorithm, the existing method is difficult to balance in the aspects of calculated amount and tracking precision; some track tracking algorithms (such as MPC) rely on stronger computing processing capability, and the tracking accuracy is difficult to guarantee by using the traditional track tracking method (such as single point preview);
3. in a track tracking control algorithm, the intelligent vehicle tracking control method is not well integrated with a vehicle sensing system, and most of the intelligent vehicle tracking control method is developed by using a sensing-planning-control framework, so that the flexibility of the intelligent vehicle system is insufficient.
Disclosure of Invention
The invention aims to provide a system and a method for controlling track-by-wire chassis track tracking based on UWB positioning aiming at the defects of the prior art, and is used for solving the following problems:
1. searching a low-cost high-precision track tracking positioning scheme in a fixed scene (such as a park and a factory);
2. the vehicle track tracking steering angle control law is deduced by using an inversion method, so that the calculation amount and the tracking precision are well balanced;
3. relevant process quantities in a UWB positioning system are introduced into track tracking control obtained by derivation based on an inversion method, so that the UWB positioning unit and the track tracking control unit are better fused, and the robustness of the system is enhanced;
the purpose of the invention is realized by the following technical scheme: a line control chassis track tracking control system based on UWB positioning comprises a UWB positioning unit and a track tracking control unit;
a UWB positioning unit: the method comprises the steps that vehicle real-time positioning data are obtained on the basis of a UWB positioning technology, a high-order perturbation filtering method is adopted, and the positioning data and a reference track are subtracted to obtain control quantity at the current moment, wherein the control quantity comprises transverse position deviation and course angle deviation;
a trajectory tracking control unit: the unit is a closed-loop control system, and two subsystems are decomposed based on an inversion method: and the transverse position deviation control subsystem and the course angle deviation control subsystem calculate to obtain the wheel rotation angle and the driving moment according to the control quantity output by the UWB positioning unit, drive the vehicle to move forwards and complete the tracking of the reference track.
Further, the UWB positioning unit comprises a vehicle-mounted antenna and at least three positioning base stations; the positioning base station and the vehicle-mounted antenna are respectively supplied with power, the system automatically networks after power supply, and the vehicle-mounted antenna and the base station synchronously output positioning data in real time, wherein the positioning data comprise the current position coordinates of the vehicle and the angles between the vehicle and each positioning base station.
Further, the formula of the high-order perturbation filtering method adopted by the UWB positioning unit is as follows:
Figure BDA0002087236930000031
in the formula a1-akWhen the sampling frequency is k, positioning data which contains the shooting amount and is acquired by the UWB positioning technology at the current moment, namely, the originally acquired data; fyIs a higher order of the current timeAn output value, when the positioning data is the coordinates of the current position of the vehicle, FyTransverse position P to reference trackyMaking a difference to obtain the transverse position deviation y of the current moment; when the positioning data is the angle between the vehicle and each positioning base station, FyThe difference is made with the reference course angle theta, and the course angle deviation of the current moment can be obtained
Figure BDA0002087236930000032
Further, a control law is derived from an inversion method in the trajectory tracking control unit, and the implementation process is as follows:
firstly, the control of the transverse position deviation y of the transverse position deviation control subsystem is carried out, which specifically comprises the following steps:
according to the kinematic model of the vehicle, it can be known that:
Figure BDA0002087236930000033
wherein
Figure BDA0002087236930000034
As the transverse speed of the vehicle, VrAs is the longitudinal speed of the vehicle,
Figure BDA0002087236930000035
is the course angle deviation, deltaFIs the steering angle, beta, of the front wheelFIs a front wheel side slip angle;
virtual control law for controlling transverse position deviation to subsystem
Figure BDA0002087236930000036
The tracking target of the course angle deviation control subsystem is used for carrying out course angle deviation of the course angle deviation control subsystem
Figure BDA0002087236930000037
The formula is as follows:
Figure BDA0002087236930000038
Figure BDA0002087236930000039
Figure BDA00020872369300000310
wherein
Figure BDA00020872369300000311
Is composed of
Figure BDA00020872369300000312
L is the vehicle wheelbase, c(s) is the road curvature;
taking the virtual control rate of the course angle deviation control subsystem as the actual control law of the whole closed-loop control system to finally obtain the front wheel steering angle deltaFDeviation from lateral position y and course angle
Figure BDA00020872369300000313
The relationship of (c) is:
Figure BDA00020872369300000314
wherein beta isRFor the rear wheel side slip angle, α is an intermediate variable, α is 1-c(s) y.
A drive-by-wire chassis track tracking control method based on UWB positioning comprises the following steps:
(1) acquiring real-time positioning data of the vehicle based on a UWB positioning technology, wherein the positioning data comprises current position coordinates of the vehicle and angles between the vehicle and each positioning base station, and then subtracting a reference track from the positioning data by adopting a high-order perturbation filtering method to obtain control quantity at the current moment, including transverse position deviation and course angle deviation;
(2) two subsystems are decomposed based on an inversion method: and (2) a transverse position deviation control subsystem and a course angle deviation control subsystem, wherein the two subsystems form a closed-loop control system, and the wheel rotation angle and the driving torque are calculated according to the control quantity at the current moment obtained in the step (1) to drive the vehicle to move forwards so as to complete the tracking of the reference track.
The invention has the beneficial effects that:
1. the UWB positioning technology is applied to vehicle track tracking control in a fixed scene, high-precision positioning in a given space can be realized, the calculation cost is saved, and the practicability is high;
2. the track tracking control method can complete track tracking operation with higher precision in smaller calculated amount, saves the calculation cost and has stronger practicability;
3. according to the invention, good data fusion is innovatively carried out between UWB and vehicle track tracking control, and a high-order perturbation filtering method is deduced, so that the track tracking control under the method has good system robustness and safety.
Drawings
FIG. 1 is a UWB positioning schematic;
FIG. 2 is a diagram of a trajectory tracking scheme;
FIG. 3 is a trajectory tracking framework;
FIG. 4 is a view of the drive-by-wire chassis;
fig. 5 is a graph of the experimental results.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
The invention completes the track tracking control of the drive-by-wire chassis based on the UWB near-field positioning technology and the automobile track tracking technology.
The invention provides a line control chassis track tracking control system based on UWB positioning, which comprises a UWB positioning unit and a track tracking control unit;
a UWB positioning unit: acquiring real-time positioning data of a vehicle based on a UWB positioning technology, and subtracting the reference track from the positioning data by adopting a high-order perturbation filtering method to finally obtain the control quantity of the current moment, wherein the control quantity comprises transverse position deviation and course angle deviation;
a trajectory tracking control unit: according to the control quantity output by the UWB positioning unit, the wheel turning angle and the driving moment are obtained through calculation, and the vehicle is driven to move forwards through the steer-by-wire actuator and the driving motor; the UWB positioning antenna mounted on the vehicle acquires the vehicle positioning data at the next moment, and so on, and completes the tracking of the reference trajectory, as shown in fig. 3.
As shown in fig. 1, the UWB positioning technology is composed of at least three positioning base stations and a vehicle-mounted antenna. The positioning base station and the vehicle-mounted antenna are respectively supplied with power, the system automatically networks after power supply, and the vehicle-mounted antenna and the base station synchronously output positioning data in real time, wherein the positioning data comprise the current position coordinates of the vehicle and the angles between the vehicle and each positioning base station. Specifically, the vehicle-mounted antenna obtains the distance of a base station through measurement, and can determine a spherical surface; measuring the distance between the two base stations to determine a circle; one or two unique spatial positions can be determined by measuring the distances between the three base stations, and the final three-dimensional position of the vehicle-mounted antenna is obtained by judging and omitting one position; if four or more base stations are used, redundant observed quantities are increased, the more the observable information quantity is, the higher the reliability is, and the precision is improved accordingly. This is the same as the GPS principle, and the greater the number of satellites, the greater the observations that can be provided to the receiver, and the greater the positioning accuracy. Different from the GPS, the base station positioning system is in a relatively small indoor and outdoor environment, and the signal transmission distance is short, so that the influence of errors such as time delay, ionospheric refraction and the like generated in the transmission process can be ignored. Therefore, the method is suitable for the development of vehicle track tracking operation in the garden.
As shown in fig. 4, the drive-by-wire chassis is composed of a vehicle control unit 1, a driving motor 2, a hydraulic braking system 3, a power battery pack 4, a wireless communication module 5, a steer-by-wire system 6, a UWB vehicle-mounted antenna 7 and the like.
The high-order perturbation filtering method is described as follows: if the positioning data (the current position coordinates of the vehicle and the angles between the vehicle and each positioning base station) are not filtered, the real-time performance of the positioning data is high, but the noise is large. When different filtering modes are adopted to filter data, data with higher precision can be obtained. Most of the noise in the original data is the amount of perturbation, and the high-order perturbation filtering is to filter the amount of perturbation noise in the original data under the control idea of the minimum high-order amount, so as to finally obtain good data which is stable in data and can be subjected to data fusion with the trajectory planning control part. The specific formula is as follows:
Figure BDA0002087236930000051
in the formula a1-akWhen the sampling frequency is k, positioning data which contains the shooting amount and is acquired by the UWB positioning technology at the current moment, namely, the originally acquired data; fyFor the high-order output value of the current time, when the positioning data is the coordinates of the current position of the vehicle, F isyTransverse position P to the reference trackyMaking a difference to obtain the transverse position deviation y of the current moment; when the positioning data is the angle between the vehicle and each positioning base station, FyThe difference is made with the reference course angle theta, and the course angle deviation of the current moment can be obtained
Figure BDA0002087236930000054
And then, deriving a turning angle control law of the vehicle by an inversion method, so that data output by the UWB positioning unit is fused with the track tracking control unit to obtain a track tracking control system with higher stability and robustness.
And the specific control law of the track tracking control unit is derived by an inversion method. The basic design idea of the inversion method is to decompose a complex nonlinear system into subsystems with the order not exceeding the system order, then separately design a part of control functions of each subsystem, obtain a virtual control law of the subsystem on the basis of ensuring that the subsystems have certain convergence, and in the design of the next subsystem, take the virtual control law of the previous subsystem as a tracking target of the subsystem. Similar to the design of the previous subsystem, obtaining the virtual control law of the subsystem; by parity of reasoning, finally obtain the wholeThe actual control law of a closed loop system. In the trajectory tracking control unit, the vehicle positioning data is subtracted from the reference trajectory to obtain two control inputs, namely a lateral position deviation y and a course angle deviation
Figure BDA0002087236930000052
The track tracking control unit is a closed-loop control system, and two subsystems are decomposed based on an inversion method: as shown in fig. 2, the lateral position deviation control subsystem and the heading angle deviation control subsystem are implemented as follows:
firstly, the control of the lateral position deviation y of the lateral position deviation control subsystem is carried out, specifically as follows:
according to the kinematic model of the vehicle, it can be known that:
Figure BDA0002087236930000053
wherein
Figure BDA0002087236930000061
As the transverse speed of the vehicle, VrFor the longitudinal speed of the vehicle, V is taken, usually during experiments in which the vehicle is run at a constant longitudinal speedr=2m/s,
Figure BDA0002087236930000062
Is the course angle deviation, deltaFFor front wheel steering angle, betaFIs a front wheel side slip angle.
Virtual control law for controlling transverse position deviation to subsystem
Figure BDA0002087236930000063
The tracking target of the course angle deviation control subsystem is used for carrying out course angle deviation of the course angle deviation control subsystem
Figure BDA0002087236930000064
The formula is as follows:
Figure BDA0002087236930000065
Figure BDA0002087236930000066
Figure BDA0002087236930000067
wherein
Figure BDA0002087236930000068
Is composed of
Figure BDA0002087236930000069
L is the vehicle wheelbase, c(s) is the road curvature.
Taking the virtual control rate of the course angle deviation control subsystem as the actual control law of the whole closed-loop control system to finally obtain the front wheel steering angle deltaFDeviation from lateral position y and course angle
Figure BDA00020872369300000610
The relationship of (1) is:
Figure BDA00020872369300000611
wherein beta isRFor the rear wheel side slip angle, α is an intermediate variable, α is 1-c(s) y.
The experimental result shows that under the working condition of transverse lane changing, the whole track tracking control system is stable after about 5 seconds, and the transverse deviation and the course angle deviation are within an acceptable range at the moment, so that the effect is better.
In fig. 5(a), the abscissa is time, the ordinate is a heading angle (in radians), the solid line represents a reference heading angle, and the dash-dot line represents an actual heading angle, so that the tracking accuracy of the heading angle is high, and the maximum error does not exceed 0.02 rad.
In fig. 5(b), the abscissa is time, the ordinate is the lateral position (in meters) of the reference track, the solid line represents the lateral position of the reference track, and the dash-dot line represents the lateral position in actual operation, and it can be seen from the figure that the tracking accuracy of the lateral position is high, and the maximum error is not more than 0.5 m.
The above are merely examples of the present invention, and are not intended to limit the scope of the present invention. Any modification, equivalent replacement, improvement and the like, which are not made by the inventive work, are included in the scope of protection of the present invention within the spirit and principle of the present invention.

Claims (4)

1. A drive-by-wire chassis track tracking control system based on UWB positioning is characterized by comprising a UWB positioning unit and a track tracking control unit;
a UWB positioning unit: acquiring real-time positioning data of a vehicle based on a UWB positioning technology, and subtracting a reference track from the positioning data by adopting a high-order perturbation filtering method to obtain a control quantity at the current moment, wherein the control quantity comprises a transverse position deviation and a course angle deviation;
a trajectory tracking control unit: the unit is a closed-loop control system, and two subsystems are decomposed based on an inversion method: the transverse position deviation control subsystem and the course angle deviation control subsystem calculate to obtain a wheel corner and a driving moment according to the control quantity output by the UWB positioning unit, drive the vehicle to move forwards and complete the tracking of a reference track; the track tracking control unit derives a control law by an inversion method, and the implementation process is as follows: firstly, the control of the transverse position deviation y of the transverse position deviation control subsystem is carried out, which specifically comprises the following steps:
according to the kinematic model of the vehicle, it can be known that:
Figure FDA0003560091600000011
wherein
Figure FDA0003560091600000012
As the transverse speed of the vehicle, VrIn the longitudinal direction of the vehicleThe speed of the motor is controlled by the speed of the motor,
Figure FDA0003560091600000013
is the course angle deviation, deltaFIs the steering angle, beta, of the front wheelFIs a front wheel side slip angle;
virtual control law for controlling transverse position deviation to subsystem
Figure FDA0003560091600000014
The tracking target of the course angle deviation control subsystem is used for carrying out course angle deviation of the course angle deviation control subsystem
Figure FDA0003560091600000015
The formula is as follows:
Figure FDA0003560091600000016
Figure FDA0003560091600000017
Figure FDA0003560091600000018
wherein
Figure FDA0003560091600000019
Is composed of
Figure FDA00035600916000000110
L is the vehicle wheelbase, c(s) is the road curvature;
taking the virtual control rate of the course angle deviation control subsystem as the actual control law of the whole closed-loop control system to finally obtain the front wheel steering angle deltaFDeviation from lateral position y and course angle
Figure FDA00035600916000000111
The relationship of (1) is:
Figure FDA00035600916000000112
wherein beta isRFor the rear wheel side slip angle, α is an intermediate variable, α is 1-c(s) y.
2. The system of claim 1, wherein the UWB positioning unit comprises a vehicle-mounted antenna and at least three positioning base stations; the positioning base station and the vehicle-mounted antenna are respectively supplied with power, the system automatically networks after power supply, and the vehicle-mounted antenna and the base station synchronously output positioning data in real time, wherein the positioning data comprise the current position coordinates of the vehicle and the angles between the vehicle and each positioning base station.
3. The system according to claim 1, wherein the UWB positioning unit employs a higher order perturbation filtering method according to the following formula:
Figure FDA0003560091600000021
in the formula a1-akWhen the sampling frequency is k, positioning data which contains the shooting amount and is acquired by the UWB positioning technology at the current moment, namely, the originally acquired data; fyFor the high-order output value of the current time, when the positioning data is the coordinates of the current position of the vehicle, F isyTransverse position P to the reference trackyMaking a difference to obtain the transverse position deviation y of the current moment; when the positioning data is the angle between the vehicle and each positioning base station, FyThe difference is made with the reference course angle theta, and the course angle deviation of the current moment can be obtained
Figure FDA0003560091600000022
4. A line control chassis track tracking control method based on UWB positioning is characterized by comprising the following steps:
(1) acquiring real-time positioning data of the vehicle based on a UWB positioning technology, wherein the positioning data comprises current position coordinates of the vehicle and angles between the vehicle and each positioning base station, and then subtracting a reference track from the positioning data by adopting a high-order perturbation filtering method to obtain control quantity at the current moment, including transverse position deviation and course angle deviation;
(2) two subsystems are decomposed based on an inversion method: the system comprises a transverse position deviation control subsystem and a course angle deviation control subsystem, wherein the transverse position deviation control subsystem and the course angle deviation control subsystem form a closed-loop control system, and according to the control quantity at the current moment obtained in the step (1), the wheel rotation angle and the driving moment are calculated to drive the vehicle to move forwards so as to complete the tracking of a reference track; the specific steps of decomposing two subsystems by an inversion method are as follows: firstly, the control of the lateral position deviation y of the lateral position deviation control subsystem is carried out, specifically as follows:
according to the kinematic model of the vehicle, it can be known that:
Figure FDA0003560091600000023
wherein
Figure FDA0003560091600000024
As the transverse speed of the vehicle, VrAs is the longitudinal speed of the vehicle,
Figure FDA0003560091600000025
is the course angle deviation, deltaFIs the steering angle, beta, of the front wheelFIs a front wheel side slip angle;
virtual control law for controlling transverse position deviation
Figure FDA0003560091600000026
As a shipTracking target of the heading angle deviation control subsystem, and performing heading angle deviation of the heading angle deviation control subsystem
Figure FDA0003560091600000027
The formula is as follows:
Figure FDA0003560091600000028
Figure FDA0003560091600000029
Figure FDA00035600916000000210
wherein
Figure FDA0003560091600000031
Is composed of
Figure FDA0003560091600000032
L is the vehicle wheelbase, c(s) is the road curvature;
taking the virtual control rate of the course angle deviation control subsystem as the actual control law of the whole closed-loop control system to finally obtain the front wheel steering angle deltaFDeviation from lateral position y and course angle
Figure FDA0003560091600000033
The relationship of (1) is:
Figure FDA0003560091600000034
wherein beta isRFor the rear wheel side slip angle, α is an intermediate variable, α is 1-c(s) y.
CN201910494171.7A 2019-06-06 2019-06-06 Line control chassis track tracking control system and method based on UWB positioning Active CN110297502B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910494171.7A CN110297502B (en) 2019-06-06 2019-06-06 Line control chassis track tracking control system and method based on UWB positioning

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910494171.7A CN110297502B (en) 2019-06-06 2019-06-06 Line control chassis track tracking control system and method based on UWB positioning

Publications (2)

Publication Number Publication Date
CN110297502A CN110297502A (en) 2019-10-01
CN110297502B true CN110297502B (en) 2022-07-01

Family

ID=68027680

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910494171.7A Active CN110297502B (en) 2019-06-06 2019-06-06 Line control chassis track tracking control system and method based on UWB positioning

Country Status (1)

Country Link
CN (1) CN110297502B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113271547B (en) * 2021-05-24 2022-12-06 福建盛海智能科技有限公司 Unmanned tracking driving method and terminal based on UWB array positioning navigation

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101713999A (en) * 2009-11-18 2010-05-26 北京矿冶研究总院 Navigation control method of underground autonomous scraper
CN103197675A (en) * 2013-03-13 2013-07-10 北京矿冶研究总院 Autonomous driving and obstacle avoidance motion control and target path planning method for underground carry scraper
WO2016011433A2 (en) * 2014-07-17 2016-01-21 Origin Wireless, Inc. Wireless positioning systems
CN107415939A (en) * 2017-03-17 2017-12-01 江苏大学 A kind of distributed-driving electric automobile steering stability control method
CN108008720A (en) * 2017-10-31 2018-05-08 哈尔滨理工大学 The fuzzy sliding mode Trajectory Tracking Control and method of a kind of wheeled mobile robot
CN108622104A (en) * 2018-05-07 2018-10-09 湖北汽车工业学院 A kind of Trajectory Tracking Control method for automatic driving vehicle
CN108844543A (en) * 2018-06-08 2018-11-20 南通大学 Indoor AGV navigation control method based on UWB positioning and dead reckoning
CN109491395A (en) * 2018-12-24 2019-03-19 山东农业大学 Greenhouse AUTONOMOUS TASK Navigation Control Unit, method and controller
CN109606368A (en) * 2018-11-19 2019-04-12 江苏大学 A kind of intelligent automobile can open up speed adaptive change Trajectory Tracking Control method

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101713999A (en) * 2009-11-18 2010-05-26 北京矿冶研究总院 Navigation control method of underground autonomous scraper
CN103197675A (en) * 2013-03-13 2013-07-10 北京矿冶研究总院 Autonomous driving and obstacle avoidance motion control and target path planning method for underground carry scraper
WO2016011433A2 (en) * 2014-07-17 2016-01-21 Origin Wireless, Inc. Wireless positioning systems
CN107415939A (en) * 2017-03-17 2017-12-01 江苏大学 A kind of distributed-driving electric automobile steering stability control method
CN108008720A (en) * 2017-10-31 2018-05-08 哈尔滨理工大学 The fuzzy sliding mode Trajectory Tracking Control and method of a kind of wheeled mobile robot
CN108622104A (en) * 2018-05-07 2018-10-09 湖北汽车工业学院 A kind of Trajectory Tracking Control method for automatic driving vehicle
CN108844543A (en) * 2018-06-08 2018-11-20 南通大学 Indoor AGV navigation control method based on UWB positioning and dead reckoning
CN109606368A (en) * 2018-11-19 2019-04-12 江苏大学 A kind of intelligent automobile can open up speed adaptive change Trajectory Tracking Control method
CN109491395A (en) * 2018-12-24 2019-03-19 山东农业大学 Greenhouse AUTONOMOUS TASK Navigation Control Unit, method and controller

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于预瞄距离的地下矿用铰接车路径跟踪预测控制;孟宇等;《工程科学学报》;20190531;第41卷(第5期);第662--671页 *

Also Published As

Publication number Publication date
CN110297502A (en) 2019-10-01

Similar Documents

Publication Publication Date Title
CN108222093B (en) Automatic bulldozing robot
CN104932548B (en) A kind of unmanned plane directional aerial autotracking systems design method
CN111885504B (en) Unmanned aerial vehicle track optimization method for assisting wireless communication of mobile vehicle
CN102928816B (en) High-reliably integrated positioning method for vehicles in tunnel environment
CN111949943A (en) Vehicle fusion positioning method for V2X and laser point cloud registration for advanced automatic driving
CN110716558A (en) Automatic driving system for non-public road based on digital twin technology
CN107132563B (en) Combined navigation method combining odometer and dual-antenna differential GNSS
Zha et al. A survey of intelligent driving vehicle trajectory tracking based on vehicle dynamics
CN102393744A (en) Navigation method of pilotless automobile
CN111137298B (en) Vehicle automatic driving method, device, system and storage medium
CN112435496B (en) Vehicle and ship intelligent navigation control early warning device and method based on multiple sensors
CN107592623A (en) The method of suspended rail automatic driving vehicle precise positioning and ranging based on UWB and DGPS technologies
CN113264049B (en) Intelligent networking fleet cooperative lane change control method
CN110716565B (en) Track vehicle navigation track tracking control system
CN111487976B (en) Backing track tracking method
AU2021106247A4 (en) Vehicle fusion positioning method based on V2X and laser point cloud registration for advanced automatic driving
Rodriguez-Castaño et al. High-speed autonomous navigation system for heavy vehicles
CN110825078A (en) Ground turning path control system of autonomous navigation tracked vehicle
CN109814550A (en) It is a kind of for closing the unmanned transport vehicle of garden
CN110297502B (en) Line control chassis track tracking control system and method based on UWB positioning
CN103454614A (en) Method for relative positioning between vehicles based on particle filters
Huang et al. Path tracking based on improved pure pursuit model and pid
Zhang et al. Review on UWB-based and multi-sensor fusion positioning algorithms in indoor environment
Ke et al. Cooperative adaptive cruise control using vehicle-to-vehicle communication and deep learning
CN111198567B (en) Multi-AGV collaborative dynamic tracking method and device

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
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20191001

Assignee: Hangzhou Changdian Technology Co.,Ltd.

Assignor: ZHEJIANG ZHILAI TECHNOLOGY Co.,Ltd.

Contract record no.: X2023980042756

Denomination of invention: A Wire Control Chassis Trajectory Tracking Control System and Method Based on UWB Positioning

Granted publication date: 20220701

License type: Common License

Record date: 20230927

EE01 Entry into force of recordation of patent licensing contract