A real-time motion planning method for robots based on force feedback

A motion planning, robotics technology, applied in manipulators, program-controlled manipulators, manufacturing tools, etc., can solve the problems of not considering the rated torque constraint of the manipulator, motion shock, failure shutdown, etc., to improve the quality of processing and assembly, smooth acceleration, eliminate Effects of Data Acquisition Noise

Active Publication Date: 2022-01-04
BEIJING SATELLITE MFG FACTORY
View PDF8 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0005] The technical problem solved by the present invention is: in the current prior art, using segmental linear mapping between the force at the end of the mechanical arm and the periodical attitude correction amount to perform compliant force follow-up control on the mechanical arm, the motion shock and failure shutdown that are prone to occur , relying solely on the theoretical model without considering the actual rated torque constraints of each axis of the manipulator, a real-time motion planning method for robots based on force feedback is proposed

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
  • A real-time motion planning method for robots based on force feedback
  • A real-time motion planning method for robots based on force feedback
  • A real-time motion planning method for robots based on force feedback

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0049] A real-time motion planning method for robots based on force feedback. Aiming at the problem that the mechanical arm cannot move smoothly in the case of large periodic attitude corrections, the existing piecewise linear force-position control method is corrected, such as figure 1 As shown, the specific steps are:

[0050] (1) Use a six-dimensional force sensor for data collection, and obtain the component forces f of the X, Y, and Z axes in the base coordinate system of the manipulator after gravity compensation and coordinate transformation X , f Y , f Z , and according to the component force f X , f Y , f Z Obtain the external force f in the base coordinate system of the manipulator;

[0051] Wherein, the coordinate system of the six-dimensional force sensor coincides with the X and Y axes of the tool coordinate system of the manipulator respectively, and the calculation method of the external force is: subtract the load gravity at the end of the manipulator from...

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

A real-time motion planning method for a robot based on force feedback, aiming at the problem that the robot arm cannot smoothly add / subtract motion under a large periodic attitude correction amount, the existing piecewise linear force position control method is modified. The six-dimensional force sensor is used to sense the external force, and the target attitude correction amount per cycle of each axis of the coordinate system is obtained; and the interpolation step of the attitude correction amount per cycle of each axis is determined by incrementing the maximum period attitude correction amount when each coordinate axis is running stably. Finally, through force-position conversion and interpolation, the periodic attitude target correction amount of each axis is approximated, which avoids the vibration caused by the change of motion state when the robot arm starts or stops, and realizes the smooth movement in the process of force control of the robot arm.

Description

technical field [0001] The invention relates to a real-time motion planning method for a robot based on force feedback, and belongs to the technical field of control engineering. Background technique [0002] Robot is a kind of large-load, high-precision automatic mechanical system, and it is more and more applied to the field of processing and assembly. However, in some processing and assembly fields, traditional teaching is difficult to meet the accuracy requirements, takes a long time, and has poor environmental adaptability. The robot active compliance control system based on force feedback is composed of a manipulator, a manipulator control cabinet, a force sensor installed at the end of the manipulator, and a host computer control system. It can follow the external force for flexible motion and realize the flexibility of the posture of the end parts of the manipulator. Adjustment. [0003] In the study of robot compliance force control, it is found that in order to r...

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): B25J9/16
CPCB25J9/1664B25J9/1633
Inventor 张加波徐建萍赵长喜刘净瑜乐毅
Owner BEIJING SATELLITE MFG FACTORY
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