全方位移动机器人自主导航方法及防疫机器人与流程
本发明属于自主导航，具体涉及一种全方位移动机器人自主导航方法及防疫机器人。
1、Kaiyun中国体育官网目前的，防疫机器人大多采用差速轮驱动方式，当防疫机器人工作在非结构化且狭窄的环境中时，不利于防疫机器人的转向，因此不能保证防疫机器人顺利的完成消杀任务。因此具有自主、高效、覆盖面广的全向智能防疫机器人，不仅是时代发展的方向，更是防疫形式的迫切需求。
1、鉴于上述的分析，本发明旨在公开了一种全方位移动机器人自主导航地图构建方法及防疫机器人，实现全方位移动、自主导航、自主避障和防疫消杀功能，能够更好的实现消毒区域全覆盖功能。
3、采用包括激光雷达、imu单元和里程计在内的传感器获取机器人移动过程的周围环境信息；
5、使用激光雷达进行机器人的自主导航建图，在建图过程中，结合所述数据融合滤波器输出数据作为新的混合提议分布，基于gmapping算法构建自主导航地图；
6、根据自主导航地图，采用基于定向搜索a*算法进行路径规划，实现机器人的自主导航。
7、进一步地，所述机器人采用4个麦克纳姆轮进行驱动；将四个麦克纳姆轮的速度信息合成得到里程计观测量数据；
8、测量的所述四个麦克纳姆轮中左前轮的角速度为ωlf，左后轮的角速度为ωlb，右前轮的角速度为ωrf，右后轮的角速度为ωrb；
9、根据机器人麦克纳姆轮角速度计算的机器人速度为v＝[vx vy ωz]t，vx为机器人在x轴的线速度，vy为机器人在y轴的线速度，ωz为机器人的整体角速度；
12、对测量的机器人速度v进行积分得到里程计观测量数据[x,y,θyaw]；其中x,y为机器人的全局平面坐标，θyaw为机器人的偏航角。
14、所述扩展卡尔曼滤波器的状态量x(k)＝[x,y,z,θpitch,θroll,θyaw]t；x,y,z为机器人的全局三维坐标；θpitch、θroll和θyaw为机器人的俯仰角、滚转角和偏航角；
18、2)判断起始节点或指定节点是否为目标节点；是，则跳转至6)，否则继续执行；
19、3)计算出起始节点或指定节点与目标节点之间的定向导引函数值，确定优先搜索方向；
20、4)依据障碍物分布情况，选择待指定节点；将待指定节点和东、南、西、北四个方向添加到open_list，同时将障碍物节点添加到close_list；
21、5)找出最小代价函数f(x)对应的节点作为指定节点，并将该指定节点标记为close_list中的元素，记录其父节点；并继续执行2)；
24、进一步地，将引导启发函数γs与方位判定阈值区间(ε1,ε2)进行比较确定优先搜索方向，其中，
30、(xs，ys)为起始节点或指定节点的全局坐标；(xg，yg)为目标节点的全局坐标。
32、依据障碍物分布初步确定方向搜索；当障碍物在目标节点与当前节点之间的连线上时，则终止该方向搜索；当障碍物在连线的某一侧时，则继续搜索；当障碍物在连线的两侧，且位于正方向时，则继续搜索；
33、待初步确定方向搜索完成后，转而搜索东、南、西、北四个方向，以其中代价函数值γs最小的节点作为下一个待指定节点。
35、获得生成的路径节点集合为l＝{qii＝0,1,2…,n}；其中，qi表示生成的路径上的第i个路径节点；
36、依据三点共线三个节点是否共线，若三个节点处于同一条直线节点为可舍节点，执行去除q1节点并更新路径l的操作；
37、随后继续判断q0、q2、Kaiyun中国体育官网q3三个节点是否存在可舍节点，若不存在，则继续遍历q2、q3、q4三个节点，直至遍历所有的路径节点为止；
40、获得经过关键节点提取优化后的路径节点集合为s＝{qjj＝0,1,2…,m}；其中，qj表示优化后路径上的第j个路径节点；
41、确定起始点q0与目标节点qm所在直线方程，遍历该线段所经过的节点坐标，判断两者之间是否存在障碍物；
42、若无障碍物，则删除两者之间的其它路径点，并将q0和qm两点保留至新的路径，同时退出程序；
43、否则，连接q0和qm-1，若两者之间的连线满足无障碍物条件，则保留q0和qm-1，qm三个路径节点作为最终路径节点集合；
44、否则，连接q0和qm-2，以此类推，直至找到与起始点之间的连线满足条件的qj节点；随后将qj节点作为新的起始点q0，重复上述步骤，直至路径中不存在多余路径节点。
45、进一步地，引入贝塞尔曲线对改进后的a*算法所生成的规划路径进行平滑处理。
46、本发明还公开了一种防疫机器人，所述防疫机器人在进行防疫消杀工作时，采用如上所述的全方位移动机器人自主导航方法进行自主导航。
48、本发明实现全方位移动、自主导航、自主避障和防疫消杀功能，能够更好的实现消毒区域全覆盖功能，运动方式灵活多变，可实现全方位移动，以此更好的保障在狭窄空间消杀的全面、彻底性；采用麦克纳姆轮做智能防疫机器人的驱动轮实现其全方位移动；采用slam技术实现智能防疫机器人的自主定位及导航功能，使其具有智能化、全自动化；搭配小型消毒喷雾器，使其具有防疫消杀功能，在节省大量人力、物力和财力的同时，高质量高效率的完成工作区域防疫消杀的任务。
2.根据权利要求1所述的全方位移动机器人自主导航方法，其特征在于，所述机器人采用4个麦克纳姆轮进行驱动；将四个麦克纳姆轮的速度信息合成得到里程计观测量数据；
3.根据权利要求2所述的全方位移动机器人自主导航方法，其特征在于，所述数据融合滤波器采用扩展卡尔曼滤波器；
4.根据权利要求1所述的全方位移动机器人自主导航方法，其特征在于，所述基于定向搜索a*算法进行路径规划包括：
7.根据权利要求4所述的全方位移动机器人自主导航方法，其特征在于，所述路径关键节点提取，包括：
8.根据权利要求7所述的全方位移动机器人自主导航方法，其特征在于，所述“拉直”处理包括：
9.根据权利要求4所述的全方位移动机器人自主导航方法，其特征在于，引入贝塞尔曲线对改进后的a*算法所生成的规划路径进行平滑处理。
10.一种防疫机器人，其特征在于，所述防疫机器人在进行防疫消杀工作时，采用如权利要求1-9任一项所述的全方位移动机器人自主导航方法进行自主导航。
本发明涉及一种全方位移动机器人自主导航方法及防疫机器人，自主导航方法，包括：采用包括激光雷达、IMU单元和里程计在内的传感器获取机器人移动过程的周围环境信息；建立数据融合滤波器将里程计和IMU单元观测量数据进行融合；使用激光雷达进行机器人的自主导航建图，在建图过程中，结合所述数据融合滤波器输出数据作为新的混合提议分布，基于Gmapping算法构建自主导航地图；根据自主导航地图，采用基于定向搜索A*算法进行路径规划，实现机器人的自主导航。本发明实现全方位移动、自主导航、自主避障，能够更好的实现区域全覆盖。
1.振动信号时频分析理论与测试系统设计 2.汽车检测系统设计 3.汽车电子控制系统设计