扩张状态观测器下的FFSR末端轨迹跟踪控制

简介

针对传统空间机器人控制方法需要测量角速度信息的问题,提出一种基于扩张状态观测器的优化控制方法,实现不确定条件下自由漂浮空间机器人(Free-Floating Space Robot,FFSR)末端轨迹跟踪控制。首先,在FFSR名义模型的基础上,考虑参数不精确以及外部扰动因素,建立更符合实际工程的FFSR模型;而后,通过增广变量方法将FFSR模型转化成状态空间表达形式,并基于此设计扩张状态观测器,对状态变量以及不确定项进行在线估计;进而,将观测器的输出作为控制器的输入,提出一种基于状态依赖黎卡提方程(State-Dependent Riccati Equation,SDRE)的优化控制方法;最后,在Matlab/Simulink平台上对所提控制方法进行数值仿真。结果表明所设计的状态观测器能有效观测FFSR关节角的角速度以及末端抓手位置信息,且通过所设计的优化控制器能够实现机械臂末端的精确跟踪控制。