关键词:
多轴系统
关节空间显式动力学
轴不变量
模型预测控制
扩张状态观测器
摘要:
现有多轴航天器自由度高且有效载荷大,其动力学建模与控制存在建模复杂度高、实时性差和扰动下控制精度低的问题。本文以航天器多轴系统的典型代表空间机械臂为应用背景,首先提出多轴系统的关节空间显式动力学建模方法,实现动力学的自动建模和自动求解,以提高动力学建模效率并保证动力学模型在控制应用中的实时性;然后将所提出的动力学模型应用于关节驱动控制算法和空间机械臂动力学控制算法研究,以提高机械臂在模型误差扰动、未知外力扰动和关节力矩约束条件下的控制性能。论文主要内容如下:
首先,分析多轴航天器的设计需求并系统阐述多轴系统动力学建模的理论基础。基于轴不变量理论,实现多轴系统的数学化描述,并以此构建轴链有向Span树来描述系统的拓扑结构。通过建立自然坐标系,实现对多轴系统结构参数和动力学参数的描述,并以此建立运动学正向分层迭代公式。同时,为了解决传统动力学建模方法中偏导数计算导致的动力学模型无法完全参数化表达的问题,在运动学迭代公式基础上推导不同关节类型的偏速度显式表达式,并以此推导外力反向分层迭代公式。
其次,提出基于轴不变量的迭代式关节空间正动力学显式建模方法,实现动力学的自动建模和自动求解,以提高多轴系统动力学建模的效率和求解的实时性。该建模方法一方面可以实现系统拓扑、结构参数及动力学参数的完全参数化,且链符号具有伪代码功能,因此具有较高的建模效率,便于实际的工程应用;另一方面,该方法所得到的动力学方程具有迭代式的表达形式,具有较高的计算效率。与现有的显式正动力学建模方法相比,所提出的动力学建模方法具有更低的建模和计算复杂度。此外,动力学方程中矩阵的每个元素都有独立的显式表达式,可以利用分布式关节控制器并行计算的方式来进一步减少动力学的运算时间。同时,基于所提出的动力学模型搭建机械臂和火星车的仿真平台,通过与现有建模方法的仿真结果进行对比,来验证所提出动力学建模方法的正确性和实时性。
然后,以所提出的动力学模型为基础,提出基于动力学逆模补偿的双曲正切关节控制器,在满足关节输出约束的同时提高关节在非线性耦合外力和关节摩擦影响下的动态响应速度和跟踪精度。基于所提出的动力学方程提出关节正压力的显式表达式,并以此给出显含正压力的关节摩擦力模型和辨识方法,以提高关节摩擦力模型的建模效率和精度。同时,提出改进的驱动控制算法,以提高关节的动态响应速度和跟踪精度:提出一种改进的空间矢量脉宽调制算法,以减小由MOS管开关状态切换导致的时延和输出力矩的波动;通过设计高带宽电流环和补偿驱动电路死区降低系统时延,以提高控制器的动态性能;提出基于逆模补偿的双曲正切控制器,以保证关节输出的有界性和方向性,同时提高关节在非线性耦合惯性力、关节摩擦力和重力负载扰动下的响应速度和跟踪精度。
接着,通过所提出的正动力学模型进行状态预测,提出一种基于扩张状态观测器的鲁棒模型预测控制器,以提高空间机械臂在模型误差扰动、未知外力扰动和关节力矩约束条件下的轨迹跟踪精度。通过推导离散时间预测状态方程和改进预测参考轨迹,提出一种离散时间非线性模型预测控制器,以实现控制器在关节力矩约束条件下的最优控制输出。同时,提出一种基于动力学模型的非线性降阶扩张状态观测器,以增强控制器对模型误差扰动和未知外力扰动的抵抗能力。通过仿真实验验证所提出控制器在模型误差扰动、未知外力扰动和关节力矩约束条件下的位置和速度跟踪精度。
最后,设计并搭建机械臂地面测试平台,通过实验验证本文所提出的模型和控制算法的性能。根据分析的机械臂的需求进行机械臂关节的选型,对机械臂关节驱动器的各个组件进行改进设计并提出一种新颖的失电制动器结构。为了提高关节控制器性能,重新设计控制器软件和电路。为了提高关节的可靠性,对传统的失电制动器结构进行改进设计,提出永磁式失电制动器结构,并建立其电磁模型。同时,为了验证所提出的模型和控制算法的性能,进行以下实验:通过单关节实验平台测试永磁式失电制动器的制动性能、Ether CAT控制器的实时性和关节的位置、速度和力矩的跟踪精度;通过关节摩擦参数辨识实验得到关节摩擦模型,为机械臂控制实验奠定基础;通过机械臂动力学控制实验验证提出的逆模补偿器的力矩补偿精度、双曲正切控制器的关节位置跟踪精度以及机械臂的末端轨迹的跟踪精度。