-
公开(公告)号: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误差模型可避免随机陀螺仪随机误差对姿态估计造成影响;自适应卡尔曼滤波系统方程可以保证在不同状态下的姿态估计精度。
-
公开(公告)号:CN109087341B
公开(公告)日:2022-07-05
申请号:CN201810578052.5
申请日:2018-06-07
Applicant: 华南农业大学
Abstract: 本发明公开了一种近距离高光谱相机与测距传感器的融合方法,具体包括下述步骤:S1、设计传感器安装支架并安装高光谱相机和测距传感器;S2、设计立体标定棋盘格,使参考点之间具有不同的深度信息;S3、利用外置计算机同时采集高光谱相机与测距传感器信息,其中采集测距传感器信息时立体棋盘格处于静止状态;S4、将高光谱相机与测距传感器的测量信息都统一到系统坐标系下,建立传感器之间的关联;S5、基于线推扫式高光谱相机标定模型建立高光谱相机与测距传感器融合模型,并借助直接线性转换DLT法进行求解。本发明具有较高的分辨率与精度,将光谱信息与空间信息进行融合,为搭建三维光谱模型提供了可能。
-
公开(公告)号: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误差模型可避免随机陀螺仪随机误差对姿态估计造成影响;自适应卡尔曼滤波系统方程可以保证在不同状态下的姿态估计精度。
-
公开(公告)号:CN109087341A
公开(公告)日:2018-12-25
申请号:CN201810578052.5
申请日:2018-06-07
Applicant: 华南农业大学
Abstract: 本发明公开了一种近距离高光谱相机与测距传感器的融合方法,具体包括下述步骤:S1、设计传感器安装支架并安装高光谱相机和测距传感器;S2、设计立体标定棋盘格,使参考点之间具有不同的深度信息;S3、利用外置计算机同时采集高光谱相机与测距传感器信息,其中采集测距传感器信息时立体棋盘格处于静止状态;S4、将高光谱相机与测距传感器的测量信息都统一到系统坐标系下,建立传感器之间的关联;S5、基于线推扫式高光谱相机标定模型建立高光谱相机与测距传感器融合模型,并借助直接线性转换DLT法进行求解。本发明具有较高的分辨率与精度,将光谱信息与空间信息进行融合,为搭建三维光谱模型提供了可能。
-
公开(公告)号: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接收机获得的横滚角度以及陀螺仪获取的滚转角速度进行融合处理,获得农业机械横滚角的精确估计。本发明方法可形成更连续和稳定的农业机械横滚角数据,使得农机的倾斜校正更加准确。
-
公开(公告)号: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个观测向量的系统卡尔曼滤波状态方程和测量方程,精准测量两轴姿态倾角。本发明方法考虑两轴倾角零偏,利用卡尔曼滤波融合方法自动修正,保证两轴倾角的高精度测量。
-
公开(公告)号:CN106483535B
公开(公告)日:2019-02-01
申请号:CN201611079301.3
申请日:2016-11-30
Applicant: 华南农业大学
IPC: G01S19/23
Abstract: 本发明提供一种双天线接收机位置姿态精度测试平台及测试方法,测试平台包括:支撑装置、直线导轨和牵引系统;支撑装置由升降支架、旋转支架组成;直线导轨包括开口朝上的U型槽导轨、设于U型槽导轨上方的滑块和平面滑台;U型槽导轨安装在支撑平台的上面,两个天线安装在滑台上面;牵引系统包括调速电机、传动轮、齿轮皮带、限位开关以及固连装置,固连装置将调速电机和传动轮分别固定在直线导轨两侧的护栏钢管上,齿轮皮带与调速电机、传动轮相连,齿轮皮带的一侧和滑台固连,限位开关设置在直线导轨的两端。本发明可测试不同基线长度不同速度下双天线接收机的位置和姿态精度,解决了双天线接收机定位测姿精度评价难的问题。
-
公开(公告)号: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个观测向量的系统卡尔曼滤波状态方程和测量方程,精准测量两轴姿态倾角。本发明方法考虑两轴倾角零偏,利用卡尔曼滤波融合方法自动修正,保证两轴倾角的高精度测量。
-
-
-
-
-
-
-
-
-