服务机器人导航路径跟踪方法及服务机器人

摘要

本发明公开了一种服务机器人导航路径跟踪方法和应用该方法的服务机器人，其中导航路径跟踪方法包括：1、获取服务机器人前方原始地面图像；获取机器人在图像坐标系下的位置和前进方向；2、检测导航路径上的特征点；判断该导航路径是否满足直线判断条件；3、如果满足，对检测的特征点做直线拟合得到导航直线路径；计算机器人与导航直线路径的距离d，前进方向与导航直线路径的夹角ω；4、如果不满足，对检测出的导航路径分段，检测最靠近机器人的子路径是否满足直线判断条件并按照步骤3来计算距离d和夹角ω；5、控制机器人前进方向，使d和ω减小；6、机器人不断前进，重复步骤2‑5，不断地跟踪导航路径。该方法在使用较低成本的设备下，能够得到较高精度的导航性能。