A motion trajectory planning method for a robotic arm servo-rolling satellite docking ring
A technology of motion trajectory and manipulator, which is applied in the direction of manipulator, program control manipulator, manufacturing tools, etc., which can solve problems such as inability to lock, drift of the end track of the manipulator, and inability to complete the workspace of the servo manipulator within the specified time, etc.
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
specific Embodiment approach 1
[0027] Embodiment 1: Combining Figure 1-2 The specific process of a motion trajectory planning method for a robotic arm servo rollover satellite docking ring in this embodiment is as follows:
[0028] Step 1: Obtain the pose matrix of the robot arm base system relative to the end tool system according to the joint angle information fed back by the robot arm joint position sensor in real time e T b ;The joint coordinate system of the manipulator is such as figure 1 The corresponding DH parameter table is shown in Table 1;
[0029]
[0030] Among them, θ is the vector of 7 joint angles, and l is the length parameter of the manipulator link, which is the link offset d i the value of , b T 0 is a constant matrix, e T b Represents the pose matrix from the robot arm base system to the end tool system, e is the end tool system, b is the robot arm base system, e n b , e o b , e a b respectively represent the unit vector of the base system under the end system, e n ...
Embodiment
[0097] For the effectiveness of the present invention, the following combination image 3 The technical solution of the present invention is further described with reference to FIG. 6, using computer simulation.
[0098] Build a computer simulation platform and start the servo. The specific implementation steps are as follows image 3 As shown, do the following operations in each planning cycle:
[0099] [Step S1] Calculate based on joint angle feedback e T b ;
[0100] [Step S2] Calculate based on joint angle feedback e T g ;
[0101] [Step S3] The radius of the target docking ring is 813.25mm, the new capture point is reconstructed, and the calculated e T g_ ;
[0102] [Step S4] From e T g_ Solve the new pose feedback [d_, γ_];
[0103] [Step S5] Determine whether to enter the servo for the first time, if it is the first time to enter the servo, record the initial posture deviation [d init_ , γ init_ ], otherwise go directly to the next step;
[0104] [Step S6...
PUM
Abstract
Description
Claims
Application Information
- R&D Engineer
- R&D Manager
- IP Professional
- Industry Leading Data Capabilities
- Powerful AI technology
- Patent DNA Extraction
Browse by: Latest US Patents, China's latest patents, Technical Efficacy Thesaurus, Application Domain, Technology Topic, Popular Technical Reports.
© 2024 PatSnap. All rights reserved.Legal|Privacy policy|Modern Slavery Act Transparency Statement|Sitemap|About US| Contact US: help@patsnap.com