机器人室内运动轨迹修正控制算法.docx

《机器人室内运动轨迹修正控制算法.docx》由会员分享，可在线阅读，更多相关《机器人室内运动轨迹修正控制算法.docx（10页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、机器人室内运动轨迹修正控制算法网络转载导语：挪动机器人兼具环境信息感悟、动态决策与智能规划、行为准确控制与执行、自主导航与定位等复杂功能于一体，是当前研究的热门，在军事、工业、农业、效劳等行业具有宏大的应用潜力。目前，多数挪动机器人在室内复杂环境中运动时，仅依靠里程计和声呐等传感器来确定自身位置，机器人的实际运动轨迹和预设轨迹会出现较大偏向，严重影响了机器人的深层次应用开发。本文针对室内机器人运动轨迹不准确问题提出了一种解决方案。挪动机器人兼具环境信息感悟、动态决策与智能规划、行为准确控制与执行、自主导航与定位等复杂功能于一体，是当前研究的热门，在军事、工业、农业、效劳等行业具有宏大的应用潜力

2、。目前，多数挪动机器人在室内复杂环境中运动时，仅依靠里程计和声呐等传感器来确定自身位置，机器人的实际运动轨迹和预设轨迹会出现较大偏向，严重影响了机器人的深层次应用开发。本文针对室内机器人运动轨迹不准确问题提出了一种解决方案。对机器人运动轨迹偏向的限制可从硬件和软件两方面考虑。从硬件角度看，可以采用高精度传感器和高可靠性的系统来提升机器人导航的准确性；从软件角度看，可以改良机器人导航定位算法，得到准确的位姿参数反应给运动控制系统。本文主要从软件算法的角度修正机器人运动轨迹偏向：首先，将LiDAR传感器信息转化为正确的命令，实时地反应到运动控制端以修正机器人的运动轨迹偏向；其次，通过大量试验优化算

3、法中的轨迹修正模型参数，进一步提升机器人室内运动轨迹的准确度。1室内测图运动轨迹控制算法1.1机器人室内测图与定位模型本文在机器人控制平台上安装LiDAR传感器设备，利用开源的HectorSLAM算法包进展调试，搭建SLAM功能模块，实现挪动机器人室内未知环境下的同时定位与地图创立，以便对机器人坐标定位信息进展收集。1.1.1运动模型为准确描绘挪动机器人的运动，需要将实际的运动轨迹参数化，利用数据来表示机器人在环境中的位置和姿态信息，并进展调控，如图1所示。图1机器人运动模型设k时刻机器人运动状态为Xk=(xk,yk,k)，那么基于控制命令的运动模型可表示为 (1)式中，V为速度；W为角速度；

4、U为噪声项，表示轮子运动中的机械误差或者环境噪声；同时有机器人速度 (2)式中，轮子半径为r；轮距为2l；轮子速度为。1.1.2SLAM模块SLAM功能模块能在未知环境中获取机器人的实时位姿信息并创立环境地图，详细处理经过如图2所示。首先，传感器对环境信息进展扫描，并对观测量进展信息处理，对收集到的点云和图像数据进展加工；其次，需要进展特征匹配，在滤波器算法中进展优化，进而呈现出挪动机器人在部分环境中的运动轨迹和创立的地图信息；最后，通过SLAM功能模块输出的机器人运动轨迹和地图信息，可以通过轨迹修正算法来调整机器人状态。图2SLAM框架详细环境中，将LiDAR安置在机器人面板上对走廊地图进展

5、扫描时，可以看到SLAM地图创立和真实环境的比照情况，如图3、图4所示。图3SLAM真实测试环境图4SLAM地图创立结果激光测距仪扫描环境信息的经过中，观测量是环境路标和机器人之间的间隔和方位角，设路标点为i，传感器位置为s点，这时系统的观测模型为 (3)式中，xks表示传感器在k时刻的x坐标值；yks表示传感器在k时刻的y坐标值；ks表示传感器在k时刻的方位角；v表示间隔观测噪声；v表示方位角观测噪声；xi表示第i个地标的x坐标值；yi表示第i个地标的y坐标值。由于传感器的位置与机器人的位置之间可互相转换，借此可得到观测值Z和机器人位置之间的函数关系，即传感器观测模型。在观测经过中，观测噪声

6、服从高斯分布，也可以把上述观测量转换到极坐标系中。1.2PID轨迹修正控制算法PID控制是比例-积分-微分控制器的简称，分为P(比例单元)、I(积分单元)和D(微分单元)3局部，主要适用于线性反应控制系统。在机器人轨迹控制实际应用中，控制器将传感器采集到的地图和定位数据与预期参考值进展比拟，然后把差值传送到输入控制端，用于求解所期望的输出数据，新的输入可以保持系统参数向标准值的方向转变。PID回路包括3局部：传感器测量信息、控制器决策信息、输出设备单元。在回路中利用需求结果和测量结果的差值来计算系统的纠正值，再根据纠正值，做出相应决策，以消除误差。在控制回路中，消除纠正值的含义是指去除当前的误

