Master-slave mode snake-like robot system and position control method thereof

A technology of snake-like robot and main robot, applied in the direction of program control manipulator, manipulator, manufacturing tool, etc., can solve problems such as poor real-time control

Active Publication Date: 2016-10-26
SHENZHEN INST OF ADVANCED TECH
View PDF4 Cites 9 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

The traditional master-slave snake robot position control method has the disadvantage of poor real-time control

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
  • Master-slave mode snake-like robot system and position control method thereof
  • Master-slave mode snake-like robot system and position control method thereof
  • Master-slave mode snake-like robot system and position control method thereof

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0022] In one embodiment, a position control method of a master-slave snake robot system, such as figure 1 shown, including the following steps:

[0023] Step S120: Obtain the position information of the master hand of the master robot, and perform master-slave mapping changes on the position information of the master hand to obtain position information of the master-slave map.

[0024] Specifically, the master-slave control system can receive the master-hand movement command of the master robot, and obtain the position change information of each joint of the master-hand in the master robot according to the master-hand motion command. Position change information in a Cartesian space coordinate system. It can be understood that in other embodiments, the position change information of each joint of the main hand may also be collected directly.

[0025] After the master-hand position information of the master robot is collected, according to the preset master-slave mapping rela...

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 master-slave mode snake-like robot system and a position control method thereof. Master manipulator information of a master robot is obtained and subjected to master-slave mapping change to obtain master-slave mapping position information. Actual displacement variation of a slave robot is obtained, and slave manipulator position error is obtained through calculation according to the actual displacement variation of the slave robot. According to the master-slave mapping position information and the slave manipulator position error, slave manipulator angle variation is obtained by processing with a neural network correlation pruning algorithm and output to the slave robot so as to control the slave robot to move following with the master robot. Through the neural network correlation pruning algorithm, precise position control over the slave robot and the master robot is achieved, reverse kinematics does not need to be conducted on the slave robot, solution multiplicity is avoided, the number of degrees of freedom of the slave robot is not limited, and control real-time performance is improved.

Description

technical field [0001] The invention relates to the technical field of robot control, in particular to a master-slave snake robot system and a position control method thereof. Background technique [0002] The snake-shaped medical robot can enter the space that cannot be reached by human hands, enter the natural cavity of the human body to complete surgery and fixed-point drug delivery, and fix one end of the snake-shaped medical robot, then it becomes an operator with redundant degrees of freedom, which can complete Complicated grasping action can be operated in a narrow space. [0003] The traditional master-slave snake-like robot position control method is controlled by the Jacobian algorithm, picking up the speed change of the master hand in three-dimensional space, modeling the kinematics of the slave hand, calculating its Jacobian matrix, and inverting the matrix. Convert instantaneous velocity to displacement. This method has strong restrictions on the degree of fre...

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): B25J9/06B25J9/16
CPCB25J9/065B25J9/161B25J9/1664
Inventor 李橡欣任岭雪韩世鹏李栓熊璟王磊
Owner SHENZHEN INST OF ADVANCED TECH
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