一种浮动底座机器人的机械臂稳定轨迹规划方法及系统

本发明适用于机器人领域，尤其涉及一种浮动底座机器人的机械臂稳定轨迹规划方法及系统。本发明通过建立机械臂运动学模型；根据机械臂运动学模型获取机械臂每一关节的起始位姿，并设置目标点位姿；根据起始位姿以及目标点位姿通过逆运动学求解器进行逆运动学迭代求解，计算得到目标关节配置；根据起始位姿和目标关节配置通过线性插值法进行计算，得到机械臂的运动轨迹；对运动轨迹中每一插值点的机械臂质心位置进行计算，得到每一插值点对应的机械臂质心坐标；根据机械臂质心坐标通过预设方法进行迭代优化，得到最优运动轨迹。有效地控制了浮动底座机器人的运动轨迹，最大限度地减小了质心的变化，提高了机器人在输电线上的操作效率和稳定性。