Motion coordination control method for space dual-manipulator system

A dual manipulator, motion coordination technology, applied in manipulators, program-controlled manipulators, manufacturing tools, etc., can solve the problems of not taking into account the coordination relationship between the manipulator and the satellite body, and high tracking errors, and achieve high control accuracy and stability. The effect of fast tracking speed and high precision fast tracking

Active Publication Date: 2017-07-14
黑龙江省工研院资产经营管理有限公司
View PDF3 Cites 36 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0031] The purpose of the present invention is to solve the shortcoming that there is no space manipulator system for dual manipulators at present, and the existing space manipulator system does not take into ac

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Motion coordination control method for space dual-manipulator system
  • Motion coordination control method for space dual-manipulator system
  • Motion coordination control method for space dual-manipulator system

Examples

Experimental program
Comparison scheme
Effect test

specific Embodiment approach 1

[0148] Embodiment 1: In the weightless space environment, the kinematics and dynamics of the space manipulator are quite different from those of the ground manipulator. Therefore, it is necessary to re-establish the kinematics and dynamics equations of the space manipulator from the principles of mechanics. This patent uses the momentum conservation and Lagrangian equations of the space dual manipulator system to derive the kinematics equation and dynamics equation of the space dual manipulator system in the free flight state. Secondly, the trajectory planning problem of the space manipulator system is studied with the space dual manipulator system grasping a relatively stationary object as the goal. Through the point-to-point trajectory planning of the end of the manipulator, the motion trajectory of the manipulator is approximated by the quintic polynomial, the coefficients of the quintic polynomial are simplified by constraints, and the coefficients are iteratively solved by...

specific Embodiment approach 2

[0364] Specific implementation mode two: the difference between this implementation mode and specific implementation mode one is:

[0365] Step one specifically includes:

[0366] Step 11. Establish the kinematic equation of the space dual manipulator system according to the following formula:

[0367]

[0368] in, k represents the kth robotic arm, and k is 1 or 2;

[0369] is the mass of the i-th connecting rod of the k-th robotic arm; k i k means J i k The unit vector of the direction of rotation, J i k is the joint connecting the i-1th link and the i-th link in the kth robotic arm; p i k Indicates the joint J i k The position vector of ; Θ k is the joint angle vector of the kth robotic arm;

[0370] Step 12. Establish the dynamic equation of the space dual manipulator system according to the following formula:

[0371]

[0372] where M(q) is the generalized inertia tensor of the manipulator, is the nonlinear moment related to the manipulator and t...

specific Embodiment approach 3

[0374] Specific embodiment three: the difference between this embodiment and specific embodiment one or two is:

[0375] Step two specifically includes:

[0376] Step 21. Obtain the initial state of the end of the space manipulator final state and the desired state

[0377] Step 22. Assume that there exists t such that:

[0378]

[0379]

[0380] in, are the joint angle, angular velocity and angular acceleration of the kth robotic arm, respectively; and respectively The lower and upper limit values ​​of , and respectively the lower and upper limits of the and respectively The lower and upper limit values ​​of ; t 0 is the initial moment of trajectory planning, t f is the terminal moment of trajectory planning;

[0381] The joint function is parameterized using a quintic polynomial as follows:

[0382]

[0383]

[0384] is the parameter to be solved;

[0385] Step two and three, command Find the solution of the system of equation...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention relates to a motion coordination control method for a space dual-manipulator system, and belongs to the technical field of space manipulators. In order to overcome the defects that no space manipulator system specific to dual manipulators exists at present, the coordinated relation between a manipulator and a satellite body is not considered in an existing space manipulator system and tracking errors are high, the motion coordination control method for the space dual-manipulator system is provided. The motion coordination control method for the space dual-manipulator system includes the steps that a kinematical equation and kinetic equation of the space dual-manipulator system are established; the space dual-manipulator system is subjected to trajectory planning according to the initial postures and tail-end postures of the manipulators; and trajectories of the space dual-manipulator system are subjected to tracking control through a PD controller. The motion coordination control method for the space dual-manipulator system is suitable for a space manipulator control system.

Description

technical field [0001] The invention relates to a motion coordination control method for a space dual manipulator system, belonging to the technical field of space manipulators. Background technique [0002] The development of aerospace science and technology has greatly changed human life. The application field of space technology has been rapidly expanded in the past one or two decades. It also puts forward new requirements and tasks for space technology. Among them, the on-orbit operation of space targets and the rendezvous and docking technology are being widely valued by various countries due to their potential value in the military and civilian fields. [1] . Operate space cooperative / non-cooperative targets by using the space manipulator system, including on-orbit capture, component replacement, fuel filling, etc. Operations such as boosting and de-orbiting can greatly prolong the service life of satellites and greatly save the development cost of satellites, so they...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
IPC IPC(8): B25J9/00B25J9/16
Inventor 李传江陈亮名邱爽张米令杜晔孙延超
Owner 黑龙江省工研院资产经营管理有限公司
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products

Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic.

© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap