Looking for breakthrough ideas for innovation challenges? Try Patsnap Eureka!

A multi-sensor fusion vehicle localization method involving power wheel slip correction

A multi-sensor fusion and positioning method technology, applied in the field of positioning algorithms, can solve problems such as difficulty in guaranteeing accuracy and slowing down of data update speed, and achieve the effects of improving robustness, accurate position estimation, and rapid fault identification.

Active Publication Date: 2022-01-11
南京云智控产业技术研究院有限公司
View PDF6 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

This will lead to a decrease in the data update speed. The measured data refresh speed of the positioning system with 4 base stations and 4 tags developed by Decawave's DWM1000 is 10Hz
In addition, the accuracy of UWB positioning is at the decimeter level. When performing high-speed and precise cluster positioning, it is difficult to guarantee the accuracy if it is completely relied on

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
  • A multi-sensor fusion vehicle localization method involving power wheel slip correction
  • A multi-sensor fusion vehicle localization method involving power wheel slip correction
  • A multi-sensor fusion vehicle localization method involving power wheel slip correction

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0070] The following is a detailed description of a proposed multi-sensor fusion vehicle positioning method involving power wheel slip correction with reference to the accompanying drawings:

[0071] A multi-sensor fusion vehicle positioning method involving power wheel slip correction, the method includes the following steps:

[0072] S1. Feedforward control: Use the feedforward PID algorithm to perform closed-loop control on the speed of each motor, and obtain the speed ω of the three power wheels based on the encoder data 1 , ω 2 , ω 3 , according to the size of the three power wheels, the relative speed ν of the corresponding power wheels can be obtained 1 、ν 2 、ν 3 ;

[0073] S2. Ultra-wideband positioning: Obtain the absolute position coordinates (x UWB ,y UWB );

[0074] S3. Slip correction: Estimate the relative speed correction value ν of each power wheel according to the motor load state X_corr , (X=1,2,3), based on the model solution, the vehicle's horizont...

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 multi-sensor fusion vehicle positioning method involving power wheel slip correction. The method includes the following steps: S1. Feedforward control: use a feedforward PID algorithm to perform closed-loop control on the speed of each motor, based on an encoder Obtain the speed of the three power wheels from the data, and obtain the relative speed of the corresponding power wheels according to the size of the three power wheels; S2. Ultra-wideband positioning: obtain the absolute position coordinates of the omnidirectional wheel vehicle based on the UWB positioning system; S3. Slip Correction: Estimate the relative speed correction value of each power wheel according to the motor load state, obtain the position based on the model solution, and solve x based on the state equation car 、y car , θ car ; S4. Data fusion: use the Kalman filter to fuse the above two position data to obtain the fusion result x KF 、y KF , θ KF . The invention can effectively improve the accuracy of positioning data fusion.

Description

technical field [0001] The invention belongs to the field of positioning algorithms, and in particular relates to a multi-sensor fusion vehicle positioning method involving power wheel slip correction. Background technique [0002] The positioning technology of mobile vehicles is the key technology in the formation control of unmanned vehicles, unmanned aerial vehicles and complex systems. Applications such as trajectory tracking, path planning, and formation control of mobile vehicles need to rely on accurate location information of the vehicle. [0003] Based on the motor encoder and gyroscope data, the current speed and direction of the omnidirectional wheel vehicle can be estimated through the tire speed and vehicle acceleration, and the displacement of the vehicle can be obtained through integration, and the short-term positioning accuracy can reach millimeter level. However, due to the limitation of resolution and the existence of measurement noise, the displacement 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 Patents(China)
IPC IPC(8): G01M13/00G01P3/54G01S11/02
CPCG01M13/00G01P3/54G01S11/02
Inventor 刘剑许一航薛磊郑昊
Owner 南京云智控产业技术研究院有限公司
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Patsnap Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Patsnap Eureka Blog
Learn More
PatSnap group products