吸引势能:
$$U_{att}= \tfrac{1}{2}k_{att}\cdot d_{goal}^2$$排斥势能($d_{obs}\lt d_0$ 时):
$$U_{rep}= \tfrac{1}{2}k_{rep}\left(\frac{1}{d_{obs}}- \frac{1}{d_0}\right)^2$$合力:$\mathbf{F}= -\nabla(U_{att}+ \sum U_{rep})$
在吸引排斥势能复合场中实时计算机器人(点质量)的路径。具有势能彩色图、局部极小值检测、简易RRT比较功能。
吸引势能:
$$U_{att}= \tfrac{1}{2}k_{att}\cdot d_{goal}^2$$排斥势能($d_{obs}\lt d_0$ 时):
$$U_{rep}= \tfrac{1}{2}k_{rep}\left(\frac{1}{d_{obs}}- \frac{1}{d_0}\right)^2$$合力:$\mathbf{F}= -\nabla(U_{att}+ \sum U_{rep})$
自主搬运机器人(AGV/AMR):在工厂或仓库中,把人、其他机器人和货架当作障碍物,实时规划货物搬运路径。计算量小的优点让机载计算机也能快速更新路径。
无人机自动飞行:绕过建筑物和电线等固定障碍物,飞往指定地点。可将风等外力虚拟地作为排斥力加入模型。
机械臂轨迹规划:避免机械臂自身或被持物与环境或其他机器碰撞,规划光滑轨道。
空间碎片避撞轨道初期设计:在航天器轨道规划中,把碎片当作排斥源定义势能场,快速筛选安全轨道候选。最后用精确轨道力学模型验证。
首先,别以为"系数越大性能越好"。例如,排斥系数$k_{rep}$ 过大会使障碍物周围的斥力"山"太陡峭,机器人会振动或无法通过狭窄通道。同样,吸引系数$k_{att}$ 过强会强行通过障碍物附近,提高碰撞风险。平衡最重要,比如宽敞通道可从$k_{att}=1.0, k_{rep}=0.5$开始,狭窄通道则减小排斥影响范围$d_0$等根据情况调节。
其次,别误会"计算快就能轻易实时更新"。虽然单步计算确实快,但机器人陷入局部极小值会进入"无限循环"。实装时必须设定最大步数,或机器人不动时加入小的随机扰动等安全机制。
最后,本模拟器用的"点质量"模型过于理想化。实机有大小和形状。例如规划60cm宽搬运机器人时,应把机器人半径加上障碍物半径视为"膨胀障碍物"。在模拟器中把障碍物设大来试验,能直观体会这种思路。
5m×5m工作空间中,从初始位置(0.5, 0.5)到目标(4.5, 4.5)的路径规划。配置3个障碍物(半径0.3m),设置katt=5.0、krep=20.0、d0=1.2m、sx=0.1m/step时,路径长度6.8m、迭代次数340次、计算时间2.3ms,无局部极小值。势能分布彩色图可视化等势能线,显示吸引场(蓝色)与排斥场(红色)的相互作用