CN112014122B - 一种车轮转角测量装置及运行方法 - Google Patents
一种车轮转角测量装置及运行方法 Download PDFInfo
- Publication number
- CN112014122B CN112014122B CN202010701811.XA CN202010701811A CN112014122B CN 112014122 B CN112014122 B CN 112014122B CN 202010701811 A CN202010701811 A CN 202010701811A CN 112014122 B CN112014122 B CN 112014122B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- wheel
- angular velocity
- control box
- bias
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M17/00—Testing of vehicles
- G01M17/007—Wheeled or endless-tracked vehicles
- G01M17/013—Wheels
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明涉及一种自动驾驶辅助装置,具体说是车轮转角测量装置及运行方法。它包括车轮陀螺仪、力矩电机和导航控制箱,导航控制箱内有车身陀螺仪。运行时,导航控制箱先通过车轮陀螺仪和力矩电机分别获得车轮转向角速度和方向盘的转向角速度信息,对二者信息进行加权融合,融合后的角速度信息进行积分得到车轮角度信息,再在车辆运动过程中,导航控制箱根据车辆运动学模型预估车辆前轮转角,采用kalman滤波估计,实时估计和修正车轮角度积分误差和陀螺零偏,确保了车轮角度信息的准确性。该测量装置的安装过程简便、消耗的人力较少,使用效率较高。
Description
技术领域
本发明涉及一种自动驾驶辅助装置,具体说是车轮转角测量装置及运行方法,特别适用于农机。
背景技术
在精准农业领域,农机在自动驾驶时需要知晓驱动轮的转角信息,作为车辆状态信息用于反馈控制,车轮角度信息的精度直接关系到农机的行走精度,直接影响农机作业效率和效果。
传统的车轮转角测量装置为接触式霍尔式传感器。然而,接触式霍尔传感器的缺点是结构件较为复杂,安装较麻烦。并且霍尔旋转中心和农机转向节中心要求同轴安装,安装时需要专业人员花费很长时间校准车轮中心位置的角度,导致安装过程较繁琐,消耗的人力较多。而且,需专业人员花费很长时间校准车轮中心位置的角度,导致使用效率较低。
发明内容
本发明要解决的技术问题是提供一种车轮转角测量装置及运行方法,该测量装置的安装过程简便、消耗的人力较少,使用效率较高。
为解决上述问题,提供以下技术方案:
本发明的车轮转角测量装置的特点是包括安装在车辆前轮转向节上的车轮陀螺仪。与车辆方向盘相连的力矩电机。安装在车辆车身上的导航控制箱,导航控制箱内有车身陀螺仪。
本发明的车轮转角测量装置的运行方法的特点是包括如下步骤:
步骤1:导航控制箱通过车轮陀螺仪和力矩电机分别获得车辆前轮角速度信息和方向盘的角速度信息,对二者信息进行加权融合,对融合后的角速度信息去除车体旋转角速度后进行积分得到车辆前轮角度信息,具体含有以下步骤:
步骤101,导航控制箱高频率实时获取车轮陀螺仪的角速度信息ωgyro
其中,ωgyro=ω1+Biasa,ω1是车辆前轮实际角速度,Biasa是车轮陀螺仪偏置。
步骤102:导航控制箱实时获取力矩电机的转向速度信息ωmotor
其中,ωmotor=ω2,ω2是力矩电机输出的角速度。
步骤103:导航控制箱对车轮陀螺仪的角速度信息ωgyro和力矩电机的角速度信息ωmotor进行加权融合
其中,ω=(ωgyro+ωmotor)/2,ω加权融合后的车轮陀螺仪的角速度信息和力矩电机的角速度信息。
步骤104:导航控制箱实时获取车身旋转角速度信息ωvehicle
其中,ωvehicle=ω3+Biasb,ω3是车身实际角速度,Biasb是车身陀螺仪偏置,Biasb是被导航控制箱中的GNSS/INS组合导航估计出来的已知量。
步骤105:导航控制箱对融合后的角速度信息去除车体旋转角速度后进行积分,得到车辆前轮角度信息θ1,积分公式是:
θ1(k)=θ1(k-1)+(ω-ωvehicle)*dt
=θ1(k-1)+[(ω1+Biasa+ω2)/2-(ω3+Biasb)]*dt
其中,dt是积分时间间隔,它等于=0.02秒,k表示k时刻,车轮陀螺仪偏置Biasa未知,随着积分时间增加,θ1的积分误差会越来越大。
步骤2:车辆运动过程中,导航控制箱根据车辆运动学模型预估车辆前轮转角,采用kalman滤波估计,实时估计和修正车辆前轮角度误差和车轮陀螺仪偏置,具体含有以下步骤,
步骤201:导航控制箱根据陀螺误差特性,动态初始化kalman滤波估计相关的参数矩阵
观测量Z=θ1-θ2,其中,Z是观测角度误差,θ2是根据车辆运动学模型预估的车辆前轮转角;
系统观测噪声矩阵R=1。
步骤203:如果陀螺仪数据更新,导航控制箱则进行kalman滤波估计,修正积分误差和陀螺零偏。
最终得到修正后的车辆转角:θ=θ1-X[1],其中X[1]是δθ,即车辆前轮转向角度误差。
陀螺估计零偏:Biasa=Biasa+X[2],其中X[2]是Biasa,即车轮陀螺仪偏置。
其中,所述步骤101和步骤102中,高频率是200Hz,然后均值滤波为50Hz的数据更新频率。力矩电机的速度反馈频率是50Hz,除以传动比之后转换到车轮的转向。
所述kalman滤波估计是扩展kalman滤波估计。
采取以上方案,具有以下优点:
由于本发明的车轮转角测量装置的包括车轮陀螺仪、力矩电机和导航控制箱,导航控制箱内有车身陀螺仪。使用时,将车轮陀螺仪安装在车辆前轮转向节上,将力矩电机与车辆方向盘相连,将导航控制箱安装到车辆车身上。工作时,导航控制箱先通过车轮陀螺仪和力矩电机分别获得车轮转向角速度和方向盘的转向角速度信息,对二者信息进行加权融合,融合后的角速度信息进行积分得到车轮角度信息,再在车辆运动过程中,导航控制箱根据车辆运动学模型预估车辆前轮转角,采用kalman滤波估计,实时估计和修正车轮角度积分误差和陀螺零偏,确保了车轮角度信息的准确性。陀螺仪和力矩电机的车轮角度测量方法是非接触式,只需要陀螺仪和车辆驱动轮刚性链接即可,不需要复杂结构或同轴安装,大大简化了安装过程,减小了人力的消耗。而且,安装过程简便,工作人员消耗的时间较少,从而大大提高了车辆使用效率。
附图说明
图1是本发明的车轮转角测量装置及运行方法中车轮转角测量装置的安装示意图;
图2是本发明的车轮转角测量装置及运行方法中车轮转角测量装置的运行方法的原理图;
图3是本发明的车轮转角测量装置及运行方法中kalman滤波估计的流程图。
具体实施方式
以下结合附图对本发明做进一步详细说明。
如图1所示,本发明的车轮转角测量装置包括安装在车辆前轮转向节上的车轮陀螺仪。与车辆方向盘相连的力矩电机。安装在车辆车身上的导航控制箱,导航控制箱内有车身陀螺仪。
如图2所示,本发明的车轮转角测量装置的运行方法包括如下步骤:
步骤1:导航控制箱通过车轮陀螺仪和力矩电机分别获得车辆前轮角速度信息和方向盘的角速度信息,对二者信息进行加权融合,对融合后的角速度信息去除车体旋转角速度后进行积分得到车辆前轮角度信息,具体含有以下步骤:
步骤101,导航控制箱高频率实时获取车轮陀螺仪的角速度信息ωgyro
其中,ωgyro=ω1+Biasa,ω1是车辆前轮实际角速度,Biasa是车轮陀螺仪偏置。
步骤102:导航控制箱实时获取力矩电机的转向速度信息ωmotor
其中,ωmotor=ω2,ω2是力矩电机输出的角速度。
步骤103:导航控制箱对车轮陀螺仪的角速度信息ωgyro和力矩电机的角速度信息ωmotor进行加权融合
其中,ω=(ωgyro+ωmotor)/2,ω加权融合后的车轮陀螺仪的角速度信息和力矩电机的角速度信息。
步骤104:导航控制箱实时获取车身旋转角速度信息ωvehicle
其中,ωvehicle=ω3+Biasb,ω3是车身实际角速度,Biasb是车身陀螺仪偏置,Biasb是被导航控制箱中的GNSS/INS组合导航估计出来的已知量。
步骤105:导航控制箱对融合后的角速度信息去除车体旋转角速度后进行积分,得到车辆前轮角度信息θ1,积分公式是:
θ1(k)=θ1(k-1)+(ω-ωvehicle)*dt
=θ1(k-1)+[(ω1+Biasa+ω2)/2-(ω3+Biasb)]*dt
其中,dt是积分时间间隔,它等于=0.02秒,k表示k时刻,车轮陀螺仪偏置Biasa未知,随着积分时间增加,θ1的积分误差会越来越大。
步骤2:车辆运动过程中,导航控制箱根据车辆运动学模型预估车辆前轮转角,采用kalman滤波估计,实时估计和修正车辆前轮角度误差和车轮陀螺仪偏置,如图3所示,具体含有以下步骤,
步骤201:导航控制箱根据陀螺误差特性,动态初始化kalman滤波估计相关的参数矩阵
观测量Z=θ1-θ2,其中,Z是观测角度误差,θ2是根据车辆运动学模型预估的车辆前轮转角;
系统观测噪声矩阵R=1。
步骤203:如果陀螺仪数据更新,导航控制箱则进行kalman滤波估计,修正积分误差和陀螺零偏。
最终得到修正后的车辆转角:θ=θ1-X[1],其中X[1]是δθ,即车辆前轮转向角度误差。
陀螺估计零偏:Biasa=Biasa+X[2],其中X[2]是Biasa,即车轮陀螺仪偏置。
为了得到非滤波估计时更精确的角度信息,所述步骤101和步骤102中,高频率是200Hz,然后均值滤波为50Hz的数据更新频率。力矩电机的速度反馈频率是50Hz,除以传动比之后转换到车轮的转向。
所述kalman滤波估计是扩展kalman滤波估计。
本发明的车轮转角测量装置,通过融合陀螺仪角速度和力矩电机角速度信息得到更精确的角速度信息,去除车身角速度后积分得到更精确的角度信息。在车辆运动过程中,根据车辆运动学模型,结合kalman滤波估计,实时滤波估计和修正角度信息以及陀螺的零偏。
为了进一步提高滤波估计的准确性,本发明工作时要实时监测车辆运动状态,当车辆处于倒车状态时,滤波估计所需要的状态量以及车辆运动学模型所需要的状态信息,要发生相应的符号变化即模型中所用状态量为矢量信息,既有大小又有方向。
Claims (3)
1.一种车轮转角测量装置的运行方法,其特征在于该车轮转角测量装置包括安装在车辆前轮转向节上的车轮陀螺仪;与车辆方向盘相连的力矩电机;安装在车辆车身上的导航控制箱,导航控制箱内有车身陀螺仪;具体运行步骤如下:
步骤1:导航控制箱通过车轮陀螺仪和力矩电机分别获得车辆前轮角速度信息和方向盘的角速度信息,对二者信息进行加权融合,对融合后的角速度信息去除车体旋转角速度后进行积分得到车辆前轮角度信息,具体含有以下步骤:
步骤101,导航控制箱高频率实时获取车轮陀螺仪的角速度信息ωgyro
其中,ωgyro=ω1+Biasa,ω1是车辆前轮实际角速度,Biasa是车轮陀螺仪偏置;
步骤102:导航控制箱实时获取力矩电机的转向速度信息ωmotor
其中,ωmotor=ω2,ω2是力矩电机输出的角速度;
步骤103:导航控制箱对车轮陀螺仪的角速度信息ωgyro和力矩电机的角速度信息ωmotor进行加权融合
其中,ω=(ωgyro+ωmotor)/2,ω加权融合后的车轮陀螺仪的角速度信息和力矩电机的角速度信息;
步骤104:导航控制箱实时获取车身旋转角速度信息ωvehicle
其中,ωvehicle=ω3+Biasb,ω3是车身实际角速度,Biasb是车身陀螺仪偏置,Biasb是被导航控制箱中的GNSS/INS组合导航估计出来的已知量;
步骤105:导航控制箱对融合后的角速度信息去除车体旋转角速度后进行积分,得到车辆前轮角度信息θ1,积分公式是:
θ1(k)=θ1(k-1)+(ω-ωvehicle)*dt
=θ1(k-1)+[(ω1+Biasa+ω2)/2-(ω3+Biasb)]*dt
其中,dt是积分时间间隔,它等于=0.02秒,k表示k时刻,车轮陀螺仪偏置Biasa未知,随着积分时间增加,θ1的积分误差会越来越大;
步骤2:车辆运动过程中,导航控制箱根据车辆运动学模型预估车辆前轮转角,采用kalman滤波估计,实时估计和修正车辆前轮角度误差和车轮陀螺仪偏置,具体含有以下步骤,
步骤201:导航控制箱根据陀螺误差特性,动态初始化kalman滤波估计相关的参数矩阵
观测量Z=θ1-θ2,其中,Z是观测角度误差,θ2是根据车辆运动学模型预估的车辆前轮转角;
系统观测噪声矩阵R=1;
步骤203:如果陀螺仪数据更新,导航控制箱则进行kalman滤波估计,修正积分误差和陀螺零偏;
最终得到修正后的车辆转角:θ=θ1-X[1],其中X[1]是δθ,即车辆前轮转向角度误差;
陀螺估计,零偏:Biasa=Biasa+X[2],其中X[2]是Biasa,即车轮陀螺仪偏置。
2.如权利要求1所述的车轮转角测量装置的运行方法,其特征在于所述步骤101和步骤102中,高频率是200Hz,然后均值滤波为50Hz的数据更新频率;力矩电机的速度反馈频率是50Hz,除以传动比之后转换到车轮的转向。
3.根据权利要求1或2所述的车轮转角测量装置的运行方法,其特征在于所述kalman滤波估计是扩展kalman滤波估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010701811.XA CN112014122B (zh) | 2020-07-21 | 2020-07-21 | 一种车轮转角测量装置及运行方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010701811.XA CN112014122B (zh) | 2020-07-21 | 2020-07-21 | 一种车轮转角测量装置及运行方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112014122A CN112014122A (zh) | 2020-12-01 |
CN112014122B true CN112014122B (zh) | 2022-10-28 |
Family
ID=73499772
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010701811.XA Active CN112014122B (zh) | 2020-07-21 | 2020-07-21 | 一种车轮转角测量装置及运行方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112014122B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113126136A (zh) * | 2019-12-31 | 2021-07-16 | 上海司南卫星导航技术股份有限公司 | 基于电机方向盘的无前轮传感器自动驾驶系统 |
CN114633800B (zh) * | 2020-12-16 | 2023-08-29 | 西安合众思壮导航技术有限公司 | 一种转向轮角度的检测方法、装置及设备 |
CN114084225B (zh) * | 2021-11-19 | 2023-12-12 | 吉林大学 | 一种适用于齿轮齿条转向机构的车轮转角测量系统 |
CN114132323B (zh) * | 2021-12-01 | 2022-09-27 | 上海联适导航技术股份有限公司 | 一种基于陀螺仪和方向盘转角的轮胎转角分析方法 |
CN114162139B (zh) * | 2021-12-06 | 2024-03-26 | 上海华测导航技术股份有限公司 | 一种车辆控制方法、控制器、系统、装置及存储介质 |
CN114013504B (zh) | 2021-12-09 | 2023-03-24 | 江苏徐工工程机械研究院有限公司 | 车辆转向参数测量校准方法、系统、介质及自动驾驶车辆 |
CN114543733A (zh) * | 2022-01-19 | 2022-05-27 | 江苏大学 | 一种轮式车辆主动轮转角测量装置及控制方法 |
CN114674271B (zh) * | 2022-02-11 | 2024-06-07 | 江苏大学 | 单天线gnss辅助陀螺仪的农机转向角测量方法及装置 |
CN114572216B (zh) * | 2022-03-28 | 2023-01-03 | 安徽怡丰自动化科技有限公司 | 驱动系统的调节方法、调节装置、清洗设备及存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103697898B (zh) * | 2013-12-12 | 2016-05-25 | 沈阳美行科技有限公司 | 一种手机导航惯性推导方法 |
CN105700533B (zh) * | 2016-04-22 | 2018-12-07 | 扬州大学 | 基于北斗导航的农业机械自动驾驶控制系统及方法 |
CN107144284A (zh) * | 2017-04-18 | 2017-09-08 | 东南大学 | 基于ckf滤波的车辆动力学模型辅助惯导组合导航方法 |
CN108657269B (zh) * | 2018-04-04 | 2021-03-26 | 南京天辰礼达电子科技有限公司 | 一种农业机械方向盘电机驱动自动驾驶设备及方法 |
CN111216708B (zh) * | 2020-01-13 | 2022-02-11 | 上海华测导航技术股份有限公司 | 车辆导航引导系统及车辆 |
-
2020
- 2020-07-21 CN CN202010701811.XA patent/CN112014122B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112014122A (zh) | 2020-12-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112014122B (zh) | 一种车轮转角测量装置及运行方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
JP4952518B2 (ja) | 車両用現在位置検出装置及びプログラム | |
CN107132563B (zh) | 一种里程计结合双天线差分gnss的组合导航方法 | |
JP2004286724A (ja) | 車両挙動検出装置、車載処理システム、検出情報較正装置及び車載処理装置 | |
CN108438048B (zh) | 一种新型的履带式拖拉机自动转向控制系统及控制方法 | |
CN110095793B (zh) | 一种基于轮胎半径自适应的自动驾驶低速清扫车定位方法 | |
CN110133694B (zh) | 基于双天线gnss航向和轮速辅助的车辆定位方法及系统 | |
WO2020191977A1 (zh) | 一种自动泊车定位系统的航迹推算方法 | |
CN108759822B (zh) | 一种移动机器人3d定位系统 | |
CN114475581B (zh) | 基于轮速脉冲和imu卡尔曼滤波融合的自动泊车定位方法 | |
CN112433531A (zh) | 一种自动驾驶车辆的轨迹跟踪方法、装置及计算机设备 | |
Welte et al. | Four-wheeled dead-reckoning model calibration using RTS smoothing | |
CN112146561B (zh) | 一种霍尔角度传感器安装角度偏置的估计方法 | |
CN110133695A (zh) | 一种双天线gnss位置延迟时间动态估计系统及方法 | |
CN114966629A (zh) | 一种基于ekf算法框架的车体激光雷达外参标定方法 | |
CN115451949A (zh) | 一种基于车轮安装惯性测量单元的车辆定位方法 | |
CN115060257A (zh) | 一种基于民用级惯性测量单元的车辆变道检测方法 | |
JP2003026017A (ja) | 車両用操舵制御装置 | |
CN114935345A (zh) | 一种基于模式识别的车载惯导安装角误差补偿方法 | |
JPH07301541A (ja) | ナビゲーション装置 | |
CN112026749B (zh) | 一种线控转向系统稳定性控制方法 | |
CN114148403A (zh) | 一种线控转向系统多工况稳定性控制方法 | |
CN111231976B (zh) | 一种基于变步长的车辆状态估计方法 | |
Kochem et al. | Accurate local vehicle dead-reckoning for a parking assistance system |
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 |