Composite anti-interference trajectory tracking control algorithm of unmanned rolling machine

A trajectory tracking and unmanned driving technology, which is applied in the direction of non-electric variable control, control/regulation system, three-dimensional position/channel control, etc.

Active Publication Date: 2021-02-23
TIANJIN UNIV
View PDF11 Cites 3 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0007] The purpose of the present invention is to solve the problem that the control method of the unmanned rolling machine in the prior art cannot include fast small-scale interference and slow large-scale interference, and to provide a layering of the unmanned rolling machine's forward process Hierarchical self-learning composite anti-disturbance trajectory tracking control algorithm

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Composite anti-interference trajectory tracking control algorithm of unmanned rolling machine
  • Composite anti-interference trajectory tracking control algorithm of unmanned rolling machine
  • Composite anti-interference trajectory tracking control algorithm of unmanned rolling machine

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0044] A layered hierarchical self-learning composite anti-disturbance trajectory tracking control algorithm in the forward process of an unmanned rolling machine, comprising the following steps:

[0045] Step 1, according to the actual position of the rolling machine (measured by the positioning device assembled on the rolling machine) and the target trajectory of the rolling machine, calculate the actual distance error in the track tracking of the rolling machine;

[0046] Step 2, the anti-disturbance controller of the distance error calculates the target heading angle of the rolling machine through the total disturbance of the actual distance error obtained in step 1 and the distance error obtained by the instant disturbance observer, so that the trajectory tracking distance of the rolling machine is error tends to zero;

[0047] Step 3, the anti-disturbance controller of the heading angle calculates the target heading angle of the rolling machine through the target heading...

Embodiment 2

[0050] As a preferred solution, the anti-disturbance controller of the distance error in the step 2 will use the actual heading angle (θ 1,GPS ) and the actual distance error (e d ) is simplified as a range error dynamic system model, and the deviation between the range error dynamic system model and the actual process is unified as the total disturbance of the range error (f outlp ), put f outlp It is regarded as an extended state in the distance error dynamic system model, that is, the dynamic system model is extended to a dynamic system with a higher order than the original dynamic system model. Using the real-time disturbance observer, using the actual heading angle and actual distance error information, the total disturbance to the distance error (f outlp ) for real-time estimation and real-time compensation in the range error perturbation suppressor. For the system processed by the range error disturbance suppressor, the range error feedback controller is designed, an...

Embodiment 3

[0054] As the basis for the development of the control algorithm, the prediction model of the front and rear body angle, heading angle and position of the roller compactor is established first. Although this part of the content is not the content of the present invention, it is still written here for the sake of completeness. In this embodiment, the following simplified heading angle dynamic system model is adopted, but it is not limited to this model. The prediction model of the influence of the steering wheel of the roller compactor on the articulation angle of the front and rear body can be expressed by (3).

[0055]

[0056] Among them, γ is the articulation angle of the front and rear body (unit: radian), is the derivative of the articulation angle of the front and rear body with respect to time, is the target rotation angle of the steering wheel (unit: radian), τ steer is the time constant of the dynamic process of the steering system (unit: second), a is the sta...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention discloses a composite anti-interference trajectory tracking control algorithm for an unmanned rolling machine, and the algorithm comprises the following steps that: an actual distance error in the trajectory tracking of a rolling machine is calculated according to the actual position of the rolling machine and the target trajectory of the rolling machine; an anti-interference controller of the distance error calculates the target course angle of the rolling machine through the actual distance error and the total disturbance of the distance error obtained by the real-time disturbance observer, so that the trajectory tracking distance error of the rolling machine tends to zero; the anti-interference controller of the course angle calculates a target steering wheel rotation angle of the rolling machine through the target course angle, the course total disturbance obtained by the instant disturbance observer and the course angle disturbance obtained based on the steering system model parameter learner, so that the actual course angle of the rolling machine approaches the target course angle; and he target steering wheel angle is sent to a steering wheel angle controller.The control algorithm can solve the problems of rapid small-range interference and slow large-range interference.

Description

technical field [0001] The present invention relates to the technical field of unmanned rolling machine control, in particular to a layered and hierarchical self-learning composite anti-disturbance trajectory tracking control algorithm in the forward process of the unmanned rolling machine. Background technique [0002] The accurate tracking of the target driving trajectory by the unmanned rolling machine is the key to ensuring the quality, efficiency and safety of the rolling operation. Traditional PID (feedback-integral-derivative) control is one of the most widely used control algorithms. For example, Zhang et al. from Tsinghua University and Bian Yongming from Tongji University have used PID feedback control for the track tracking control of rolling machines. However, PID feedback control will take control action only after a significant trajectory tracking error is generated. This passive control method of "after-event adjustment" can easily cause the phenomenon of "d...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
Patent Type & Authority Applications(China)
IPC IPC(8): G05D1/10
CPCG05D1/101
Inventor 谢辉宋康
Owner TIANJIN UNIV
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products

Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic.

© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap