一种机器人避障方法技术

本发明专利技术公开一种机器人避障方法，其包括：步骤1：采集机器人的参数：重量Wh，横截面最大宽度Wi，行进速度V；同时，为机器人预设行进路线，并以机器人的初始位置为坐标原点建立坐标系，令机器人的初始位置为O，预设行进路线的终点为P；步骤2：机器人根据预设行进路线行进，同时通过传感器实时检测障碍物，如果有障碍物，将机器人此时位置记为O1，并重新规划路线；步骤3：转动机器人的朝向，使其根据步骤2的输出路线继续前进；步骤4：机器人行进的同时通过传感器实时检测障碍物，如果有障碍物，则重复步骤2和步骤3，直到到达终点位置。

【技术实现步骤摘要】

本专利技术涉及机器人的制造领域，尤其是一种机器人的躲避障碍物的算法。
技术介绍
随着科技的发展，机器人已经逐渐成为一种新兴的热门研究领域，人们一直在研究如何让机器人取代人力来完成各种工作。机器人的本体上没有智能单元只有执行机构和感应机构，它具有利用传感信息（包括视觉、听觉、触觉、接近觉、力觉和红外、超声及激光等）进行传感信息处理、实现控制与操作的能力。一般的，机器人还受控于外部计算机，在外部计算机上具有智能处理单元，处理由受控机器人采集的各种信息以及机器人本身的各种姿态和轨迹等信息，然后发出控制指令指挥机器人的动作。其中，机器人的运行环境中，常常具有一些障碍物，如一些固定的支柱、一些临时存放的机器人难以跨越的障碍等。机器人从某位置移动到另一位置时，必须避免与这些障碍物发生碰撞，因此需要绕行。如何让机器人自动避障并选取合适的路线继续前进，是一个很复杂的问题，现有的技术已经提出了众多的解决方案，然而，这些方案中，有的算法（人工势场法、VFH直方图法等等）较为精密，但是具有很复杂难以实现和普及的缺陷，并且使得整个机器人的成本变得非常高昂；有的算法简单易于实现，但是其躲避障碍的精度不高，而且不同机器人的大小、重量不同，其行进速度和计算能力也不同，采用现有的算法，无法完全做到百分百的避障。综上，现有的机器人避障算法很难满足用户低成本、高精度的需求，也就导致机器人一直无法大范围普及。
技术实现思路
因此，针对上述的问题，本专利技术提出一种机器人避障方法，对现有的机器人的避障方案进行改进，使其躲避障碍物的算法更为简单，且考虑到机器人的大小、重量、行进速度和计算能力等参数，使机器人做到百分百躲避障碍，并行动无断点更为灵敏，且不增加成本，从而解决现有技术之不足。为了解决上述技术问题，本专利技术所采用的技术方案是，一种机器人避障方法，包括如下步骤：步骤1：采集机器人的参数：重量Wh（单位：千克），横截面最大宽度Wi（单位：米），行进速度V（单位：米每秒）；同时，为机器人预设行进路线，并以机器人的初始位置为坐标原点建立坐标系，令机器人的初始位置为O，预设行进路线的终点为P；步骤2：机器人根据预设行进路线行进，同时通过传感器实时检测障碍物，如果有障碍物，将机器人此时位置记为O1，并重新规划路线：步骤21：获取障碍物的轮廓，然后获取其轮廓的左侧的最外延的点的坐标A和右侧的最外延的点的坐标B；步骤22：以A为中心、以d1为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于S，则得到新路线1：直线O1S和直线SP；同样的，以B为中心、以d2为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于G，则得到新路线2：直线O1G和直线GP；d1和d2为预设的偏移量，其设置是与重量Wh，横截面最大宽度Wi，行进速度V等要素有关，可采用多次实验获得，也可由理论推导获得；步骤23：分别将预设行进路线与新路线1和新路线2比较，得到最接近预设行进路线的路线作为输出路线，如果新路线1更为接近预设行进路线，则将新路线1作为输出路线，如果新路线2更为接近预设行进路线，则将新路线2作为输出路线；步骤3：转动机器人的朝向，使其根据步骤2的输出路线继续前进；步骤4：机器人行进的同时通过传感器实时检测障碍物，如果有障碍物，则重复步骤2和步骤3，直到到达终点位置。进一步的，所述步骤22中，d1和d2为预设的偏移量，一般的，d1和d2的范围为[(Wi/2-k*Wh/250V),Wi]，k为权衡系数，k的取值范围为[0,1]。该范围是根据重量Wh，横截面最大宽度Wi，行进速度V以及仿真实验获得，在实验时，首先对一具有标准条件的机器人建模得到标准值，然后再采用仿真软件对各种不同重量不同速度的机器人进行仿真，获得上述范围值。一般的，可将d1和d2简单的设置为：d1=Wi/2，d2=Wi/2。进一步的，为了消除机器人的运动轨迹的断点，使其运动轨迹变得光滑，步骤23还包括对输出的输出路线进行处理的步骤：具体是对输出路线的交点位置处的线段进行圆弧化处理，方便机器人转向并继续前行。现有技术中一般采用较为复杂的算法，使得机器人难以推广和普及，本专利技术通过上述方案，大大简化了避障算法，其通过获取障碍物的轮廓，然后获取其轮廓的最外延的点的坐标，并在最外延的点的基础上增设偏移量，来规划新的路线，从而使得不论什么参数的机器人均可做到完全躲避障碍物。本专利技术的方案简单易于实现和推广，具有很好的实用价值。附图说明图1为本专利技术的思路的原理示意图；图2为本专利技术的算法的实现原理示意图。具体实施方式现结合附图和具体实施方式对本专利技术进一步说明。参见图1，以机器人的初始位置为坐标原点建立坐标系（可以是三维的或者二维的，本实施例中简单起见，以二维为例），令机器人的初始位置为O(0,0)，预设行进路线的终点为P(x,y)；图示中，起点和终点之间有一障碍物，障碍物的轮廓的左边突出点为A，右边为B，如果机器人直接以OA+AP（或者OB+BP）为路线，则很容易会撞到障碍物的边沿，本专利技术考虑到机器人的自身参数，综合考量，对其进行改进，解决这一问题。作为一个具体的实施例，参见图2，本专利技术的一种机器人避障方法，包括如下步骤：步骤1：采集机器人的参数：重量Wh（单位：千克），横截面最大宽度Wi（单位：米），行进速度V（单位：米每秒）；同时，为机器人预设行进路线，并以机器人的初始位置为坐标原点建立坐标系（可以是三维的或者二维的，本实施例中简单起见，以二维为例），令机器人的初始位置为O(0,0)，预设行进路线的终点为P(x,y)；其中机器人的安全距离与机器人的体型有关，为了简化计算，将机器人的横截面简化为一圆或者椭圆，这样，机器人的安全距离与横截面最大宽度Wi有关；步骤2：机器人根据预设行进路线行进，同时通过传感器实时检测障碍物，如果检测到障碍物，将机器人此时位置记为O1，并重新规划路线：步骤21：获取障碍物的轮廓，然后获取其轮廓的左侧的最外延的点的坐标A和右侧的最外延的点的坐标B；步骤22：以A为中心、以d1为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于S，则得到新路线1：直线O1S和直线SP；同样的，以B为中心、以d2为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于G，则得到新路线2：直线O1G和直线GP；本专利技术的每次行进路线都向终点P靠拢，可减少到达目的地的代价；步骤23：分别将预设行进路线与新路线1和新路线2比较，得到最接近预设行进路线的路线作为输出路线，如果新路线1更为接近预设行进路线，则将新路线1作为输出路线，如果新路线2更为接近预设行进路线，则将新路线2作为输出路线；本实施例中，新路线2更为接近预设行进路线，则输出路线为新路线2；如果有多个障碍物，每次选取其边界的最外延的点为中心画圆，并根据切线来作为新路线，同时还将多个新路线与预设行进路线进行比较，来获取最佳的输出路线。其中将新路线与预设行进路线进行比较，可以是简单的根据其路径长短来比较，也可以根据路线的图形进行比对；步骤3：转动机器人的朝向，使其根据步骤2的输出路线继续前进；步骤4：机器人行进的同时通过传感器实时检测障碍物，如果有障碍物，则重复步骤2和步骤3，直到到达本文档来自技高网...

