CN111238471B - 一种适用于农业机械直线导航的侧滑角度估计方法及估计器 - Google Patents

一种适用于农业机械直线导航的侧滑角度估计方法及估计器 Download PDF

Info

Publication number
CN111238471B
CN111238471B CN202010052292.9A CN202010052292A CN111238471B CN 111238471 B CN111238471 B CN 111238471B CN 202010052292 A CN202010052292 A CN 202010052292A CN 111238471 B CN111238471 B CN 111238471B
Authority
CN
China
Prior art keywords
estimator
information
deviation
agricultural machine
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
CN202010052292.9A
Other languages
English (en)
Other versions
CN111238471A (zh
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.)
Qingdao Agricultural University
Original Assignee
Qingdao Agricultural University
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 Qingdao Agricultural University filed Critical Qingdao Agricultural University
Priority to CN202010052292.9A priority Critical patent/CN111238471B/zh
Publication of CN111238471A publication Critical patent/CN111238471A/zh
Priority to US17/143,449 priority patent/US20210240192A1/en
Application granted granted Critical
Publication of CN111238471B publication Critical patent/CN111238471B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • A—HUMAN NECESSITIES
    • A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/021—Determination of steering angle
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/52—Determining velocity
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/53—Determining attitude
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13—Receivers
    • G01S19/14—Receivers specially adapted for specific applications
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Mechanical Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Transportation (AREA)
  • Medical Informatics (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Game Theory and Decision Science (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Soil Sciences (AREA)
  • Environmental Sciences (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本发明公开一种适用于农业机械直线导航的侧滑角度估计方法及估计器，通过采集前轮转向角信息、农业机械的前进速度信息、天线定位信息和当前姿态信息，并对其进行分析处理；基于状态观测理论实现对侧滑角度的估计，采用第一估计器、第二估计器和第三估计器实现对车体航向偏差、位置偏差、侧滑角度信息的估计，分析过程利用积分代替微分，避免了微分运算对误差的放大作用；而且，在获取侧滑角度的同时，完成对航向偏差、位置偏差估计，本身具备滤波功能，改善了由于定位信息更新延迟所造成的航向偏差、位置偏差获取误差偏差较大等问题，为农业机械自动导航路径直线追踪算法提供参考，进而为提高侧滑条件下农业机械自动导航的路径跟踪精度提供支持。

Description

一种适用于农业机械直线导航的侧滑角度估计方法及估计器
技术领域
本发明属于车辆导航追踪领域，具体涉及一种适用于农业机械直线导航的侧滑角度估计方法及估计器。
背景技术
随着农业机械自动化水平的提高，农业机械自动导航技术越来越受重视，尤其是在我国东北及新疆地区的旱田作业中应用日趋成熟与完善。根据农作物种植的特点，农业机械导航系统对于直线路径追踪的精度要求远高于其他类型导航车辆的要求。但是不同于旱田农业机械自动导航技术的日趋完善，受水田作业环境硬底层不平、车辆侧滑等因素的影响，直线路径追踪精度差成为水田农业机械自动导航技术存在并亟需解决的主要问题。
国内农业机械自动驾驶起步较晚，对侧滑问题的研究还未开展，提高水田农业机械自动导航系统直线路径追踪精度是目前农业机械自动导航系统的主要研究问题之一。农业机械自动导航路径追踪算法多依赖于车辆动力学模型，其中侧滑角度是车辆动力学模型中的参数之一，由于侧滑产生在轮胎与地块接触面缺少直接测量的传感器，导致侧滑角度难以获取，而当前农业机械自动导航路径跟踪算法大多忽略掉了侧滑角度的影响，从而导致水田作业机械过程中路径追踪精度差。
为此，本发明基于状态观测理论，设计一种农业机械侧滑角度估计器，为农业机械自动导航路径直线追踪算法提供参数参考，进而为提高侧滑条件下农业机械自动导航的路径跟踪精度提供支持。
发明内容
本发明针对采用前轮转向的农业机械车辆在直线路径追踪过程中存在的侧滑问题，基于观测器理论，提出一种适用于农业机械直线导航的侧滑角度估计方法及估计器。
本发明是采用以下的技术方案实现的：
一种适用于农业机械直线导航的侧滑角度估计方法，包括以下步骤：
步骤S1、在农业机械行进过程中，采集农业机械的前轮转向角信息、以及农业机械的前进速度信息、天线定位信息和当前姿态信息，并对其进行对应的分析处理；
步骤S2、构建农业机械的动力学方程并将其作为系统状态方程，基于状态观测器理论实现对直线导航路径追踪过程中的侧滑角度的估计，具体的：
(1)根据步骤S1所采集的农业机械的天线定位信息和当前姿态信息，分析并获得j时刻综合误差信号ε(j)：
Figure GDA0003072464490000011
其中，y(j)表示j时刻的位置偏差量测值，位置偏差记为导航点坐标距离路径规划线上最近点之间的距离，
Figure GDA0003072464490000021
表示j时刻的航向偏差量测值，航向偏差记为车辆航向与路径规划线的航向之差，
Figure GDA0003072464490000022
表示j时刻的航向偏差估计值，
Figure GDA0003072464490000023
表示j时刻的位置偏差估计值，ky和kθ为系数，满足kθ+ky＜1，且kθ＜ky；位置偏差估计值和航向偏差估计值的初始值均为0；
(2)根据得到的综合误差信号ε(j)，分析并获得j时刻侧滑角度估计值
Figure GDA0003072464490000024
Figure GDA0003072464490000025
其中，
Figure GDA0003072464490000026
表示j-1时刻的侧滑角度估计值，k1为系数，Ts表示系统控制周期；
(3)根据采集的前轮转角信息、前进速度信息以及综合误差信号ε(j)和侧滑角度估计值
Figure GDA0003072464490000027
对j时刻航向偏差进行估计，得到j时刻航向偏差估计值:
Figure GDA0003072464490000028
其中，
Figure GDA0003072464490000029
表示j-1时刻的航向偏差估计值，v(j)为车辆当前前进速度，L为车身长度，δ(j)为当前前轮转向角度，k2为系数；
(4)根据采集的农业机械前进速度信息以及分析获得的航向偏差估计值、侧滑角度估计值和综合误差信号，对航向的位置偏差进行估计，得到位置偏差估计值：
Figure GDA00030724644900000210
其中，
Figure GDA00030724644900000211
表示j-1时刻的位置偏差估计值，k3为系数。
进一步的，所述步骤S1中，对采集的数据进行分析处理时，具体采用以下方式：
(1)对采集的前轮转向角信息进行A/D转换并进行滤波处理，得到j时刻前轮转向角数字值δ(j)；
(2)对采集的农业机械的前进速度信息进行滤波得到j时刻的当前前进速度v(j)；
(3)对采集的天线定位信息和当前车辆姿态信息经过坐标变换及分析，得到导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure GDA00030724644900000212
定义j时刻位置偏差量测值y(j)为导航点坐标距离路径规划线上最近点之间的距离，航向偏差量测值
Figure GDA00030724644900000213
为j时刻车辆航向与路径规划线的航向之差。
进一步的，所述步骤S2中，所构建的农业机械的动力学方程为：
Figure GDA00030724644900000214
其中，δ表示前轮轮角角度，L为农业机械车身长度，v表示车辆前进速度，β表示侧滑角度，
Figure GDA00030724644900000215
表示航向偏差，y表示位置偏差，
Figure GDA00030724644900000216
分别表示位置偏差和航向偏差的一阶倒数。
本发明另外还提出一种适用于农业机械直线导航的侧滑角度估计器，所述农业机械的自动导航系统包括车辆前轮轮角传感器和GNSS定位定向装置，所述侧滑角度估计器包括综合误差计算器、第一估计器、第二估计器和第三估计器；
所述前轮轮角传感器用以采集前轮转向角信息，前轮转向角信息经过处理后传输至第二估计器的输入端；所述GNSS定位定向装置用以采集农业机械的前进速度信息、天线定位信息和当前姿态信息，所采集的前进速度信息经过滤波处理后同样传输至第二估计器的输入端；所采集的天线定位信息和当前车辆姿态信息经过分析计算，得到导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure GDA0003072464490000031
并传输至综合误差计算器的输入端；
所述综合误差计算器的输出端分别与第一估计器、第二估计器和第三估计器的输入端相连，第一估计器的输出端分别与第二估计器和第三估计器的输入端相连，第二估计器的输出端分别与综合误差计算器和第三估计器的输入端相连，第三估计器的输出端与综合误差计算器的输入端相连；
所述综合误差计算器用以分析获得j时刻综合误差信号ε(j)，即：
Figure GDA0003072464490000032
其中，
Figure GDA0003072464490000033
表示航向偏差估计值；
Figure GDA0003072464490000034
表示位置偏差估计值，ky和kθ为系数，满足kθ+ky＜1，且kθ＜ky；位置偏差估计值根据第三估计器获得，航向偏差的估计值根据第二估计器获得，其初始值均为0；
所述第一估计器实现对j时刻侧滑角度估计值
Figure GDA0003072464490000035
的估计，即：
Figure GDA0003072464490000036
其中，k1为系数，Ts表示系统控制周期；
所述第二估计器用以对j时刻航向偏差进行估计，得到航向偏差估计值，即：
Figure GDA0003072464490000037
其中，v(j)为车辆当前速度，L为车身长度，δ(j)为当前前轮转向角度，k2为系数；
所述第三估计器实现对航向的位置偏差的估计，得到位置偏差估计值，即：
Figure GDA0003072464490000038
其中，k3为系数。
进一步的，所述前轮轮角传感器的输出端依次通过A/D转换器和第一数字滤波器与第二估计器的输入端相连，第一数字滤波器用以实现对经过A/D转换器转换后的前轮转向角信号的滤波处理。
与现有技术相比，本发明的优点和积极效果在于：
本方案基于状态观测理论实现对侧滑角度的估计，不需要增加额外的硬件，计算量低，方便单片机、ARM等低成本嵌入式系统实现；采用三个状态观测器实现对车体航向偏差、位置偏差、侧滑角度信息的估计，分析过程利用积分代替微分，避免了微分运算对误差的放大作用；而且，在获取侧滑角度的同时，完成对航向偏差、位置偏差估计，本身具备滤波功能，改善了由于定位信息更新延迟所造成的航向偏差、位置偏差获取误差偏差较大等问题。
附图说明
图1为本发明实施例所述侧滑角度估计器的原理框图；
图2为本发明实施例所述直线导航示意图；
图3为本发明实施例所述综合误差计算器原理框图；
图4为本发明所述第一估计器原理框图；
图5为本发明所述第二估计器原理框图；
图6为本发明所述第三估计器原理框图；
图7为基于传统方法对侧滑角度估计直线路径追踪的精度数据图；
图8为本发明侧滑角度估计试验数据图；
图9为采用本发明侧滑角度补偿直线导航路径追踪精度数据图。
具体实施方式
为了能够更加清楚地理解本发明的上述目的、特征和优点，下面结合附图及实施例对本发明做进一步说明。需要说明的是，在不冲突的情况下，本申请的实施例及实施例中的特征可以相互组合。
本发明利用观测器理论，基于轮角测量信息、车辆前进速度、车辆动力学模型设计一种适用于农业机械直线导航的侧滑角度估计方法及估计器。
实施例1，一种适用于农业机械直线导航的侧滑角度估计方法，具体包括以下步骤：
步骤S1、在农业机械行进过程中，采集农业机械的前轮转向角信息、以及农业机械的前进速度信息、天线定位信息和当前姿态信息，并对其进行对应的分析处理；
步骤S2、构建农业机械的动力学方程并将其作为系统状态方程，基于状态观测器理论实现对直线导航路径追踪过程中的侧滑角度的估计，具体的：
(1)根据步骤S1所采集的农业机械的天线定位信息和当前姿态信息，分析并获得j时
刻综合误差信号ε(j)：
Figure GDA0003072464490000041
其中，y(j)表示j时刻的位置偏差量测值，位置偏差记为导航点坐标距离路径规划线上最近点之间的距离，
Figure GDA0003072464490000042
表示j时刻的航向偏差量测值，航向偏差记为车辆航向与路径规划线的航向之差，
Figure GDA0003072464490000043
表示航向偏差估计值，
Figure GDA0003072464490000044
表示位置偏差估计值，ky和kθ为系数，满足kθ+ky＜1，且kθ＜ky；位置偏差估计值和航向偏差估计值的初始值均为0；
(2)根据得到的综合误差信号ε(j)，分析并获得j时刻侧滑角度估计值
Figure GDA0003072464490000051
Figure GDA0003072464490000052
其中，
Figure GDA0003072464490000053
表示j-1时刻的侧滑角度估计值，k1为系数，Ts表示系统控制周期；
(3)根据采集的前轮转角信息、前进速度信息以及综合误差信号ε(j)和侧滑角度估计值
Figure GDA0003072464490000054
对j时刻航向偏差进行估计，得到j时刻航向偏差估计值:
Figure GDA0003072464490000055
其中，
Figure GDA0003072464490000056
表示j-1时刻的航向偏差估计值，v(j)为车辆当前前进速度，L为车身长度，δ(j)为当前前轮转向角度，k2为系数；
(4)根据采集的农业机械前进速度信息以及分析获得的航向偏差估计值、侧滑角度估计值和综合误差信号，对航向的位置偏差进行估计，得到位置偏差估计值：
Figure GDA0003072464490000057
其中，
Figure GDA0003072464490000058
表示j-1时刻的位置偏差估计值，k3为系数。
其中，所述步骤S1中，通过安装在农业机械自动导航系统上的车辆前轮轮角传感器和GNSS定位定向装置进行数据采集，对采集的数据进行分析处理时，具体采用以下方式：
(1)对采集的前轮转向角信息进行A/D转换并进行滤波处理，得到j时刻前轮转向角数字值δ(j)；这里采用均值滤波，定义均值滤波的滤波点数为N，A/D转换的采样间隔为Δt，系统控制周期为Ts，则均值滤波点数N满足关系式：
N＜0.5Ts/Δt；
(2)对采集的农业机械的前进速度信息进行二次滤波得到j时刻的当前前进速度v(j)；
(3)对采集的天线定位信息和当前车辆姿态信息经过坐标变换及分析：
坐标变换由两步完成：
1.高斯-克吕格投影，由大地参考坐标系经纬度高程转换为地心-地固坐标系坐标；
2.欧拉坐标变换模块根据定位天线在车体坐标系的坐标信息以及车辆姿态信息计算得到车辆中心点在导航坐标系下的坐标信息(以下简称导航点坐标)；
通过坐标变化得到导航点坐标信息，并分析得到导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure GDA0003072464490000059
如图2所示，定义j时刻位置偏差量测值y(j)为导航点坐标距离路径规划线上最近点之间的距离，航向偏差量测值
Figure GDA00030724644900000510
为j时刻车辆航向与路径规划线的航向之差。
根据现代控制理论知识，准确的动力学模型是实现导航的精确路径追踪的前提与基础，在直线路径追踪过程中，步骤S2中所构建的农业机械的动力学方程为：
Figure GDA0003072464490000061
其中，δ表示前轮轮角角度，L为农业机械车身长度，v表示车辆前进速度，β表示侧滑角度，
Figure GDA0003072464490000062
表示航向偏差，y表示位置偏差，
Figure GDA0003072464490000063
表示位置偏差和航向偏差的一阶导数。
在实际应用中，侧滑产生在地块与车轮接触面，难以采用加装传感器侧滑信息。本方案利于状态观测器理论，将公式(2)作为本方案设计过程中的系统状态方程；农业机械直线路径追踪过程中，存在两个偏差信息：位置偏差和航向偏差，并且两个偏差信息均可测；为使量测信息中充分包含车体当前坐标信息，本方案量测方程采用位置偏差和航向偏差线性的组合；根据系统状态方程和量测方程，实现对侧滑信息的估计。
实施例2，基于实施例1所提出的估计方法，本实施例提出一种适用于农业机械直线导航的侧滑角度估计器，农业机械的自动导航系统安装有车辆前轮轮角传感器1和GNSS定位定向装置2，如图1所示，前轮轮角传感器1输出的前轮转向角模拟值经A/D转换器3和第一数字滤波器4后输出j时刻前轮转向轮角数字值δ(j)；第一数字滤波器4实现对轮角传感器A/D转换后信号的滤波，为均值滤波。定义均值滤波的滤波点数为N，AD转换的采样间隔为Δt，系统控制周期为Ts，为保证系统的正常运行，均值滤波点数N满足关系式：
N＜0.5Ts/Δt。
GNSS定位/定向装置2用以采集农业机械的前进速度信息、天线定位信息和当前姿态信息：其输出的的前进速度信息v经过第二数字滤波器5完成对GNSS输出的车辆移动速度的滤波，得到j时刻的前进速度v(j)，第二数字滤波器5为二阶低通滤波器；其输出的天线定位信息和当前车辆姿态信息经过坐标变换模块6和追踪误差计算器7的分析计算，得到导航点坐标信息与路径规划C之间的位置偏差的量测值y(j)与航向偏差的量测值
Figure GDA0003072464490000064
坐标变换模块6由两步完成：
1.高斯-克吕格投影，由大地参考坐标系经纬度高程转换为地心-地固坐标系坐标；
2.欧拉坐标变换模块根据定位天线在车体坐标系的坐标信息以及车辆姿态信息计算得到车辆中心点在导航坐标系下的坐标信息(以下简称导航点坐标)；
基于所采集的大地参考坐标系下的天线定位信息(包括经度、纬度和高程)与当前姿态信息(航向、横滚和俯仰)，坐标变换模块6包括高斯-克吕格投影变换和欧拉坐标变换，目的在于根据车辆姿态信息与天线定位信息获取车辆中心点在导航坐标系下的投影点坐标信息。根据导航坐标系的定义，GNSS定位/定向装置2输出定位天线在大地参考坐标系下的经度、纬度和高程定位信息；采用高斯-克吕格投影，将定位天线在大地参考坐标系下的经度、纬度、高程转换为地心-地固坐标系下的x、y、z坐标信息，记为(px,py,pz)；选取地心-地固坐标系为导航坐标系，该坐标系采用常规的东北天坐标系，即x轴为东方向，y轴为北方向，z轴垂直于xy平面指向天空方向；定义车辆中心点为车体坐标系坐标原点o’,车头方向为车体坐标系纵轴y’，垂直于车头由坐标原点o’指向车身右侧方向为车体坐标系横轴x’，根据右手法则，由坐标原点指向垂直于车身的天空方向为车体坐标系z’；GNSS定位天线安装在车体坐标系下的坐标是已知的,记为(vx,vy,vz)；如前所述，车体的姿态信息，包括横滚、俯仰、航向,记为(roll,pitch,yaw)；根据欧拉变换基本原理，可利用欧拉变换获取导航坐标系下，车辆中心点的坐标信息(x,y,z)(以下简称导航点坐标)，考虑到该坐标变换技术比较成熟，在此不做详述。
坐标变换完成后，通过追踪误差计算器7计算导航点坐标与路径规划线C之间的位置偏差y(j)与航向偏差
Figure GDA0003072464490000073
的量测值，如图2农业机械直线路径追踪示意图所示，定义j时刻位置偏差y(j)为导航点坐标与路径规划线C上距离最近点o的距离，航向偏差
Figure GDA0003072464490000074
为j时刻车辆航向与C的航向之差。
需要说明的是农业机械为一刚体，水田作业机械尤其是喷雾机、插秧机，相比较于旱田作业机械，尺寸较小，通常作业速度小于8km/h，本方案针对农业机械工作于直线追踪，车辆转向角度小，因此近似假定前后轮侧滑同时产生且侧滑角度相同。
继续参考图1，侧滑角度估计器包括综合误差计算器8，第一估计器9，第二估计器10和第三估计器11，四者相互作用获得航向偏差估计值、位置偏差估计值、侧滑角度估计值。
根据现代控制理论知识，准确的动力学模型是实现导航的精确路径追踪的前提与基础。在假定前后轮侧滑角度相同的前提下，定义农业机械的曲率半径为c(s)，前轮轮角角度为δ，农业机械的动力学方程可描述为：
Figure GDA0003072464490000071
在直线路径追踪过程中，可近似认为曲率半径c(s)＝0，公式1简化为：
Figure GDA0003072464490000072
但是在实际应用中，侧滑产生在地块与车轮接触面，难以采用加装传感器侧滑信息。本方案利于状态观测器理论，设计一种适用于农业机械直线路径追踪过程的侧滑信息估计器，公式(2)作为本方案设计过程中的系统状态方程；农业机械直线路径追踪过程中，存在两个偏差信息：位置偏差和航向偏差，并且两个偏差信息均可测；为使量测信息中充分包含车体当前坐标信息，本方案量测方程采用位置偏差和航向偏差线性的组合；根据系统状态方程和量测方程，设计观测器对侧滑信息进行估计，具体的：
如图3所示，综合误差计算器8包括第一加法器81、第二加法器82、第一乘法器83、第二乘法器84和第三加法器85；综合误差计算器8根据位置与航向偏差的量测值和位置与航向偏差的估计值计算得到j时刻综合误差信号ε(j)，即：
Figure GDA0003072464490000081
其中，，
Figure GDA0003072464490000082
表示j时刻的航向偏差估计值，
Figure GDA00030724644900000811
表示j时刻的位置偏差估计值，位置偏差估计值和航向偏差估计值的初始值均为0，为保证系统稳定性kθ和ky满足关系式kθ+ky＜1；由于侧滑主要体现在车体位置偏差信息上，因此，选取kθ＜ky。
如图4所示，第一估计器9包括第四乘法器91、第四加法器92和第一状态存储器93，第一状态存储器93记载前一时刻侧滑角度估计值为
Figure GDA0003072464490000083
第一估计器9完成对j时刻侧滑角度估计值
Figure GDA0003072464490000084
的估计，即：
Figure GDA0003072464490000085
Ts表示系统控制周期；
如图5所示，第二估计器10包括第一除法器101、第一余弦计算器102、第一正切计算器103、第五加法器104、第二正切计算器105、第六加法器106、第五乘法器107、第六乘法器108、第七加法器109、第七乘法器1010、第八加法器1011和第二状态存储器1012；第二状态存储器1012记载前一时刻航向偏差的估计值
Figure GDA0003072464490000086
第二估计器10根据车辆当前速度v(j)，车身长度L，当前轮角角度δ(j)对j时刻航向偏差
Figure GDA0003072464490000087
进行估计，即：
Figure GDA0003072464490000088
如图6所示，第三估计器11包括第九加法器111、正弦计算器112、第八乘法器113、第九乘法器114、第十加法器115、第十乘法器116、第十一加法器117、第三状态存储器118，第三状态存储器118记载前一时刻位置偏差的估计值
Figure GDA0003072464490000089
第三估计器11完成对航向位置偏差的估计，即：
Figure GDA00030724644900000810
综上所述，本方案基于状态观测理论实现对侧滑角度的估计，不需要增加额外的硬件，计算量低，方便单片机、ARM等低成本嵌入式系统实现；采用三个状态观测器实现对车体航向偏差、位置偏差、侧滑角度信息的估计，分析过程利用积分代替微分，避免了微分运算对误差的放大作用；而且，在获取侧滑角度的同时，完成对航向偏差、位置偏差估计，本身具备滤波功能，改善了由于定位信息更新延迟所造成的航向偏差、位置偏差获取误差偏差较大等问题。
试验验证：
为验证本方案的效果，进行了实物试验：试验地点为广州华南农业大学增城试验基地，试验地块为水田，经前期人工驾驶车辆试验，部分区域存在可感受到的侧滑现象，试验车辆为雷沃四轮驱动水旱两用高地隙喷雾机ZP9500，采用霍尔传感器测量轮角角度，传感器型号为德国NOVOTECHNIK公司生产的RF4000-120，直线路径追踪算法是基于车辆链式非线性模型基础上所设计的反馈控制率，控制率的输出为用数学公式描述为：
Figure GDA0003072464490000091
式中，
Figure GDA0003072464490000092
为j时刻路径追踪算法所输出的期望轮角；ψe(j)为当前目标航向与实际航向的差；λ1、λ2为控制系数；试验中，λ1＝1.42，λ2＝5.78，不对侧滑角进行估计，即公式7中β(j)＝0，直线路径追踪精度数据图如图7所示，精度约为10cm，采用本发明算法对侧滑角度估计数据图如图8所示，估计器的参数选择为：ky＝0.6，kθ＝0.3，Ts＝0.02s，k1＝14，k2＝128，k3＝1000；将估计角度值带入公式(7)实现直线路径追踪，如图9所示，路径追踪精度约为6cm，并且大角度的侧滑角度得到了抑制，需要说明的是试验数据中整体位置偏差偏正，这是由于天线安装与车身垂直角度的安装误差造成的，在导航系统运行过程中，通常采用的解决办法是将导航控制线调节整体偏移值，以图7、图9为例，正向偏置约为2cm，则跟踪控制线偏左2cm，经此处理，整体位置误差偏置偏置将不影响生产作业过程中的导航控制精度，经此调整后未做侧滑补偿前位置偏差仍为约10cm,做补偿后位置偏差约为4cm,本发明对水田作业下直线导航导航精度提升明显。
以上所述，仅是本发明的较佳实施例而已，并非是对本发明作其它形式的限制，任何熟悉本专业的技术人员可能利用上述揭示的技术内容加以变更或改型为等同变化的等效实施例应用于其它领域，但是凡是未脱离本发明技术方案内容，依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与改型，仍属于本发明技术方案的保护范围。

Claims (8)

1.一种适用于农业机械直线导航的侧滑角度估计方法，其特征在于，包括以下步骤：
步骤S1、在农业机械行进过程中，采集农业机械的前轮转向角信息、以及农业机械的前进速度信息、天线定位信息和当前姿态信息，并对其进行对应的分析处理；
步骤S2、构建农业机械的动力学方程并将其作为系统状态方程，基于状态观测器理论实现对直线导航路径追踪过程中的侧滑角度的估计，具体的：
(1)根据步骤S1所采集的农业机械的天线定位信息和当前姿态信息，分析并获得j时刻综合误差信号ε(j)：
Figure FDA0003072464480000011
其中，y(j)表示j时刻的位置偏差量测值，位置偏差记为导航点坐标距离路径规划线上最近点之间的距离，
Figure FDA0003072464480000012
表示j时刻的航向偏差量测值，航向偏差记为车辆航向与路径规划线的航向之差，
Figure FDA0003072464480000013
表示j时刻的航向偏差估计值，
Figure FDA0003072464480000014
表示j时刻的位置偏差估计值，ky和kθ为系数，满足kθ+ky＜1，且kθ＜ky；位置偏差估计值和航向偏差估计值的初始值均为0；
(2)根据得到的综合误差信号ε(j)，分析并获得j时刻侧滑角度估计值
Figure FDA00030724644800000112
Figure FDA0003072464480000015
其中，
Figure FDA0003072464480000016
表示j-1时刻的侧滑角度估计值，k1为系数，Ts表示系统控制周期；
(3)根据采集的前轮转角信息、前进速度信息以及综合误差信号ε(j)和侧滑角度估计值
Figure FDA0003072464480000017
对j时刻航向偏差进行估计，得到j时刻航向偏差估计值:
Figure FDA0003072464480000018
其中，
Figure FDA0003072464480000019
表示j-1时刻的航向偏差估计值，v(j)为车辆当前前进速度，L为车身长度，δ(j)为当前前轮转向角度，k2为系数；
(4)根据采集的农业机械前进速度信息以及分析获得的航向偏差估计值、侧滑角度估计值和综合误差信号，对航向的位置偏差进行估计，得到位置偏差估计值：
Figure FDA00030724644800000110
其中，
Figure FDA00030724644800000111
表示j-1时刻的位置偏差估计值，k3为系数。
2.根据权利要求1所述的适用于农业机械直线导航的侧滑角度估计方法，其特征在于：所述步骤S1中，对采集的数据进行分析处理时，具体采用以下方式：
(1)对采集的前轮转向角信息进行A/D转换并进行滤波处理，得到j时刻前轮转向角数字值δ(j)；
(2)对采集的农业机械的前进速度信息进行滤波得到j时刻的当前前进速度v(j)；
(3)对采集的天线定位信息和当前车辆姿态信息经过坐标变换及分析，得到导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure FDA0003072464480000021
定义j时刻位置偏差量测值y(j)为导航点坐标距离路径规划线上最近点之间的距离，航向偏差量测值
Figure FDA0003072464480000022
为j时刻车辆航向与路径规划线的航向之差。
3.根据权利要求1所述的适用于农业机械直线导航的侧滑角度估计方法，其特征在于：所述步骤S2中，所构建的农业机械的动力学方程为：
Figure FDA0003072464480000023
其中，δ表示前轮轮角角度，L为农业机械车身长度，v表示车辆前进速度，β表示侧滑角度，
Figure FDA0003072464480000024
表示航向偏差，y表示位置偏差，
Figure FDA0003072464480000025
分别表示位置偏差和航向偏差的一阶倒数。
4.根据权利要求2所述的适用于农业机械直线导航的侧滑角度估计方法，其特征在于：在对采集的前轮转向角信息进行滤波处理时，采用均值滤波，定义均值滤波的滤波点数为N，A/D转换的采样间隔为Δt，系统控制周期为Ts，则均值滤波点数N满足关系式：
N＜0.5Ts/Δt。
5.一种适用于农业机械直线导航的侧滑角度估计器，所述农业机械的自动导航系统包括车辆前轮轮角传感器(1)和GNSS定位定向装置(2)，其特征在于，所述侧滑角度估计器包括综合误差计算器(8)、第一估计器(9)、第二估计器(10)和第三估计器(11)；
所述前轮轮角传感器(1)用以采集前轮转向角信息，前轮转向角信息经过处理后传输至第二估计器(10)的输入端；所述GNSS定位定向装置(2)用以采集农业机械的前进速度信息、天线定位信息和当前姿态信息，所采集的前进速度信息经过滤波处理后同样传输至第二估计器(10)的输入端；所采集的天线定位信息和当前车辆姿态信息经过分析计算，得到导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure FDA0003072464480000028
并传输至综合误差计算器(8)的输入端；
所述综合误差计算器(8)的输出端分别与第一估计器(9)、第二估计器(10)和第三估计器(11)的输入端相连，第一估计器(9)的输出端分别与第二估计器(10)和第三估计器(11)的输入端相连，第二估计器(10)的输出端分别与综合误差计算器(8)和第三估计器(11)的输入端相连，第三估计器(11)的输出端与综合误差计算器(8)的输入端相连；
所述综合误差计算器(8)用以分析获得j时刻综合误差信号ε(j)，即：
Figure FDA0003072464480000026
其中，
Figure FDA0003072464480000027
表示航向偏差估计值；
Figure FDA0003072464480000029
表示位置偏差估计值，ky和kθ为系数，满足kθ+ky＜1，且kθ＜ky；位置偏差估计值根据第三估计器(11)获得，航向偏差的估计值根据第二估计器(2)获得，其初始值均为0；
所述第一估计器(9)实现对j时刻侧滑角度估计值
Figure FDA0003072464480000031
的估计，即：
Figure FDA0003072464480000032
其中，k1为系数，Ts表示系统控制周期；
所述第二估计器(10)用以对j时刻航向偏差进行估计，得到航向偏差估计值，即：
Figure FDA0003072464480000033
其中，v(j)为车辆当前速度，L为车身长度，δ(j)为当前前轮转向角度，k2为系数；
所述第三估计器(11)实现对航向的位置偏差的估计，得到位置偏差估计值，即：
Figure FDA0003072464480000034
其中，k3为系数。
6.根据权利要求5所述的适用于农业机械直线导航的侧滑角度估计器，其特征在于：所述前轮轮角传感器(1)的输出端依次通过A/D转换器(3)和第一数字滤波器(4)与第二估计器(10)的输入端相连，第一数字滤波器(4)用以实现对经过A/D转换器(3)转换后的前轮转向角信号的滤波处理。
7.根据权利要求6所述的适用于农业机械直线导航的侧滑角度估计器，其特征在于：设第一数字滤波器(4)滤波点数为N，A/D转换器(3)的采样间隔为Δt，自动导航系统的控制周期为Ts，则滤波点数N满足关系式：
N＜0.5Ts/Δt。
8.根据权利要求5所述的适用于农业机械直线导航的侧滑角度估计器，其特征在于：所述GNSS定位定向装置(2)的输出端的一端通过第二数字滤波器(5)与第二估计器(10)的输入端相连，所述第二数字滤波器(5)实现对所采集的前进速度信息的滤波处理；
GNSS定位定向装置(2)的输出端的另一端依次经过坐标变换模块(6)和追踪误差计算器(7)与综合误差计算器(8)的输入端相连，所述坐标变换模块(6)通过对采集的信息进行坐标变换并得到导航点坐标信息，所述追踪误差计算器(7)用以计算导航点坐标信息与路径规划线之间的位置偏差量测值y(j)与航向偏差量测值
Figure FDA0003072464480000035
CN202010052292.9A 2020-01-17 2020-01-17 一种适用于农业机械直线导航的侧滑角度估计方法及估计器 Active CN111238471B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202010052292.9A CN111238471B (zh) 2020-01-17 2020-01-17 一种适用于农业机械直线导航的侧滑角度估计方法及估计器
US17/143,449 US20210240192A1 (en) 2020-01-17 2021-01-07 Estimation method and estimator for sideslip angle of straight-line navigation of agricultural machinery

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010052292.9A CN111238471B (zh) 2020-01-17 2020-01-17 一种适用于农业机械直线导航的侧滑角度估计方法及估计器

Publications (2)

Publication Number Publication Date
CN111238471A CN111238471A (zh) 2020-06-05
CN111238471B true CN111238471B (zh) 2021-08-24

Family

ID=70868761

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010052292.9A Active CN111238471B (zh) 2020-01-17 2020-01-17 一种适用于农业机械直线导航的侧滑角度估计方法及估计器

Country Status (2)

Country Link
US (1) US20210240192A1 (zh)
CN (1) CN111238471B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220206498A1 (en) * 2020-12-30 2022-06-30 Jingsheng Yu Lateral control in path-tracking of autonomous vehicle
JP2022188372A (ja) * 2021-06-09 2022-12-21 株式会社Subaru センターディファレンシャルの差回転拘束力制御装置
CN114115274A (zh) * 2021-11-25 2022-03-01 江苏大学 一种农用轮式拖拉机路径跟踪输出反馈控制策略
CN114162127B (zh) * 2021-12-28 2023-06-27 华南农业大学 一种基于机具位姿估计的水田无人农机路径跟踪控制方法
CN114394102B (zh) * 2022-01-24 2023-05-05 江苏徐工工程机械研究院有限公司 姿态传感器的校准方法和行驶装置
US20230311988A1 (en) * 2022-03-31 2023-10-05 Caterpillar Inc. Systems and methods for machine steering

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107074241A (zh) * 2014-10-20 2017-08-18 米兰综合工科大学 估计车辆侧滑角度的方法、实施所述方法的计算机程序、装载有所述计算机程序的控制单元以及包括所述控制单元的车辆
CN108693773A (zh) * 2018-04-04 2018-10-23 南京天辰礼达电子科技有限公司 一种农业机械自动驾驶滑坡偏差自适应估计方法
CN108873043A (zh) * 2018-05-09 2018-11-23 华南农业大学 车辆侧滑角度的计算方法及装置
CN109407668A (zh) * 2018-11-21 2019-03-01 江苏大学 一种农业机器人远程视频遥控系统及控制方法
CN110530361A (zh) * 2019-08-26 2019-12-03 青岛农业大学 一种基于农业机械双天线gnss自动导航系统的转向角度估计器

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107074241A (zh) * 2014-10-20 2017-08-18 米兰综合工科大学 估计车辆侧滑角度的方法、实施所述方法的计算机程序、装载有所述计算机程序的控制单元以及包括所述控制单元的车辆
CN108693773A (zh) * 2018-04-04 2018-10-23 南京天辰礼达电子科技有限公司 一种农业机械自动驾驶滑坡偏差自适应估计方法
CN108873043A (zh) * 2018-05-09 2018-11-23 华南农业大学 车辆侧滑角度的计算方法及装置
CN109407668A (zh) * 2018-11-21 2019-03-01 江苏大学 一种农业机器人远程视频遥控系统及控制方法
CN110530361A (zh) * 2019-08-26 2019-12-03 青岛农业大学 一种基于农业机械双天线gnss自动导航系统的转向角度估计器

Also Published As

Publication number Publication date
CN111238471A (zh) 2020-06-05
US20210240192A1 (en) 2021-08-05

Similar Documents

Publication Publication Date Title
CN111238471B (zh) 一种适用于农业机械直线导航的侧滑角度估计方法及估计器
AU2020104234A4 (en) An Estimation Method and Estimator for Sideslip Angle of Straight-line Navigation of Agricultural Machinery
CN112050809B (zh) 轮式里程计与陀螺仪信息融合的无人车定向定位方法
CN101949703B (zh) 一种捷联惯性/卫星组合导航滤波方法
CN110530361B (zh) 基于农业机械双天线gnss自动导航系统的转向角度估计器
WO2020238011A1 (zh) 一种履带式拖拉机运动学估计及偏差校准方法
CN113311411A (zh) 一种用于移动机器人的激光雷达点云运动畸变校正方法
CN111238535B (zh) 一种基于因子图的imu误差在线标定方法
CN110077392B (zh) 一种自动泊车定位系统的航迹推算方法
CN103852760B (zh) 一种基于刚性和柔性基线组合的多基线测量方法
CN105136145A (zh) 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法
CN110133694B (zh) 基于双天线gnss航向和轮速辅助的车辆定位方法及系统
CN105987696A (zh) 一种低成本车辆自动驾驶设计实现方法
CN112762961B (zh) 一种车载惯性里程计组合导航在线标定方法
CN108919304B (zh) 一种基于参考平面的移动测量系统中pos误差补偿方法
CN104359496B (zh) 基于垂线偏差补偿的高精度姿态修正方法
CN110987470A (zh) 一种基于模型迭代的汽车质量在线估计方法
CN112326990A (zh) 一种作业车辆测速方法及系统
CN112455506B (zh) 一种多维度自校准的列车运行位置精确定位的方法及系统
Si et al. High-precision estimation of steering angle of agricultural tractors using GPS and low-accuracy MEMS
CN108332756B (zh) 一种基于拓扑信息的水下航行器协同定位方法
CN107830872A (zh) 一种舰船捷联惯性导航系统自适应初始对准方法
CN114115274A (zh) 一种农用轮式拖拉机路径跟踪输出反馈控制策略
CN111220151B (zh) 载体系下考虑温度模型的惯性和里程计组合导航方法
CN110133695A (zh) 一种双天线gnss位置延迟时间动态估计系统及方法

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