【技术实现步骤摘要】
本专利技术属于机器人，具体涉及室外作业机器人路径规划方法。
技术介绍
1、目前，以割草机器人、药物喷洒机器人和农业收割机器人等为代表，作业时需要对室外工作空间进行完整覆盖，移动机器人系统往往需要人工干预而无法实现自主运动控制，即相关机器人综合感知、运行速度有待提高。
2、传统装备制造及新型机器人公司都关注定位与实时运动规划的研发。出于成本考虑与技术门槛，主流的覆盖规划方法，主要在工作空间边界埋设电线、磁条或设立地标等，对边界进行识别，并主要通过在边界范围内随机游走或以某种固定形式移动实现对工作空间的全覆盖。这种通过埋线或地标实现的边界识别对于室外往往较大的工作区域而言往往成本较高，且管线存在老化现象，需要定期维护和更换，这对于用户而言并不友好。此外，由于没有对周围环境的感知模块，机器人往往只能随机游走并通过碰撞传感器实现对工作空间的覆盖，效率相对较低。
3、在同样需要用到全覆盖路径规划的扫地机器人产业由于竞争激烈，产品迭代十分迅速，目前的主打产品已经能够基于碰撞监测、红外、激光或超声雷达等传感器，或通过双目视觉或深度相机实现在室内场景的精确定位或构建地图，进而通过智能的实时路径规划实现全覆盖和避障功能。但是，由于室外场景纹理较少、室外的工作空间往往相对较大，进行全局建图和特征匹配对机器人的算力要求极高；室外场景纹理信息不够充足且光照变化比较明显，使得机器人的精确定位非常困难，机器人无法实现对环境和自身状态的准确感知，自然也无法据此实现实时全覆盖路径规划。因此，在扫地机器人中使用的定位和路径规划算法并不能简
技术实现思路
1、本专利技术的目的在于提供一种安全可靠、路径优化的室外作业机器人实时全覆盖路径规划方法。
2、本专利技术提供的室外作业机器人实时全覆盖路径规划方法，包括采用gps、imu和双目相机三类传感器对机器人位置进行融合定位，提高系统整体的定位精度；根据双目立体视觉建图原理得到任意空间点相对于机器人本身的位置；将各个空间点以点云的形式整合，得到周围环境的点云地图，通过转换得到八叉树地图；采用基于分解的全覆盖路径规划算法进行全覆盖路径规划；最后通过pid和lqr等算法控制机器人沿着参考路径移动，实现对工作空间的全覆盖；其整体架构参见图1；具体步骤为：
3、步骤(一)采用三种传感器进行融合定位
4、具体地，考虑到室外环境的需求，机器人系统采用gps、imu和双目相机三类传感器进行融合定位。其中，双目相机能够实现对周围环境的感知，便于建立局部地图，同时还能将视频输入交付给语义处理模块，基于深度学习识别图像中的障碍物和动态物体，从而为后续的定位、路径规划和避障提供必要的信息。imu作为低成本的定位设备，能够在短时间内给出精度较高的位姿数据。gps定位精度为米级，但能够直接给出绝对位置，不会产生累计误差。
5、三类传感器的融合定位能够使不同传感器的优劣势互补，得到更高也更鲁棒的定位性能。双目视觉里程计可通过图像对周围环境建模并根据三角测量实现对自身位姿的估计，但精度易受光照和动态物体的影响，通过imu可以一定程度上弥补此类情况下的定位误差，这也是多传感器融合定位系统中非常经典的组合。双目相机和imu都通过计算不同采样点间的相对位姿来计算机器人的状态，但由于每次估计都存在一定误差，经过多次计算之后得到的绝对位姿将因为出现累计误差产生较大的偏移，而这可以通过gps给出的绝对位置进行纠正。gps根据设备成本的不同在室外环境可以实现厘米级到米级的定位精度，但是由于室外环境往往还存在遮挡和天气等因素的干扰，单纯的gps定位无法保证做到全程覆盖，且低成本的gps往往只能精确到米级，所以通过双目相机和imu的补充能够提高系统整体的定位精度。
6、通过三类传感器的组合，定位模块能够各取所长，以较低的成本实现相对较高的定位精度。下面将对三种传感器的测量模型进行简单介绍，并在之后给出本专利技术采用的低耦合融合定位方案。
7、(1)双目相机
8、视觉slam由于成本较激光雷达低且包含大量的语义信息，随着slam(实时定位与建图)的发展在学界的热度已经逐渐超越激光slam。近年来视觉slam方案不断迭代，并表现出不弱于激光雷达的精度和鲁棒性，而其中双目相机由于性能相对均衡，广泛地被各类移动机器人搭载。
9、通过对图像提取特征点，可以对相邻帧的特征点进行特征匹配，进而通过dlt(直接线性变换)等方法求解出相邻两帧间的相对位姿，多个帧间的相对位姿叠加，即可得到当前的绝对位姿，实现双目视觉定位。
10、(2)imu惯导
11、imu通常包含加速度计和陀螺仪，能够以较高的频率给出设备的平移加速度和旋转角速度，将每个帧测量得到的加速度和角速度乘以采样周期即可得到两个帧间的相对位姿。和双目相机类似，imu给出的帧间相对位姿往往具有较高的精度，但是由于长时间的累计对误差的放大效应，长时间运行之后得到的绝对位姿相对较高。
12、(3)gps卫星定位
13、gps是一种通过卫星信号确定地球上任意位置的定位系统。围绕地球轨道运行的卫星不断发射包含自身位置和时间戳信息的信号，接收器在接收到来自多个卫星的信号后即可根据卫星信号的传播时间以光速确定卫星的距离，通过接收至少来自三颗卫星的信号即可计算出接收器相对于各个卫星的相对位置。
14、由于gps给出的是绝对位置，不需要经过对相对位置的积分过程，因此并不存在累计误差。通过增加接收的频段，接收器能够实现更加精确的定位信息，但是此类高精度接收器受限于高成本并没有被包括割草机器人、药物喷洒机器人和收割机器人等为代表的需要对室外工作空间进行完整覆盖的移动机器人广泛采用—通过与imu和双目相机等低成本传感器进行融合定位，系统能够实现更高的定位精度和鲁棒性。
15、在通过以上定位方法获得来自三类传感器给出的位姿信息后，需要将数值不同的信息进行整合，本专利技术采用的是松耦合方案，亦即通过ekf(extended kalman filter,扩展卡尔曼滤波)实现对三个位姿信息的加权，得到更加精确的定位。ekf假设所有的测量都是以真值为均值的高斯分布，来自三个传感器的信息可以通过不同的计算方式得到对状态的估计，通过对三个估计的方差不断进行更新，可以对基于三个传感器的测量进行加权，从而得到理论上最优的估计值。关于ekf的详细迭代过程，可以参考图2所示。
16、具体而言，对于任意的移动机器人系统，其在时刻k处的状态可以用xk表示，通常xk为由机器人的空间坐标p＝(x,y,z)t、姿态o＝(r,p,y)t和速度v＝(vx,vy,vz)t构成的向量，亦即xk＝(p,o,v)t。在进行位姿估计之前，需要事先建立系统的运动模型xk＝f(xk-1,uk-1)，其中uk-1表示系统在k时刻的控制命令，通常为加速度a＝(ax,ay,az)和角加速度ω＝(ωr,ωp,ωy)，可以表示为uk-1＝(a,ω)t。
17、对于绝大多数移动机本文档来自技高网...
【技术保护点】
1.一种室外作业机器人实时全覆盖路径规划方法，其特征在于，包括采用GPS、IMU和双目相机三类传感器对机器人位置进行融合定位，提高系统整体的定位精度；根据双目立体视觉建图原理得到任意空间点相对于机器人本身的位置；将各个空间点以点云的形式整合，得到周围环境的点云地图，通过转换得到八叉树地图；采用基于分解的全覆盖路径规划算法进行全覆盖路径规划；最后通过PID和LQR算法控制机器人沿着参考路径移动，实现对工作空间的全覆盖；具体步骤为：
2.根据权利要求1所述的室外作业机器人实时全覆盖路径规划方法，其特征在于，步骤(一)中，所述通过EKF对三个位姿信息的加权迭代，具体为：
3.根据权利要求1所述的室外作业机器人实时全覆盖路径规划方法，步骤(三)中，具体采用基于Morse的分解方法；具体通过Morse曲线扫描整个目标空间，即得到多个关键点，即Morse曲线与障碍物的切点，在经过关键点时Morse曲线被障碍物划分为多段，进而产生多个候选子区域，而离开障碍物时同样因为经过关键点，多段Morse曲线合并为一段，完成子区域的生成并产生新的候选子区域；这里，Morse函数采用
...【技术特征摘要】
1.一种室外作业机器人实时全覆盖路径规划方法，其特征在于，包括采用gps、imu和双目相机三类传感器对机器人位置进行融合定位，提高系统整体的定位精度；根据双目立体视觉建图原理得到任意空间点相对于机器人本身的位置；将各个空间点以点云的形式整合，得到周围环境的点云地图，通过转换得到八叉树地图；采用基于分解的全覆盖路径规划算法进行全覆盖路径规划；最后通过pid和lqr算法控制机器人沿着参考路径移动，实现对工作空间的全覆盖；具体步骤为：
2.根据权利要求1所述的室外作业机器人实时全覆盖路径...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。