Robot real-time motion planning method based on force feedback

A motion planning, robotics technology, applied in manipulators, program-controlled manipulators, manufacturing tools, etc., can solve problems such as failure to stop, not considering the rated torque constraints of the manipulator, and motion oscillations

Active Publication Date: 2020-10-23
BEIJING SATELLITE MFG FACTORY
View PDF8 Cites 3 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

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

The invention provides a robot real-time motion planning method based on force feedback. Aiming at solving the problem that under the large periodic attitude correction, a mechanical arm cannot conduct smooth plus/minus motion, an existing piecewise linear force position control method is corrected. A six-component force sensor is adopted to sense external acting force to obtain each periodic attitude target correction of all axes of a coordinate system; and the maximum increment of the periodic attitude correction during stable operation of all the coordinate axes is determined as the interpolation stride cardinal number of each periodic attitude correction of all the axes, finally through force position conversion, the periodic attitude target correction of all the axes is subjected to interpolation approximation, shocking caused by the change of the motion state during starting or stopping of the mechanical arm is avoided, and smooth motion in the force control process of the mechanical arm is achieved.

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
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