[发明专利]一种自主运行机器人色差导航控制方法

权利要求书

1.一种自主运行机器人色差导航控制方法，其特征在于，所述的自主运行机器人色差导航控制方法包括以下步骤：

第一步，导航线路预制，根据机器人运行作业需要，首先在机器人运行场地的地面中规划出所有的机器人运行路线，然后在各条机器人运行路线对应的场地地板内嵌入若干多色照明灯，并使每条运行路线内的多色照明灯颜色相同，不同运行路线内多色照明灯颜色不同，同时每条运行路线中，相邻的两个多色照明灯间距为10—50厘米；相邻两条运行路线间的多色照明灯间距不小于20厘米，且各多色照明灯光轴均与场地地板垂直分布；

第二步，机器人运行节点配置，在完成第一步作业后，从根据机器人各运行路线中，均布至少两个到位传感器，且各到位传感器均嵌于场地地板内并与多色照明灯分布在同一直线方向上；

第三步，机器人配置，为机器人底盘正下方和底盘前侧面上分别配备光敏传感器、颜色识别装置，且底盘正下方和底盘前侧面的光敏传感器、颜色识别装置均分布在机器人机身轴线方向上；

第四步，机器人定位运行，在完成第三步作业后，将机器人转运至运行场地内，并使机器人的光敏传感器、颜色识别装置与运行路线的多色照明灯进行对应，使得机器人光敏传感器、颜色识别装置与多色照明灯光轴同轴分布，然后在机器人运行时，首先根据使用选定机器人运行路线，然后点亮相应路线上的多色照明灯，并使各运行路线上的照明灯颜色各不相同，然后有机器人上的光敏传感器对多色照明灯位置进行定位，由颜色识别装置对运行线路上各颜色的多色照明灯进行识别，并使机器人在特定颜色灯光指引下进行运行作业，在机器人运行过程中，另通过到位传感器对该运行线路上机器人通过各到位传感器点位置和时间精度进行检测，并对机器人运行轨迹进行辅助修正；所述的第一步中同一运行线路中的各多色照明灯均相互并联，所述的多色照明灯和到位传感器均沿着各运行线路中线分布，所述的第二步的光敏传感器、颜色识别装置中，一个光敏传感器和一个颜色识别装置构成一个检测组，其中位于底盘前侧面检测组的轴线与水平面呈15°—90°夹角，所述的第四步中，在进行机器人通过各到位传感器点时间精度进行检测时，首先统计机器人运行速度，然后根据相邻两个到位传感器间运行路线长度计算出机器人理论通过两个到位传感器的时间，然后将机器人实际通过相邻两个到位传感器的时间与计算时间对比获得机器人通过到位传感器点时间的精度，并以此判定机器人在运行线路中运行状态和运行轨迹的稳定性。