一种空间绳系机器人三轴主动姿态控制方法技术

技术编号:10437176 阅读:149 留言:0更新日期:2014-09-17 13:44
本发明专利技术提出了一种空间绳系机器人三轴主动姿态控制方法,根据空间绳系机器人的轨道动力学特性计算空间绳系机器人在平衡状态空间系绳应具有的标称张力,根据空间绳系机器人姿态运动学与动力学方程确定控制力矩变量,建立空间绳系机器人姿态动力学的状态方程和输出方程并根据反馈线性化控制规律计算出三个方向的姿态控制力矩,根据控制力矩与空间系绳连接点位置、反作用轮转速之间的关系得出相应的空间系绳连接点位置及反作用轮的转动角速度。该方法根据目标的姿态利用空间系绳及反作用轮对空间绳系机器人的姿态实施三轴姿态协调控制,适用于空间绳系机器人位于空间平台与地心连线时对空间绳系机器人的三轴姿态控制。

【技术实现步骤摘要】

【技术保护点】
一种空间绳系机器人三轴主动姿态控制方法,其特征在于:采用以下步骤:步骤1:计算空间绳系机器人三个方向的姿态控制力矩ux、uy及uz:ux=-Ix(-IrIyx7x4+(1-nx)Ωx6-nxΩ2x1+IrIxΩx7)+vxuy=-Iy(IrIyx7x2-IrIyΩx7x5)+vyuz=-Iz((nz-1)Ωx2-nzΩ2x5+tanx3cosx1Izux-tanx1Izuy)+vz]]>其中x1=φ、x3=θ、x5=ψ、x7=Ωr,φ、θ及ψ为空间绳系机器人的三轴姿态角,Ix、Iy、Iz分别为空间绳系机器人转动惯量,Ωr为反作用轮转动角速度,Ir为反作用轮的转动惯量,nx和nz为系数,Ω为空间绳系机器人的轨道角速度,vx=φ··d-k1(φ-φd)-k2(φ·-φ·d),vy=θ··d-k3(θ-θd)-k4(θ·-θ·d)]]>及vz=ψ··d-k5(ψ-ψd)-k6(ψ·-ψ·d),]]>φd、θd及ψd分别为空间绳系机器人的指令滚转角、指令俯仰角及指令偏航角,k1、k2、k3、k4、k5及k6为正值常数;步骤2:根据步骤1得到的空间绳系机器人三个方向的姿态控制力矩ux、uy及uz,由公式Mx=ux+Mdx=-sinφcosθTzL+cosφcosθTyL+MdxMy=uy+Mdy=-sinθTzL-cosφcosθTxL+MdyMz=-IrΩ·r+tanθcosφux-tanφuy+MdzT=T0-mrl··l··=|(-cosφcosθyL+sinφcosθzL)φ··+(cosθxL+sinφsinθyL+cosφsinθzL)θ··+sinθx··L-sinφcosθy··L+(-sinθxL+sinφcosθyL+cosφcosθzL)θ·2+(sinφcosθyL+cosφcosθzL)φ·2+2cosθθ·x·L-2cosφcosθy·Lφ·+(2cosφsinθyL-2sinφsinθzL+2sinφsinθ)φ·θ·+2sinφsinθy·Lθ·|]]>得到空间系绳连接点位置xL、yL及反作用轮的转动角速度Ωr实现空间绳系机器人三轴姿态的主动控制;其中Mdx、Mdy和Mdz分别为空间绳系机器人三个轴向的干扰力矩,Mx、My和Mz为空间绳系机器人所受到的力矩,T为空间系绳上的张力,T0为空间绳系机器人在平衡状态时,空间系绳应具有的标称张力,T0=3Ω2mrlmr空间绳系机器人的质量,l为空间系绳的长度;所述平衡状态指空间绳系机器人位于空间平台与地心连线上。...

【技术特征摘要】

【专利技术属性】
技术研发人员:黄攀峰王东科袁建平孟中杰徐秀栋
申请(专利权)人:西北工业大学
类型:发明
国别省市:陕西;61

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1