Udwadia-Kalaba方法在四足机器人单腿轨迹跟踪控制违约问题的应用

针对四足机器人由于初始条件与约束方程不相容和数值积分对低阶约束造成的违约的问题,提出了一种基于Udwadia-Kalaba方法以解决以上四足机器人单腿动力学违约问题的轨迹跟踪控制方法,该方法利用拉格朗日方程建立无约束的动力学方程,将系统的预定轨迹视为系统的约束关系,联系正运动学得到的末端位置建立约束方程.首先,对于初值违约问题,设置了各关节不为零的初角速度,基于Udwadia-Kalaba方法所进行的末端轨迹跟踪误差较大,利用Baumgarte稳定性方法以减小系统误差,并与PID控制下得到的末端轨迹进行对比,验证了对于修正初值违约问题,Baumgarte稳定性方法的优越性;接着,考虑数值积分对低阶约束造成的违约的问题,将其中一个约束轨迹设置为和时间有关的线性方程,利用Udwadia-Kalaba方法进行轨迹跟踪控制,发现其轨迹偏差较大,而后利用Baumgarte稳定性方法对末端轨迹进行修正,达到了使末端轨迹与轨迹规划贴合的目的.