导航

ACTA AERONAUTICAET ASTRONAUTICA SINICA ›› 2018, Vol. 39 ›› Issue (9): 422040-422050.doi: 10.7527/S1000-6893.2018.22040

• Material Engineering and Mechanical Manufacturing • Previous Articles    

Control method of point-to-point singularity avoidance for free floating space robot

YANG Fan1, ZHANG Guoliang2, ZHANG Hexin1, SONG Haitao1   

  1. 1. College of Missile Engineering, Rocket Force University of Engineering, Xi'an 710025, China;
    2. School of Control Engineering, Chengdu University of Information Technology, Chengdu 610225, China
  • Received:2018-01-23 Revised:2018-02-26 Online:2018-09-15 Published:2018-04-26

Abstract: A point-to-point singularity avoidance control method for the Free Floating Space Robot (FFSR) with the redundant manipulator is proposed in this paper. According to the Discrete State Dependent Riccati Equation (DSDRE) based controller design method, pseudo linear reconstruction of the FFSR system equation is realized by using the dynamic and kinematic equations for FFSR. Then, based on the pseudo linear equations and DSDRE state regulator design method, the tracking control of the joint angular velocity and effector's trajectory is realized. According to the requirements for full row rank of the Generalized Jacobian Matrix (GJM) in controller design, the singularity discrimination basis of FFSR is defined and the singular constraint function is constructed. Due to the characteristic of multi-inverse kinematics solutions for redundant FFSR systems, considering the constraints of joint angle and angular velocity, an online planner for FFSR's desired trajectory is designed with the constraint functions for singularity avoidance. A control method for point-to-point singularity avoidance is finally proposed by combining the designed tracking controller with the planner. To verify the effectiveness of the proposed method and simplify the computation, the planar 4-link FFSR model is used for numerical simulation. The simulation results show that the proposed method for point-to-point avoidance singularity control can effectively realize the avoidance of point-to-point singularity of redundant FFSR systems.

Key words: free floating space robot, point-to-point motion control, Discrete State Dependent Riccati Equation (DSDRE), avoidance singularity planning, redundant manipulator

CLC Number: