[发明专利]一种机械臂逆解多解选择和时间最优轨迹规划算法

摘要

本发明涉及足式机器人机械臂领域，特别涉及一种机械臂逆解多解选择和时间最优轨迹规划算法。该算法可以根据当前的机械臂位姿迅速从逆解多解中选择最合适的一组解，有效规避奇异位型，实现不同逆解之间的平滑切换，保证机械臂控制和动作的连续性和不振荡；并利用七次多项式和条件比例控制相结合的轨迹规划方法规划出时间最优的轨迹，保证关节角度、角速度、角加速度、角加加速度的平滑连续可导，同时满足多目标多约束条件，满足执行器规范，含关节角速度最大值约束或关节角加速度最大值约束等。该算法大大减小了多解选择和轨迹规划的计算量，可以实现实时高效的时间最优轨迹规划，并可推广到低算力控制器上应用。