在参数三次样条运动规划方法的实现中定义了如下C结构体来描述两个型值点之间的三次样条曲线:
由于在三次样条曲线的构造过程中,要求解,t+1维线性方程组来确定各段三次样条的系数,这个过程中包含大量的浮点运算,使算法的实时性难以得到保证。因此,在三次样条曲线运动规划方法实现中,应该引入了一个三次样条运动规划预处理指令,通过该指令,把计算量较大、实时性要求不高的工作,如计算出各轴的三次曲线参数方程的系数及三次样条的长度等放在预处理阶段完成。当预处理结束时,才开始三次样条曲线的实时插补,参数化三次样条实时插补算法流程如图1。在非实时仿真环境下对表1给出的型值点对应的C样条曲线进行了规划测试,参数配置如下:amax=1000m/s2;v=150mm/min;vmax=6000mm/min;cycleTime=0.002s。其中,amax为最大加速度,、为指定的编程速度,vmax系统的轴最大速度,cycleTime为插补周期。
由测试可知(曲线图略,可以根据值点列表对应得出),基于样条曲线的运动规划方法也可以在数控的运动控制器中实现。