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

Whole attitude angle updating method applied to agricultural machinery and based on nine-axis MEMS (micro-electromechanical system) sensor

A technology for agricultural machinery and updating methods, which is applied in the field of measurement and can solve problems such as incomplete application

Active Publication Date: 2015-12-30
SHANGHAI HUACE NAVIGATION TECH
View PDF5 Cites 47 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

SINS is mostly used in aircraft navigation control systems, while the research and application in the field of agricultural machinery control is in its infancy, and the application objects and environmental conditions of the two are quite different. The method is not always applicable in the control of agricultural machinery

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
  • Whole attitude angle updating method applied to agricultural machinery and based on nine-axis MEMS (micro-electromechanical system) sensor
  • Whole attitude angle updating method applied to agricultural machinery and based on nine-axis MEMS (micro-electromechanical system) sensor
  • Whole attitude angle updating method applied to agricultural machinery and based on nine-axis MEMS (micro-electromechanical system) sensor

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0058] like figure 1 As shown, a method for updating the full attitude angle of agricultural machinery based on the nine-axis MEMS sensor, the method for updating the full attitude angle of the agricultural machinery based on the nine-axis MEMS sensor includes the following steps:

[0059] Step S1: Establish a gyroscope error model, an electronic compass calibration ellipse model and a seven-dimensional EKF filter model, and set the parameter vector of the corresponding vehicle body motion attitude;

[0060] The step S1: establishing the gyroscope error model, the electronic compass calibration ellipse model and the seven-dimensional EKF filter model, and setting the parameter vector of the corresponding vehicle body motion attitude. The specific steps are:

[0061] The gyroscope error model calculates the angular velocity of the gyroscope through the gyroscope error calculation formula, where the gyroscope error calculation formula is: ω=ω ib +b ωr +b ωg , where ω is the o...

Embodiment 2

[0099] like figure 2 As shown, a method for updating the full attitude angle of agricultural machinery based on the nine-axis MEMS sensor, the method for updating the full attitude angle of the agricultural machinery based on the nine-axis MEMS sensor includes the following steps:

[0100] Step S1: Establish a gyroscope error model, an electronic compass calibration ellipse model and a seven-dimensional EKF filter model, and set the parameter vector of the corresponding vehicle body motion attitude;

[0101] The step S1: establishing the gyroscope error model, the electronic compass calibration ellipse model and the seven-dimensional EKF filter model, and setting the parameter vector of the corresponding vehicle body motion attitude. The specific steps are:

[0102] The gyroscope error model calculates the angular velocity of the gyroscope through the gyroscope error calculation formula, where the gyroscope error calculation formula is: ω=ω ib +b ωr +b ωg , where ω is the ...

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 whole attitude angle updating method applied to agricultural machinery and based on a nine-axis MEMS (micro-electromechanical system) sensor. The whole attitude angle updating method applied to agricultural machinery and based on the nine-axis MEMS sensor comprises the following steps: a gyroscope error model, an electronic compass calibration ellipse model and a seven-dimensional EKF (extended Kalman filter) model are established, and parameter vectors of corresponding motion attitudes of a vehicle body are set; data including the acceleration, the angular velocity and the geomagnetic field intensity of vehicle body motion are acquired in real time; the angle, the speed, the location information and the heading angle of the vehicle body are calculated through the established gyroscope error model and electronic compass calibration ellipse model; data fusion processing is performed on the angle, the speed, the location information and the heading angle of the vehicle body through the seven-dimensional EKF model, and the motion attitude angle of the vehicle body is updated in real time. The method comprising the steps has small errors and high precision and is stable and reliable.

Description

technical field [0001] The invention relates to the field of measurement technology, in particular to a method for updating the full attitude angle of agricultural machinery based on a nine-axis MEMS sensor. Background technique [0002] With the development of MEMS (Micro-Electro-Mechanical-System) sensors, navigation and control technology and the further increase of the country's support for agriculture, precision agriculture is rapidly becoming a trend, and in the process of auxiliary driving control of agricultural machinery , the attitude of the car body, including pitch angle, roll angle and heading angle, these information can provide important data input for high-precision integrated navigation and control algorithms. [0003] At present, inertial navigation systems are divided into PINS (PlatformInertialNavigationSystem) and SINS (StrapdownInertialNavigationSystem). Compared with PINS, SINS uses IMU (InertialMeasuringUnit) sensors to establish a "mathematical platf...

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): G01C21/00G01C21/12G01C21/08G01C21/20
CPCG01C21/00G01C21/08G01C21/12G01C21/20G01C21/1654G01C19/00G01C25/005A01B69/008A01B79/005B81B7/02G01C21/18G01C23/00A01B69/00G01C25/00
Inventor 任强王杰俊戴文鼎曹广节董光阳涂睿
Owner SHANGHAI HUACE NAVIGATION TECH
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

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

© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap|About US| Contact US: help@patsnap.com