【技术实现步骤摘要】
一种基于电子差速底盘的航向控制方法及装置
本专利技术涉及车辆控制系统
,具体为一种基于电子差速底盘的航向控制方法及装置。
技术介绍
自动驾驶汽车又称无人驾驶汽车、电脑驾驶汽车、或轮式移动机器人,是一种通过电脑系统实现无人驾驶的智能汽车。在20世纪已有数十年的历史,21世纪初呈现出接近实用化的趋势。自动驾驶汽车依靠人工智能、视觉计算、雷达、监控装置和全球定位系统协同合作,让电脑可以在没有任何人类主动的操作下,自动安全地操作机动车辆。现有的无人驾驶车辆,其一般是通过输入指定的行驶路线,由计算机控制车辆按设定的路线行进,但若在野外或山路等道路不平的情况下,由于颠簸和重力偏差等因素,会使车身在车轮行进方向不变的情况下发生整体偏移,进而偏离路线,而其无法自动纠偏,只能依靠人工远程控制,使用具有局限性。
技术实现思路
针对现有技术的不足,本专利技术提供了一种基于电子差速底盘的航向控制方法及装置,解决了现有的无人驾驶车辆,只是按照设定的路线运行,在野外或山路等道路不平的情况下,由于颠簸和重力偏差等因素,会使车身在 ...
【技术保护点】
1.一种基于电子差速底盘的航向控制方法,其特征在于:包括如下步骤:/n步骤一:上位机(2)根据相关接口接收当前航向和目标航向数据;/n步骤二:上位机(2)经过数据处理和导航决策计算得出航向偏差值;/n步骤三:将航向偏差值经RS232通讯模块(3)传输至底盘控制器(41);/n步骤四:底盘控制器(41)接收到偏差值之后根据PID算法不断进行航向纠偏计算,通过计算得出的左右两轮不同的PWM控制量,间接控制底盘行驶中的角速度,最终寻求当前航向与目标航向偏差值变为零,直到到达目标点,实现底盘的航向控制。/n
【技术特征摘要】
1.一种基于电子差速底盘的航向控制方法,其特征在于:包括如下步骤:
步骤一:上位机(2)根据相关接口接收当前航向和目标航向数据;
步骤二:上位机(2)经过数据处理和导航决策计算得出航向偏差值;
步骤三:将航向偏差值经RS232通讯模块(3)传输至底盘控制器(41);
步骤四:底盘控制器(41)接收到偏差值之后根据PID算法不断进行航向纠偏计算,通过计算得出的左右两轮不同的PWM控制量,间接控制底盘行驶中的角速度,最终寻求当前航向与目标航向偏差值变为零,直到到达目标点,实现底盘的航向控制。
2.根据权利要求1所述的一种基于电子差速底盘的航向控制方法及装置,其特征在于:所述步骤一中,上位机(2)通过通讯接口读取IMU的数据,解析提取出航向角度值。
3.根据权利要求2所述的一种基于电子差速底盘的航向控制方法及装置,其特征在于:所述步骤二中,将权利要求2中得出的航向角度值经过坐标系变换和磁偏角矫正计算得出计算所用值,并与相关导航接口所得目标航向值做差值计算,得到航向角偏差。
4.根据权利要求3所述的一种基于电子差速底盘的航向控制方法及装置,其特征在于:所述步骤四中,将权利要求3中所得航向角偏差值通过算法计算后控制两轮底盘按照目标航向角前进。
5.根据权利要求1所述的一种基于电子差速底盘的航向控制方法及装置,其特征在于:当求得的航向偏差角度的值大于180度或小于-180度时,从反方向进行转向;获取需要偏转的角度后,不断调整底盘的前进方向,寻求航向与目标航向角一致地行进。
6.根据权利要求1所述的一种基于电子差...
【专利技术属性】
技术研发人员:洪彬,侯静,
申请(专利权)人:天津市天波科达科技有限公司,
类型:发明
国别省市:天津;12
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。