基于避障伪距离的自由漂浮空间机器人规划跟踪一体化控制

针对自由漂浮空间机器人(Free Floating Space Robot,FFSR)的避障规划与控制问题，提出一种FFSR的避障规划-跟踪一体化控制方法。首先，基于障碍物伪距离技术，采用FFSR逆几何模型求解期望末端位姿下的连杆伪距离估计值，进而通过求解非线性优化问题，获得FFSR避障期望轨迹。其次，将全局轨迹规划与局部在线避障相结合，辅以离散状态黎卡提方程（DSDRE）控制方法实现FFSR的避障规划-跟踪一体化控制。最后，采用6R空间机器人模型验证了所提方法的有效性。仿真结果表明，该方法能够实现FFSR的避障控制，有效克服了传统FFSR控制中末端轨迹规划与控制相分离的问题，提高了FFSR的环境适应性。     

一种改进阻尼倒数的空间机器人避奇异算法

针对自由漂浮空间机器人运动规划过程中存在的动力学奇异问题,提出一种动力学奇异转化加改进阻尼倒数的奇异回避算法。首先,通过运动学分解,间接求解机器人逆运动学方程,避免直接求解逆广义雅可比矩阵,以实现奇异参数的分离;然后,采用改进的高斯分布阻尼因子的阻尼倒数代替奇异参数的普通倒数,回避运动学奇异的影响。与现有阻尼倒数方法相比,提高了算法在奇异点附近的连续性,进一步减小了算法带来的跟踪误差。在PUMA类型空间机器人模型上进行仿真试验,校验算法的有效性。     

自由漂浮空间机器人末端轨迹优化跟踪控制

针对自由漂浮空间机器人(FFSR)末端轨迹跟踪优化控制中惯性参数不确定的问题,基于状态依赖Riccati方程（SDRE）,提出一种采用标称SDRE控制器与补偿SDRE控制器相结合的组合优化控制器,通过SDRE基本理论及李雅普诺夫方法证明了控制方法能够实现系统跟踪的能量优化和渐近稳定,实现了FFSR在广义雅克比矩阵非奇异条件下的末端轨迹优化跟踪控制。数值仿真表明,控制器能够实现对于期望末端轨迹的有效跟踪。     

自由漂浮空间机器人点到点避奇异运动控制方法

针对具有冗余机械臂的自由漂浮空间机器人（Free Floating Space Robot, FFSR）点到点避免奇异性规划和控制问题,提出了一种冗余FFSR的点到点避免奇异控制方法。首先,该方法基于离散状态依赖李卡提方程（DSDRE）控制器设计方法,利用FFSR的动力学和运动学方程实现了FFSR系统方程的伪线性重构;然后,基于伪线性重构系统及DSDRE状态调节器设计方法实现了FFSR的关节角速度和末端位姿的同时跟踪控制;其次,根据跟踪控制器对FFSR广义雅克比矩阵（GJM）行满秩的设计要求,定义FFSR的奇异性判别依据,构造了避奇异约束函数;再次,由于冗余FFSR系统具有多逆运动学解特点,考虑关节角及关节角速度约束,结合避奇异约束函数设计了FFSR的期望轨迹在线规划器,进一步将设计的跟踪控制器与规划器相结合提出了冗余FFSR末端点到点避奇异运动控制方法。最后,为验证所提方法的有效性同时考虑简化计算,采用平面4连杆FFSR模型进行数值仿真,仿真结果表明所提点到点避奇异运动控制方法能够有效实现冗余FFSR系统的点到点避奇异运动。