7、差、平均过去的误差或者改变将来的误差。如图5所示，安置在机器人面板上的激光测距仪信息就是PID控制构造中的反应信息源，利用信息源做出决策信息是的关键局部，本文在轨迹修正决策中采取了PI闭环控制算法，利用激光雷达对机器人的定位输出对机器人的运动状态进展实时的反应式调控。图5反应控制构造在机器人的轨迹修正经过中主要采用PI控制算法，详细内容分为以下两局部：1.2.1方位角修正原理 (1)转向设置：当机器人偏移预设直线轨迹时，机器人的偏移方向通过激光雷达SLAM输出坐标信息可判定。 (2)转动角度：转动幅度的大小不是任意值，根据机器人的硬件特性和屡次试验测试模拟出最正确的转向参数，对应不同的坐标阈值

8、分别设定不同的转向角度，才能保证修正轨迹的准确性。设机器人横轴上偏离的间隔为d，单位为m；运动速度为v,单位为m/s；调整的角度为,单位为度。经过试验测试总结，有如下调整关系 (4)1.2.2间隔修正原理 (1)方向设置：一般情况下机器人在行进经过中不能到达指定位置，即是积分式的修正控制形式。由机器人累计的间隔增量和预设间隔的差值可判定机器人修正后的运动方向。 (2)修正间隔：即对机器人SLAM功能模块输出的间隔增量和预设间隔的差值进展补偿。2轨迹修正算法测试机器人典型的运动轨迹分为直线运动和曲线运动，曲线运动可以看作直线运动的叠加，因此在机器人运动学的研究领域中主要考察机器人直线运动和回环运

9、动的轨迹准确性，本文针对这两种典型的运动轨迹设计了相应的试验，对轨迹修正算法的效果进展分析比拟。2.1直线轨迹测试 (1)直线行走测试:改变轨迹修正算法中的方位角调整参数，比照同等条件下，机器人直线运动10m的修正效果，如图6和图7所示。图6细微修正参数图7较佳修正参数比照分析可以看到，修正参数经过调整后，对机器人运动轨迹的漂移有很好的限制作用，优化后的修正参数可以将机器人运动轨迹限制到厘米级别。 (2)控制挪动机器人在直线上往返行走5m间隔，比拟修正前后的轨迹，结果如图8和图9所示。图8修正前后直线运动轨迹比照图9修正前后运动轨迹放大比照图9是图8中机器人运动轨迹终点处放大局部。分析图9可知

10、，进展修正后的机器人运动轨迹偏向可以有效收敛，未经修正的机器人运动轨迹一旦发生漂移就会不断累加。2.2回环道路测试为了检测算法修正的稳定性，设计了典型的闭环检测4试验：控制挪动机器人在室内沿墙行走，轨迹为长方形，本次试验设置在走廊环境，长方形轨迹的长4m，宽为0.9m，详细模型如图10所示。图10回环测试轨迹模型试验结果分析可知，在正常的室内环境下，进展轨迹修正和不进展轨迹修正时，机器人按照预设道路的运动轨迹，可以看出轨迹修正算法的可行性。如图11所示，试验说明修正后的Y轴平均误差在5cm，未修正Y轴平均误差28cm。显然，机器人运动轨迹偏向经过反应控制修正后，可得到有效控制，仅依靠里程计定位

11、的机器人运动轨迹误差在漂移后会不断累加，通过LiDAR传感器信息的约束可以收敛到厘米级别，也验证了轨迹修正算法的可行性和可靠性。图11机器人无人状态下室内回环测试3结语本文针对机器人运动轨迹偏向设计了一套轨迹修正算法，定性和定量地分析了机器人轨迹修正的数学模型和修正参数。通过大量的试验数据构建了机器人轨迹修正控制的经历模型，得到了可靠的轨迹修正控制参数。分析轨迹修正后的多个试验结果可知，对挪动机器人室内测图的预设轨迹进展PID轨迹控制算法修正后，机器人室内运动经过中可以实时调整自己的运动状态，不需要附加人为的控制命令约束。另外，进展轨迹修正算法控制的挪动机器人可以按照预设道路进展准确挪动，具有很高的稳定性，在室内运动经过中可以到达预期的精度要求，经过大量试验得到的轨迹修正控制模型效果明显，验证了本套机器人运动轨迹偏向修正方案的可行性和可靠性。