Looking for breakthrough ideas for innovation challenges? Try Patsnap Eureka!

High-precision multi-joint serial connection mechanical arm anti-kinematics solution

A robotic arm and multi-joint technology, applied in informatics, special data processing applications, instruments, etc., can solve problems such as non-unique solutions, slow solution speeds, and low precision

Active Publication Date: 2016-09-28
WUHAN FENJIN INTELLIGENT MACHINE CO LTD
View PDF2 Cites 13 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0005] The present invention is mainly to solve the technical problems of low stability, low precision, slow solution speed and non-unique solution in the prior art; it provides a stable, fast, accurate and unique solution to the kinematics of the mechanical arm inverse solution

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
  • High-precision multi-joint serial connection mechanical arm anti-kinematics solution
  • High-precision multi-joint serial connection mechanical arm anti-kinematics solution
  • High-precision multi-joint serial connection mechanical arm anti-kinematics solution

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0092] The invention provides a high-precision method for solving the motion posture of a multi-joint tandem mechanical arm, which includes:

[0093] Step 1: Establish the DH parameter table according to the external structure size of the mechanical arm, and establish the positive kinematics equation according to the DH method:

[0094] 0 T n = 0 T 1 · 1 T 2 … n-1 T n (18)

[0095] Where n is the total number of joints of the robotic arm;

[0096]

[0097] Where n=[n x ,n y ,n z ] T , O=[o x ,o y ,o z ] T , A=[a x ,a y ,a z ] T , P=[p x ,p y ,p z ] T ; N, o, a are the attitude vector, p is the position vector; n x ,n y ,n z ,o x ,o y ,o z ,a x ,a y ,a z , P x ,p y ,p z The specific expression of only contains θ 1 ,θ 2 …Θ n These n joint angle variables; the i-1 T i Where i=1, 2,...n; the fixed DH coordinate system on the i-1 link connected to the i joint is used as the base coordinate, and the fixed DH coordinate on the i link connected to the i joint The pose conversion matrix relat...

Embodiment 2

[0147] The invention provides a high-precision method for solving the motion posture of a multi-joint tandem mechanical arm, in particular to a mechanical arm with a 6-joint structure that satisfies the piper criterion.

[0148] Assuming that the robotic arm is a 6-joint structure that meets the piper criterion, the rear three joint axes intersect at one point, and the positive kinematics position equation does not include the rear three joint angles, the position and posture can be used to find the inverse solution step by step to further improve The accuracy of the inverse solution and the method of inverse solution follow the steps below:

[0149] Step 1: Establish the DH parameter table according to the external structure size of the robot arm, and establish the positive kinematics equation according to the DH method

[0150] 0 T 6 = 0 T 1 · 1 T 2 · 2 T 3 · 3 T 4 · 4 T 5 · 5 T 6 (35)

[0151] It can be calculated:

[0152]

[0153] n is the total number of joints of the robotic ar...

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 high-precision multi-joint serial connection mechanical arm anti-kinematics solution. A hybrid particle swarm optimization and gravitational search algorithm (PSOGSA) is used, a formula (please see the formula in the description) of a nonlinear weight distribution coefficient s is introduced, the early stage of algorithm design is partial to the gravitational algorithm, and the middle stage and the later stage of algorithm design are partial to the particle swarm optimization, so that search efficiency is improved. Three improvement strategies including improvement point dynamic and narrow boundary, non-linear time-varying weight and local optimal correction combination and super-inter-belt weak directivity return diffusion are adopted. By means of the algorithm and the improvement strategies, a unique inverse solution is obtained within a small number of iteration, errors are always stabilized in the 10<-8> level, and theoretical calculation time can be reduced to 2.58 ms each time. According to the special structure mechanical arm with three shafts intersected at a point, the position and posture separation inverse solution strategy is used, solution performance can be further improved, the errors can be reduced to 10<-14> level, and theoretical calculation time can be reduced to 1.597 ms each time.

Description

Technical field [0001] The invention relates to the kinematics solution technology of a multi-joint series manipulator, in particular to a solution method for the kinematics inverse solution of a high-precision series manipulator without inverse triangulation calculation. The solution is based on the improved Gravity Particle Swarm Optimization (PSOGSA). Background technique [0002] The multi-joint tandem manipulator is a complex electromechanical object. It not only involves mechanical design, processing, and assembly, but also involves the selection and drive of electrical motors, and also involves kinematics and dynamics in control. Basic multi-joint coordination control algorithm. Among them, kinematics is the basis of any control, because it is used to calculate the relationship between the end pose of the robotic arm and the angle of each joint. Among them, obtaining the robot end pose from the joint angle is called the positive kinematics solution, and the expression ca...

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
Patent Type & Authority Applications(China)
IPC IPC(8): G06F19/00
CPCG16Z99/00
Inventor 潘健王亚洲王淑青高翔舒军余志婷李维裴远阳李叶伟陆田朱道利要若天
Owner WUHAN FENJIN INTELLIGENT MACHINE CO LTD
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Patsnap Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Patsnap Eureka Blog
Learn More
PatSnap group products

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