Fault tolerant motion planning method for obstacle avoidance of mobile manipulator

2016 
The invention provides a fault tolerant motion planning method for obstacle avoidance of a mobile manipulator. The method includes the following steps that (1) a joint or a driving wheel which is locked due to faults is determined, a uniform redundancy analysis scheme for secondary planning is built for the mobile manipulator, and the minimum performance index designed in the analysis scheme is a quadratic function of a joint velocity vector of a mobile platform and the mobile manipulator; (2) the uniform coordinated redundancy analysis scheme for secondary planning is solved by using a secondary planning solver; and (3) a solving result is transmitted to a lower computer controller, and the mobile platform and the mobile manipulator are driven to complete a given tail end task cooperatively at the same time. Due to uniform description and planning of the mobile platform and the mobile manipulator, as long as the serial number and the locking angle of the joint or the driving wheel which is locked due to faults are known, automatic fault tolerant processing can be conducted; the mobile platform of the mobile manipulator and the mobile manipulator are controlled to move cooperatively at the same time, obstacles can be avoided, and the given tail end task is completed.
    • Correction
    • Source
    • Cite
    • Save
    • Machine Reading By IdeaReader
    0
    References
    0
    Citations
    NaN
    KQI
    []