Path following control method, device and storage medium adapting to unknown dynamic space

A technology of following control and path, applied in non-electric variable control, two-dimensional position/channel control, vehicle position/route/altitude control, etc., can solve the problem of increasing the difficulty of path planning, destroying the optimality of the path, and reducing the search efficiency. and other issues to ensure the vehicle control ability and effect, high planning efficiency, and strong path realization ability.

Active Publication Date: 2022-08-05
北京轩宇空间科技有限公司
View PDF11 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

The path obtained by planning based on dense grid points, after smoothing the path that satisfies the limitation of vehicle mobility, usually destroys the optimality of the path, and even causes the path to be infeasible; while considering the limitation of vehicle mobility in the path planning process, then Greatly increases the difficulty of path planning and reduces search efficiency
The method of directly planning the path and directly following the planning result is not suitable for the path realization of the unknown dynamic space

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
  • Path following control method, device and storage medium adapting to unknown dynamic space
  • Path following control method, device and storage medium adapting to unknown dynamic space
  • Path following control method, device and storage medium adapting to unknown dynamic space

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0043] The path following control method of the embodiment of the present application mainly includes the steps:

[0044] (1) Determine whether the vehicle has reached the target, stop if it does, and continue if it does not. Set the reaching target judgment threshold d_end, if the current admissible pose distance from the end node of the rough path node string is less than the threshold, the target is considered to be reached; otherwise, it is considered that the target has not been reached. The end node is also the target point of path planning.

[0045] (2) Based on the admissible pose, find the current node and the next node in the rough path node string. Among them, the admissible pose can be the result of certain operations after being directly acquired by various sensors, or it can be the comprehensive result obtained after pose fusion processing. The current node is the node closest to the admissible pose in the rough path node string. The next node in the rough pat...

Embodiment 2

[0060] combined with Figure 5 The above structural block diagram further describes the path following control device adapted to the unknown dynamic space according to the embodiment of the present application.

[0061] The path following control device of this example includes a judgment module, a node module, an expectation module, and a control module connected in sequence.

[0062] Specifically, the judging module judges whether the vehicle has reached the target: if it reaches it, it stops, and if it does not reach it, it continues to execute; when the judgment result of the judging module is that the target has not been reached, the node module is based on the acceptable pose and poses in the rough path node string. Find the current node and the next node; the expectation module uses the artificial potential field method to solve the expected motion command based on the acceptable pose and the current planning graph; the control module uses the expected motion command to...

Embodiment 3

[0067] This example provides a computer-readable storage medium on which a computer program is stored, and when the computer program is run by a processor, the device where the storage medium is located is controlled to execute the path following control method adapted to the unknown dynamic space of the first embodiment.

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 path following control method adapted to an unknown dynamic space, and belongs to the field of automatic driving. The method steps include: judging whether the vehicle reaches the target, stopping if it reaches the target, and continuing if it does not arrive; finding the current node and the next node in the rough path node string based on the admissible believable pose; For the planning diagram, the artificial potential field method is used to solve the expected motion command; based on the motion response dynamics of the vehicle, the expected motion command is used to solve the following control command. The present invention integrates local path correction and trajectory following control, has high planning efficiency and strong path realization ability; considers local environment and vehicle capability during path realization, has good obstacle avoidance and collision avoidance effect, and is suitable for vehicle control.

Description

technical field [0001] The present invention relates to automatic driving technology, in particular to a path following control method, device and storage medium adapting to unknown dynamic space. Background technique [0002] After the path planning is completed, when the vehicle realizes the path, due to the limitation of the vehicle's own motion capability, the path smoothing process is usually performed. The path obtained by planning the path based on dense grid points, after the path is smoothed to meet the limitations of the vehicle's motion capability, usually destroys the optimality of the path, or even makes the path infeasible. It greatly increases the difficulty of path planning and reduces the search efficiency. The method of directly planning the path and directly following the planning result is not suitable for path realization in unknown dynamic space. SUMMARY OF THE INVENTION [0003] In view of the above situation, the present invention provides a path ...

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 Patents(China)
IPC IPC(8): G01C21/30G01C21/34G05D1/00G05D1/02
CPCG01C21/30G01C21/343G01C21/3415G05D1/0088G05D1/0212
Inventor 罗冠辰王鹏涛刘俊君王明杰
Owner 北京轩宇空间科技有限公司
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