伺服约束控制中基于广义虚位移分解的约束违约抑制

基于Udwadia和Kalaba方程的伺服约束控制理论可以较好地应用在机械系统的轨迹跟踪控制中。在伺服约束控制中,对约束系统动力学模型的数值积分过程会产生对低阶约束的违约,同时还存在初始值不相容引起的控制偏差甚至系统不稳定问题。利用系统广义质量矩阵的乔利斯基分解,将描述系统的广义虚位移向量经过变换,在约束流形上分解为约束方向与约束允许方向,从而分离出速率约束及坐标约束违约部分,在此基础上推导出修正公式。以二自由度机械臂为仿真对象,在伺服约束轨迹控制中的应用进行了仿真研究。结果表明,基于虚位移分解的方法可以对伺服控制中的约束违约进行抑制,同时也可以解决系统初始条件不相容引起的问题。