-
公开(公告)号:CN105974436A
公开(公告)日:2016-09-28
申请号:CN201610428507.6
申请日:2016-06-15
Applicant: 华南农业大学
Abstract: 本发明公开了一种手持高精度GNSS定位采集器及采集方法,采集器包括上位机和下位机。上位机的硬件平台以微处理器为核心,配备锂电池、电阻屏、存储芯片和无线数传模块。上位机基于WinCE嵌入式操作系统,实时显示当前采点处位置信息以及定位质量信息,可通过触屏按键对当前位置数据进行锁定和保存;下位机包括采点支撑架、GNSS天线、数传电台天线以及电控盒,下位机接收卫星和差分信号,得到采点处高精度定位信息,通过无线数传模块发送给上位机。本发明可以对农田地块边界点离线采样,为系统导航作业路线规划提供厘米级精度的原始GNSS定位数据。具有体积小,与手持监控终端配套,采点效率高等优点。
-
公开(公告)号:CN107607113B
公开(公告)日:2020-03-17
申请号:CN201710651709.1
申请日:2017-08-02
Applicant: 华南农业大学
IPC: G01C21/18
Abstract: 本发明公开了一种两轴姿态倾角测量方法,包括下述步骤:S1、基于三轴加速度计空间几何模型模型,准静态情况下对横滚角与俯仰角初始值进行准确估算,并作为卡尔曼滤波器的状态输入量;S2、将两轴倾角零偏biasroll、biaspitch也作为卡尔曼滤波的状态输入量;S3、将X轴陀螺仪与Y轴陀螺仪测量值Gyrox、Gyroy作为卡尔曼滤波的输入向量;S4、建立包含4个状态向量与2个观测向量的系统卡尔曼滤波状态方程和测量方程,精准测量两轴姿态倾角。本发明方法考虑两轴倾角零偏,利用卡尔曼滤波融合方法自动修正,保证两轴倾角的高精度测量。
-
公开(公告)号:CN107607113A
公开(公告)日:2018-01-19
申请号:CN201710651709.1
申请日:2017-08-02
Applicant: 华南农业大学
IPC: G01C21/18
Abstract: 本发明公开了一种两轴姿态倾角测量方法,包括下述步骤:S1、基于三轴加速度计空间几何模型模型,准静态情况下对横滚角与俯仰角初始值进行准确估算,并作为卡尔曼滤波器的状态输入量;S2、将两轴倾角零偏biasroll、biaspitch也作为卡尔曼滤波的状态输入量;S3、将X轴陀螺仪与Y轴陀螺仪测量值Gyrox、Gyroy作为卡尔曼滤波的输入向量;S4、建立包含4个状态向量与2个观测向量的系统卡尔曼滤波状态方程和测量方程,精准测量两轴姿态倾角。本发明方法考虑两轴倾角零偏,利用卡尔曼滤波融合方法自动修正,保证两轴倾角的高精度测量。
-
公开(公告)号:CN107315345B
公开(公告)日:2020-10-09
申请号:CN201710484436.6
申请日:2017-06-23
Applicant: 华南农业大学
IPC: G05B13/04
Abstract: 本发明公开了一种基于双天线GNSS和预瞄追踪模型的农机自动导航控制方法,采用支持多星系统载波相位差分技术的共时钟一体双天线GNSS接收机进行农机的定位测姿,采用分段自适应的与速度相关的前视距离作为预瞄追踪模型方法中的参数对农机进行路径跟踪控制。本发明中:支持多星系统载波相位差分技术的定位板卡能有效增加参与定位解算的卫星数量,提高导航定位的精度和稳定性;基于卫星导航系统的惯导测姿提高了农机姿态测量的精度和实时性;预瞄追踪模型算法设计模拟人的驾驶行为具有预见性,路径跟踪控制效果好,提高了农机上线的快速性、稳定性以及对复杂农田路况的适应性;前视距离与速度相关,提高了农机自动导航系统在相对高速作业时的控制精度和稳定性。
-
公开(公告)号:CN107315345A
公开(公告)日:2017-11-03
申请号:CN201710484436.6
申请日:2017-06-23
Applicant: 华南农业大学
IPC: G05B13/04
Abstract: 本发明公开了一种基于双天线GNSS和预瞄追踪模型的农机自动导航控制方法,采用支持多星系统载波相位差分技术的共时钟一体双天线GNSS接收机进行农机的定位测姿,采用分段自适应的与速度相关的前视距离作为预瞄追踪模型方法中的参数对农机进行路径跟踪控制。本发明中:支持多星系统载波相位差分技术的定位板卡能有效增加参与定位解算的卫星数量,提高导航定位的精度和稳定性;基于卫星导航系统的惯导测姿提高了农机姿态测量的精度和实时性;预瞄追踪模型算法设计模拟人的驾驶行为具有预见性,路径跟踪控制效果好,提高了农机上线的快速性、稳定性以及对复杂农田路况的适应性;前视距离与速度相关,提高了农机自动导航系统在相对高速作业时的控制精度和稳定性。
-
公开(公告)号:CN107014376A
公开(公告)日:2017-08-04
申请号:CN201710117096.3
申请日:2017-03-01
Applicant: 华南农业大学
Abstract: 本发明公开了一种适用于农业机械精准作业的姿态倾角估计方法,包括对MEMS陀螺仪与加速度计固有零偏估算和结合陀螺仪二阶AR(Auto Regression)误差模型的自适应卡尔曼滤波姿态融合算法。采用AR模型估计X轴陀螺仪与Y轴陀螺仪测量误差φerr1、φerr2、θerr1、θerr2作为卡尔曼滤波的状态输入量并自适应估算测量误差协方差矩阵R。建立包含6个状态向量与2个观测向量的系统外部拓展卡尔曼滤波状态方程和测量方程,借助三轴加速度计空间几何模型自适应调整过程误差协方差矩阵Q。本发明方法考虑陀螺仪与加速度计的固有零偏,可避免姿态估算时引入系统误差;二阶AR误差模型可避免随机陀螺仪随机误差对姿态估计造成影响;自适应卡尔曼滤波系统方程可以保证在不同状态下的姿态估计精度。
-
公开(公告)号:CN107014376B
公开(公告)日:2019-09-10
申请号:CN201710117096.3
申请日:2017-03-01
Applicant: 华南农业大学
Abstract: 本发明公开了一种适用于农业机械精准作业的姿态倾角估计方法,包括对MEMS陀螺仪与加速度计固有零偏估算和结合陀螺仪二阶AR(Auto Regression)误差模型的自适应卡尔曼滤波姿态融合算法。采用AR模型估计X轴陀螺仪与Y轴陀螺仪测量误差φerr1、φerr2、θerr1、θerr2作为卡尔曼滤波的状态输入量并自适应估算测量误差协方差矩阵R。建立包含6个状态向量与2个观测向量的系统外部拓展卡尔曼滤波状态方程和测量方程,借助三轴加速度计空间几何模型自适应调整过程误差协方差矩阵Q。本发明方法考虑陀螺仪与加速度计的固有零偏,可避免姿态估算时引入系统误差;二阶AR误差模型可避免随机陀螺仪随机误差对姿态估计造成影响;自适应卡尔曼滤波系统方程可以保证在不同状态下的姿态估计精度。
-
公开(公告)号:CN106772517A
公开(公告)日:2017-05-31
申请号:CN201611243607.8
申请日:2016-12-29
Applicant: 华南农业大学
CPC classification number: G01S19/47 , G01C21/005 , G01C21/18 , G01S19/41
Abstract: 本发明公开了一种基于双天线GNSS接收机/陀螺仪信息融合的农机横滚角测试方法,采用双天线GNSS接收机测量得到的横滚角白噪声较大,不易直接用于农机姿态的校正。陀螺仪输出数据平稳,短时间稳定性强,但长期精度差。采用卡尔曼滤波器对双天线GNSS接收机获得的横滚角度以及陀螺仪获取的滚转角速度进行融合处理,获得农业机械横滚角的精确估计。本发明方法可形成更连续和稳定的农业机械横滚角数据,使得农机的倾斜校正更加准确。
-
-
-
-
-
-
-