一种基于斥力势场的多机器人调度方法与流程

文档序号:11827384阅读:来源:国知局

技术特征:

1.一种基于斥力势场的多机器人调度方法,包括以下步骤:

a. 机器人使用室内基站得到绝对坐标,将绝对坐标发送到调度系统。

b. 调度系统计算两两机器人之间的距离。

c. 根据距离计算出两两机器人之间的斥力,距离越近斥力越强,反之越弱。

d. 将每一对斥力发送给相关的两台机器人。

e. 机器人收到一组斥力,分别是与其他每一台机器人的斥力,取方向为两两机器人相互排斥的方向得到斥力向量,计算出斥力向量的合力得到总斥力向量。

f. 机器人根据路径规划出的路线,取沿路径行走的向量作为原始驱动力向量。

g. 将原始驱动力向量和斥力的合力向量求和得到最终驱动力向量。

h. 将此最终驱动力向量作为机器人的运动控制输入。

i. 机器人两行动轮采用PID控制器控制,接收上述的最终驱动力向量作为输入,计算出电机应有的输入电压。

j. 将控制电压发送给电机驱动芯片,实现机器人的运动。

2.一种如权利要求1所述的基于斥力势场的多机器人调度方法,其特征进一步在于:步骤a中,每台机器人使用室内基站,结合GPS定位方法,定位出机器人的当前坐标,当前坐标即为绝对坐标。

3.一种如权利要求1所述的基于斥力势场的多机器人调度方法,其特征进一步在于:步骤c中,斥力的大小根据公式force = -0.3*log((distance-0.8)/2)计算,其中distance表示两两机器人之间的距离,force表示斥力。

4.一种如权利要求1所述的基于斥力势场的多机器人调度方法,其特征进一步在于:,步骤f中,路径规划方法为:每台机器人的行走路径在图上使用单源最短路径方法,得出自身的行走路径最优解。

5.一种如权利要求4所述的基于斥力势场的多机器人调度方法,其特征进一步在于:地图采用关键点与关键点之间的连线表示。关键点与关键点的连线以“图”为数据结构。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1