摘要
为提高举高消防车作业的及时性、可靠性与安全性,提出一种考虑动作平稳、无冲击的时间最优轨迹规划算法。引入伪位移参量s表示路径,利用B样条曲线对举高消防车臂架系统各个关节运动离散点进行拟合,构造连续运动几何路径。结合连续路径,以s及其对于时间的各阶导数表示时间最优目标函数与各个关节速度、加速度约束,建立时间最优轨迹规划的凸优化模型。利用B样条曲线以有限维矢量x表示轨迹,采用内点法对凸优化模型进行求解,在保证速度、加速度、加加速度连续的条件下求得最优解,进而得到各个关节的运动轨迹。利用提出的方法对大高度举高消防车进行轨迹规划,经仿真表明,在满足动作平稳性的同时得到时间最优运动轨迹。
- 单位