Speed ​​control method of high-precision traction teaching robot based on impedance model

A technology for teaching robots and impedance models, which is applied in program control, digital control, electrical program control, etc., can solve problems such as difficulty in traction teaching, poor real-time traction effect, and inability to control speed and acceleration. Real-time following effect, real-time tracking effect, effect of improving precision

Active Publication Date: 2018-11-09
SOUTHEAST UNIV
View PDF7 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

However, these two solutions have the following disadvantages: ①Due to the low level of interface development, only some interface functions are available, such as point-to-point motion commands (MovJ or MoveL), which cannot control the speed and acceleration of the robot during motion ;②Based on the existing secondary development interface of the controller, only the relationship between the force deviation F and the displacement x can be established. Therefore, in each force control cycle, the end of the robot will experience "acceleration-uniform speed-deceleration" or "acceleration- Therefore, it will be found that the movement of the end of the robot is not smooth during traction, and the traction effect shows that the real-time traction effect is poor and the traction accuracy is low.
③The drag teaching based on zero-force control without torque sensor has low traction accuracy and needs to rely on an accurate dynamic model. Moreover, when dragging at low speeds, there are many nonlinear factors that affect the accuracy of dragging. It is difficult to achieve accurate traction teaching without a torque sensor, so it is also difficult to use in actual industrial sites

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
  • Speed ​​control method of high-precision traction teaching robot based on impedance model
  • Speed ​​control method of high-precision traction teaching robot based on impedance model
  • Speed ​​control method of high-precision traction teaching robot based on impedance model

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0036] The technical solution of the present invention will be further introduced below in combination with specific embodiments.

[0037] This specific embodiment discloses a speed control method of a high-precision traction teaching robot based on an impedance model, including the following steps:

[0038] S1: The robot controller collects the information of the six-dimensional force sensor, first filters the collected information, then performs gravity compensation, and finally obtains the deviation data from the expected force or expected torque value;

[0039] S2: Transform the force deviation data or torque value deviation data into the speed at which the end of the robot moves in Cartesian space and the angular velocity around the axis according to the impedance model;

[0040] S3: Smoothly interpolate the motion according to the deformed S-shaped speed control curve to obtain the corresponding position function, speed function and acceleration function;

[0041] S4: A...

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 discloses a speed control method for a high-accuracy traction teaching robot based on an impedance model. The speed control method includes the steps: S1 acquiring information of a six-dimensional force sensor by the robot: firstly, performing filter processing for acquired information, secondly, performing gravity compensation, and finally, acquiring deviation data of expected force or an expected torque value; S2, transforming the deviation data of the force or the deviation data of the torque value into moving speed of the tail end of the robot in the Cartesian space and angle speed rotating around an axis according to the impedance model; S3 performing smooth interpolation for motion according to a deformed S-shaped speed control curve to obtain a corresponding position function, a speed function and an acceleration function; S4 calculating a joint angle function in joint space according to inverse kinematics; S5 performing isochronous interpolation of the joint space for the joint angle function, and transmitting the joint angle function to a servo driver by a bus of a controller to control actions of the robot. According to the speed control method, traction accuracy is effectively improved.

Description

technical field [0001] The invention relates to the field of industrial robots, in particular to a speed control method of a high-precision traction teaching robot based on an impedance model. Background technique [0002] Manual traction and teaching robot operation is an indispensable link in human-machine cooperation, and it is an operation to instruct the teaching personnel to drag the robot to the teaching point in Cartesian space or joint space. During traction teaching, the end or joint of the robot needs to track the intended direction of human dragging in real time and accurately, so that the robot can make the desired motion state. There are two intuitive solutions for traditional traction teaching robots: based on the existing controller secondary development interface for admittance control or based on torque mode for zero-force drag teaching without torque sensors. However, these two solutions have the following disadvantages: ①Due to the low level of interface...

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 Patents(China)
IPC IPC(8): G05B19/416
CPCG05B19/416G05B2219/36585
Inventor 段晋军甘亚辉戴先中
Owner SOUTHEAST 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