摘要
一种绳索牵引飞行机器人抗扰动控制方法,包括:1、推算移行机构期望轨迹和机械臂关节角、无人机平台中心期望轨迹和移行机构初始位置;2、计算机械臂运动对无人机平台带来的扰动力和扰动力矩,并计算绳索引起的扰动力和扰动力矩,得到总扰动方程;3、建立飞行机器人系统的动力学方程,进行解耦设计,得到解耦后的动力学方程,并得到旋翼升力、旋翼力矩、俯仰角期望值和横滚角期望值的计算公式;4、构建系统状态误差动力学方程,解算出飞行机器人旋翼升力和旋翼力矩;5、设计旋翼转速分配矩阵,根据旋翼升力、旋翼力矩以及旋翼转速分配矩阵计算旋翼转速,实现飞行机器人抗扰动运行。本发明解决了飞行机器人工作过程中的平稳性和安全性问题。
技术关键词
无人机平台
飞行机器人系统
扰动控制方法
移行机构
坐标系
机械臂关节
方程
力矩
姿态控制子系统
姿态环
升力
轨迹
飞行机器人控制系统
八旋翼飞行机器人
矩阵
机体
姿态角速度