采用四个麦克纳姆轮的机器人自动回充方法技术

本发明专利技术公开了采用四个麦克纳姆轮的机器人自动回充方法，包括：在充电座上设置多个信号发射器；利用红外检测机器人的麦克纳姆轮相对所述发射区域的位置；当机器人的处于充电座的发射区域时，计算机器人驱动的速度，并驱动机器人整体向充电座做一段直线运动。通过麦克纳姆轮底盘的运动控制，在机器人自动回充的运动过程中将机器人的运动简化为缩小垂直距离、调整中心偏差和调整角度偏差三个部分。有效避免了传统两轮差速的运动控制方式的复杂性和低效性。

Robot automatic backfilling method using four MC PM wheels

The invention discloses a robot automatic recharge method using four McNam wheels, including: setting a plurality of signal emitters on the charging seat; using infrared to detect the position of the McNam wheel relative to the launching area of the robot; and when the robot is in the launching area of the charging seat, the speed driven by the computer robot; And drive the robot to make a straight motion to the charging seat as a whole. Through the motion control of the McNam wheel chassis, the motion of the robot is simplified into three parts: reducing the vertical distance, adjusting the center deviation and adjusting the angle deviation. It effectively avoids the complexity and inefficiency of the traditional two wheel differential motion control mode.

