当前位置: 首页 > 专利查询>南通大学专利>正文

惯性导航小车位置自动调整控制方法技术

技术编号:40710060 阅读:24 留言:0更新日期:2024-03-22 11:11
本申请涉及一种惯性导航小车位置自动调整控制方法,涉及惯性导航小车位置控制技术领域,包括如下步骤:S1.在小车运行过程中,确定一个点为目标点,记为目标点1,小车通过GPS模块不断采集自身目前位置的经纬度信息,传输给MCU控制模块;S2.MCU控制模块不断计算小车当前位置距离目标点1之间的垂直距离,并与设定值比较;S3.当A点与目标点1间的垂直距离c小于或等于设定值时,判定小车已经到达了目标点1,将目标点设为目标点2,计算A点到目标点2需要转过的角度;S4.MCU控制模块控制舵机转向。具有提前判定并计算转向角度,使小车按照预期轨迹运动,位置精度高的效果。

【技术实现步骤摘要】

本专利技术涉及惯性导航小车位置控制,具体涉及一种惯性导航小车位置自动调整控制方法


技术介绍

1、惯性导航小车的基本工作原理是以牛顿力学定律为基础,通过测量小车在惯性参考系的加速度,将它对时间进行积分,且把它变换到导航坐标系中,就能够得到在导航坐标系中的速度、偏航角和位置等信息。

2、为了提高小车定位精度,目前主要采用gps与惯导系统通过卡尔曼滤波器融合的方式,实现高精度定位。gps能够全天获取相对精确的位置,但是更新频率较低,惯导系统能够以高频率提供短时间内精确的位置信息,故二者信息融合能够优势互补,从而一定程度上得到更精确的位置信息。

3、传统的gps加惯性导航模块控制小车在低速运动时效果很好,但在高速运动尤其是转弯时会发现小车难以控制并且偏出预定轨道的现象。其原因是:从处理器计算出当前点小车需要的转向角度到控制系统驱动舵机完成转角过程中需要一定的时间,而由于小车在高速的运动,这段时间内小车已经运动偏离了计算点一段不小的距离,而在此时小车仍按照原定点计算的角度转角,则会导致小车不能按照预期轨迹运动,导致小车的位置精度出现偏差。<本文档来自技高网...

【技术保护点】

1.一种惯性导航小车位置自动调整控制方法,其特征在于,小车基于GPS模块与MCU控制模块相配合用于纠偏小车的行进方向,包括如下步骤:

2.根据权利要求1所述的惯性导航小车位置自动调整控制方法,其特征在于,步骤S2中直角边c长度的计算方法为:

3.根据权利要求2所述的惯性导航小车位置自动调整控制方法,其特征在于,当小车实际行进方向与目标点1重合时,β角度为0°,此时a×cosβ的值等于a,即垂直距离c为A点与目标点1间的长度,小车保持当前行进方向。

4.根据权利要求1所述的惯性导航小车位置自动调整控制方法,其特征在于,步骤S3中,以A点、E点和目标点2为...

【技术特征摘要】

1.一种惯性导航小车位置自动调整控制方法,其特征在于,小车基于gps模块与mcu控制模块相配合用于纠偏小车的行进方向,包括如下步骤:

2.根据权利要求1所述的惯性导航小车位置自动调整控制方法,其特征在于,步骤s2中直角边c长度的计算方法为:

3.根据权利要求2所述的惯性导航小车位置自动调整控制方法,其特征在于,当小车实际行进方向与目标点1重合时,β角度为0°,此时a×cosβ的值等于a,即垂直距离c为a点与目标点1间的长度,小车保持当前行进方向。

4.根据权利要求1所述的惯性导航小车位置自动调整控制方法,其特征在于,步骤s3中,以a...

【专利技术属性】
技术研发人员:杨永杰焦仕杰李正鹏耿俊杰
申请(专利权)人:南通大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1