Movement control method of six-degree-of-freedom wrist offset type serial mechanical arm

A technology of motion control and manipulators, which is applied in manipulators, program-controlled manipulators, manufacturing tools, etc. It can solve problems such as low control accuracy, inability to obtain multiple solutions at the same time, and inability to converge

Active Publication Date: 2018-10-19
NORTHEASTERN UNIV
View PDF5 Cites 16 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

The numerical method itself has many limitations, such as slow convergence speed or sometimes no convergence for high-dimensional nonlinear problems, improper selection of initial values ​​will seriously reduce the convergence speed and calculation accuracy, and it is impossible to obtain multiple solutions at the same time, so that s

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
  • Movement control method of six-degree-of-freedom wrist offset type serial mechanical arm
  • Movement control method of six-degree-of-freedom wrist offset type serial mechanical arm
  • Movement control method of six-degree-of-freedom wrist offset type serial mechanical arm

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0074] In order to make the purpose, technical solution and advantages of the present invention clearer, the present invention will be further described in detail below in conjunction with the accompanying drawings and specific embodiments. The specific embodiments described here are only used to explain the present invention, not to limit the present invention.

[0075] A motion control method of a six-degree-of-freedom wrist-biased serial manipulator, the process is as follows figure 1 shown, including the following steps:

[0076] Step 1: According to the D-H parameter method, establish the link coordinate system {i} of the joint i of the six-DOF wrist offset serial manipulator, where i=1, 2, 3, 4, 5, 6.

[0077] In this embodiment, the schematic diagram of the established D-H coordinate system of the manipulator is as follows figure 2 As shown, the transformation between the coordinate system {i} and the coordinate system {i-1} consists of four parameters, as shown in t...

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 provides a movement control method of a six-degree-of-freedom wrist offset type serial mechanical arm, and relates to the technical field of robot kinematics control methods. The methodcomprises the steps of building a connecting rod coordinate system of the mechanical arm; building a kinematical equation of the mechanical arm; obtaining the angle initial value of a joint 1; calculating the angle values of inverse kinematics solutions of joints 2-6; calculating the error of a pose and a given pose of an end effector; judging whether the error is within the error threshold valuerange; screening out the angle value of one set of inverse kinematics solution meeting the condition; and inputting the angle values of the joints of the mechanical arm into a control module of a known robot to finish movement control over the six-degree-of-freedom wrist offset type serial mechanical arm. The movement control method of the six-degree-of-freedom wrist offset type serial mechanicalarm does not need to consider the singular solution problem based on a Jacobian matrix, simplifies the control process, effectively reduces the calculation amount, improves the convergence rate and calculation precision and improves the control precision of the mechanical arm at the same time.

Description

technical field [0001] The invention relates to the technical field of robot kinematics control methods, in particular to a motion control method of a six-degree-of-freedom wrist offset series mechanical arm. Background technique [0002] Solving robot inverse kinematics is the premise and foundation of robot control. Robots whose three joints at the end do not intersect at one point or whose three axes are not parallel are usually called wrist-biased manipulators. This type of manipulator has the characteristics of high structural strength and flexible movement, but it is difficult to calculate the The inverse kinematics solutions of type manipulators, thus numerical methods are widely used to solve the above problems. The numerical method itself has many limitations, such as slow convergence speed or sometimes no convergence for high-dimensional nonlinear problems, improper selection of initial values ​​will seriously reduce the convergence speed and calculation accuracy,...

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/16
CPCB25J9/1607B25J9/1615
Inventor 颜云辉徐靖宋克臣董志鹏张德富
Owner NORTHEASTERN UNIV
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