【技术实现步骤摘要】
采用四个麦克纳姆轮的机器人自动回充方法
本专利技术涉及机器人的充电装置，尤其涉及采用四个麦克纳姆轮的机器人自动回充方法。
技术介绍
机器人的自动回充技术是通过充电基座持续地发出信号，然后由机器人机体上的接收器根据信号反馈来进行定位，从而实现机器人的全自主回充功能.传统方式中，机器人在自动回充的过程中根据红外信号的反馈不断调整机器人的运行状态，红外接收器在旋转扫描时，带着接收器方向标记一起旋转。当接到红外信号，红外接收器停止旋转，启动运动方向与红外扫描方向检测装置检测夹角，并根据一定算法判断夹角进行车身调整，控制移动和转向。当夹角减小到一定角度，小车停止转动和行进，完成第一个“方向调整”动作，然后启动红外接收器继续旋转扫描，直到接收器接收到下个红外信号，系统再次检测夹角，车体完成第二个“方向调整”动作，整个过程周而复始。在小车完成若干个“方向调整”动作后，方向夹角越来越小，小车行进速度也越来越快。当接收器检测到夹角为零，小车前进较长距离，然后接收器继续检测方向夹角是否错误，有错继续调整，无错则快速行进。由于常规底盘的运动算法只能通过差速调节车体的角度状态或实现左右偏移，每当机器人检测到车体与充电座的相对位置产生误差时，机器人都需要微调车体与充电座的相对位置。上述方案导致了车体在自动回充时运动效率太低，不利于机器人在低电压时快速、准确的返回充电座，实现自动回充功能。
技术实现思路
本专利技术的一个目的在于提出一种采用四个麦克纳姆轮的机器人自动回充方法，采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，包括：在充电座上设置多个信号发射器；利用红外检测机器人的麦克纳姆轮相对所述发射区域的位置；当机器人的处于充电座的发射区域时，计算机器人驱动的速度，并驱动机器人整体向充电座做一段直线运动。进一步地，将发射信号器的发射区域分为由上至下依次相邻的第一区域，第二区域，第三区域，第四区域；进一步地，当机器人处于第一区域或第四区域时，驱动所述机器人根据红外的反馈信号执行竖直平移，直至所述机器人的中心点与所述充电座的充电位置的中心点一致。进一步地，当机器人处于第二区域或第三区域时，驱动机器人整体向充电座做一段直线运动。进一步地，所述直线运动中，所述四个麦克纳姆轮的转速与机器人整体速度的关系为：其中，其中为ω为麦克纳姆轮的转速，v为机器人整体速度，θ为麦克纳姆轮与所述充电座平面的中心线的夹角，a为麦克纳姆轮的中心平面与所述充电座平面的平面偏置角。进一步地，检测机器人的位置平面与所述发射区域的平面的偏转夹角，当该偏转夹角为零度时，利用超声波传感的反馈信号调整自旋角度。通过麦克纳姆轮底盘的运动控制，在机器人自动回充的运动过程中将机器人的运动简化为缩小垂直距离、调整中心偏差和调整角度偏差三个部分。有效避免了传统两轮差速的运动控制方式的复杂性和低效性。附图说明图1是本专利技术优选实施例提供的的流程示意图；图2是本专利技术优选实施例提供的流程示意图；图3是本专利技术优选实施例提供的说明示意图。具体实施方式下面结合附图并通过具体实施方式来进一步说明本专利技术的技术方案。本专利技术的一个目的在于提出一种采用四个麦克纳姆轮的机器人自动回充方法，采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，包括：在充电座上设置多个信号发射器；利用红外检测机器人的麦克纳姆轮相对所述发射区域的位置；当机器人的处于充电座的发射区域时，计算机器人驱动的速度，并驱动机器人整体向充电座做一段直线运动。优选地，将发射信号器的发射区域分为由上至下依次相邻的第一区域，第二区域，第三区域，第四区域；优选地，当机器人处于第一区域或第四区域时，驱动所述机器人根据红外的反馈信号执行竖直平移，直至所述机器人的中心点与所述充电座的充电位置的中心点一致。优选地，当机器人处于第二区域或第三区域时，驱动机器人整体向充电座做一段直线运动。优选地，所述直线运动中，所述四个麦克纳姆轮的转速与机器人整体速度的关系为：其中，其中为ω为麦克纳姆轮的转速，v为机器人整体速度，θ为麦克纳姆轮与所述充电座平面的中心线的夹角，a为麦克纳姆轮的中心平面与所述充电座平面的平面偏置角。优选地，检测机器人的位置平面与所述发射区域的平面的偏转夹角，当该偏转夹角为零度时，利用超声波传感的反馈信号调整自旋角度。为了提高机器人自动回充时的运动效率，本设计提出了一种新型自动回充运动算法，4个麦卡纳姆车轮的速度分别为v1,v2,v3,v4,以轮2为例,对于轮2,由坐标系xC2OC2yC2可得到车轮轴心移动速度vOC2。由坐标系xSOSyS可得到车轮轴心移动速度vO2由式(1)、(2)得机器人逆运动学方程同理分析可得出四个轮子的转速与车体整体速度的关系为通过麦克纳姆轮底盘的运动控制，在机器人自动回充的运动过程中将机器人的运动简化为缩小垂直距离、调整中心偏差和调整角度偏差三个部分。有效避免了传统两轮差速的运动控制方式的复杂性和低效性。具体控制过程如下：当机器人完全处于充电座的发射面内时，机器人仅产生直线运动，缩短与充电座间的绝对距离。当机器人上的三个红外接收器中有任意一个无法接收到充电座上的红外发射信号时，机器人根据红外接收管的信号反馈，判断车体当前处于充电座红外信号覆盖区域的哪个位置，若处于Mid区域内时，车体直接向充电座运动，减小与充电座间的相对距离。当机器人上红外接收器与充电座上的红外发射器所在面不再平行时，机器人根据左右两侧的超声波传感器的反馈数据，调整机体的自旋角度，保证机体与充电座不存在角度偏差。当车体处于Left或Right区域时，车体根据红外反馈信号，直接左右平移，以保证车体中心与充电座中心一致。注意，上述仅为本专利技术的较佳实施例及所运用的技术原理。本领域技术人员会理解，本专利技术不限于这里所述的特定实施例，对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本专利技术的保护范围。因此，虽然通过以上实施例对本专利技术进行了较为详细的说明，但是本专利技术不仅仅限于以上实施例，在不脱离本专利技术构思的情况下，还可以包括更多其他等效实施例，而本专利技术的范围由所附的权利要求范围决定。本文档来自技高网...

【技术保护点】
1.采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，包括：在充电座上设置多个信号发射器；利用红外检测机器人的麦克纳姆轮相对所述发射区域的位置；当机器人的处于充电座的发射区域时，计算机器人驱动的速度，并驱动机器人整体向充电座做一段直线运动。

【技术特征摘要】
1.采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，包括：在充电座上设置多个信号发射器；利用红外检测机器人的麦克纳姆轮相对所述发射区域的位置；当机器人的处于充电座的发射区域时，计算机器人驱动的速度，并驱动机器人整体向充电座做一段直线运动。2.根据权利要求1所述的采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，将发射信号器的发射区域分为由上至下依次相邻的第一区域，第二区域，第三区域，第四区域。3.根据权利要求2所述的采用四个麦克纳姆轮的机器人自动回充方法，其特征在于，还包括：当机器人处于第一区域或第四区域时，驱动所述机器人根据红外的反馈信号执行竖直平移，直至所述机器人的中心点与所述充电座的充电位置的中心点一致。4.根据权利...

【专利技术属性】
技术研发人员：恽为民，杨超，庞作伟，
申请(专利权)人：上海未来伙伴机器人有限公司，未来伙伴机器人常州有限公司，
类型：发明
国别省市：上海,31