机器人前速度前瞻控制算法

机器人的前瞻控制算法，将机器人的行走轨迹进行拟合并将其离散成小段，根据弓高误差约束，采用直线圆弧的平滑拼接策略获得机器人用于前瞻的平滑轨迹。

根据曲率及最大进给速度、末端各轴最大加速度和加加速度获得各段曲线的最大速度约束条件，为了确定机器人最终速度，采用双向扫描的前瞻策略对各段衔接点速度进行调整，最后采用S型曲线规划速度曲线，采用反向插值算法，得到机器人末端各轴实时位置，以此完成前瞻速度规划，获得约束条件下加工时间最短的机器人加工轨迹。

ID:43385