【技术保护点】
一种机器人避障方法，包括如下步骤：步骤1：采集机器人的参数：重量Wh，横截面最大宽度Wi，行进速度V；同时，为机器人预设行进路线，并以机器人的初始位置为坐标原点建立坐标系，令机器人的初始位置为O，预设行进路线的终点为P；步骤2：机器人根据预设行进路线行进，同时通过传感器实时检测障碍物，如果检测到障碍物，将机器人此时位置记为O1，并重新规划路线：步骤21：获取障碍物的轮廓，然后获取其轮廓的左侧的最外延的点的坐标A和右侧的最外延的点的坐标B；步骤22：以A为中心、以d1为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于S，则得到新路线1：直线O1S和直线SP；同样的，以B为中心、以d2为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于G，则得到新路线2：直线O1G和直线GP；d1和d2为预设的偏移量；步骤23：分别将预设行进路线与新路线1和新路线2比较，得到最接近预设行进路线的路线作为输出路线，如果新路线1更为接近预设行进路线，则将新路线1作为输出路线，如果新路线2更为接近预设行进路线，则将新路线2作为输出路线；步骤3：转动机器人的朝向，使其根据步骤2的输出路线继续前进；步骤4：机器人行进的同时通过传感器实时检测障碍物，如果有障碍物，则重复步骤2和步骤3，直到到达终点位置。...

【技术特征摘要】
1.一种机器人避障方法，包括如下步骤：步骤1：采集机器人的参数：重量Wh，横截面最大宽度Wi，行进速度V；同时，为机器人预设行进路线，并以机器人的初始位置为坐标原点建立坐标系，令机器人的初始位置为O，预设行进路线的终点为P；步骤2：机器人根据预设行进路线行进，同时通过传感器实时检测障碍物，如果检测到障碍物，将机器人此时位置记为O1，并重新规划路线：步骤21：获取障碍物的轮廓，然后获取其轮廓的左侧的最外延的点的坐标A和右侧的最外延的点的坐标B；步骤22：以A为中心、以d1为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于S，则得到新路线1：直线O1S和直线SP；同样的，以B为中心、以d2为半径得到一圆，分别以O1和P为起点画出与该圆的两条切线，两条切线相交于G，则得到新路线2：直线O1G和直线GP；d1和d2为预设的偏移量；步骤23：分别将预设行进路线与...

【专利技术属性】
技术研发人员：梁爽，
申请(专利权)人：深圳市金佰科创发展有限公司，
类型：发明
国别省市：广东;44