A quintic polynomial planning method for industrial robot trajectory

A quintic polynomial, industrial robot technology, used in instruments, simulators, computer control, etc., can solve problems beyond the limits of robot motion parameters, and achieve the effect of continuous speed and acceleration, smooth planning curve, and continuous acceleration and jerk

Active Publication Date: 2019-11-12
NANJING ESTUN ROBOTICS CO LTD
View PDF5 Cites 0 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0006] The present invention proposes a quintic polynomial trajectory planning method for an industrial robot. The purpose is to solve the problem that the planned curve will exceed the limit of the robot's own motion parameters due to the unfixed shape of the quintic polynomial curve, so as to ensure the planned trajectory. Displacement, velocity, and acceleration at each moment are continuous, the curve is smooth, and it meets the inherent motion parameter limitations of the robot

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 quintic polynomial planning method for industrial robot trajectory
  • A quintic polynomial planning method for industrial robot trajectory
  • A quintic polynomial planning method for industrial robot trajectory

Examples

Experimental program
Comparison scheme
Effect test

Embodiment

[0042] Taking the transition between straight lines of an industrial robot as an example, quintic polynomial trajectory planning is used.

[0043] 1. Determine the starting and ending displacement, velocity and acceleration information of the trajectory

[0044] The trajectory preprocessing module determines the effective starting and ending displacement, velocity and acceleration information of the trajectory according to the taught start and stop position points, combined with the inherent motion parameter limitations.

[0045] the s 0 = 0, v 0 =20, acc 0 = 0;

[0046] the s e = 100, v e =82, acc e =0.

[0047] 2. Determine the interpolation time of the fifth planning

[0048] The interpolation time determined by formula (3) is 1.961s. Since the fine interpolation period of the system is 0.004s, the interpolation time is taken as an integer multiple of the fine interpolation period and rounded up to determine the fifth planning interpolation time t e = 1.964s.

[0...

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

Disclosed is a quintic polynomial trajectory planning method for an industrial robot. The method fits, according to start-end displacement, velocity and acceleration information of a trajectory, interpolation time of quintic polynomial trajectory planning using a velocity trend of s-curve trajectory planning, thereby further determining a quintic polynomial trajectory planning model. The proposed quintic polynomial planning method of the present invention determines a planning model based on the velocity running trend of the s-curve trajectory planning. The method can solve the problem in which quintic polynomial curve shapes are not fixed and are prone to twisting, thereby ensuring that velocity change during a planning process is monotonic and that no substantial convexity or reverse conditions occur, and ensuring that the planned trajectory can meet inherent motion parameter limits of the robot at all times from a start point to an end point of the trajectory. In addition, compared to commonly used trapezoidal planning and s-curve planning, the model planning curve is smoother and the trajectory running process is steadier.

Description

technical field [0001] The invention relates to a trajectory planning method for an industrial robot, in particular to a quintic polynomial planning method for the trajectory of an industrial robot. Background technique [0002] Trajectory planning is the basis of robotics applications. Robot trajectory planning is to plan the path, velocity, acceleration and jerk of the end of the robot or each joint between the starting point and the ending point. Robot trajectory planning is carried out in two spaces: joint space and Cartesian space, but no matter which space is used for trajectory planning, it is necessary to ensure that the planned trajectory is continuous and smooth, and meets the inherent motion parameters of the robot. Smooth movement of the robot. [0003] According to literature research, the current common industrial robot trajectory planning includes trapezoidal planning, S-shaped planning and polynomial planning, and the most common polynomial planning is quin...

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/404
CPCG05B19/404G05B2219/35408
Inventor 潘婷婷敬淑义冯日月夏正仙王继虎王杰高
Owner NANJING ESTUN ROBOTICS CO LTD
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