基于启发式采样算法的二自由度机械臂轨迹规划

针对传统的采样类轨迹规划算法存在随机性、计算效率低等问题,根据机械臂运动学约束,给出关于关节空间的启发式采样轨迹规划算法。采用拉格朗日法建立二自由度机械臂的动力学模型,以角加速度为采样对象,通过积分器采集角速度与角度位移进行转矩的实时检测,结合启发式采样算法,实现给定目标位姿的轨迹自动规划;且对机械臂两关节在不同负载下的运动位置、速度在MATLAB中进行仿真,并与传统的B-spline轨迹规划方法比较。结果表明,启发式采样算法可实现不同负载下给定目标位姿路径的自动规划,且在时效性及路径规划上具有优越性。