Mechanical arm trajectory tracking control method and device based on instruction filter

A trajectory tracking and control method technology, which is applied to manipulators, program-controlled manipulators, manufacturing tools, etc., can solve the problems of small application range and complicated controller design process, and achieve the effect of less difficulty and simplified calculation process

Active Publication Date: 2020-08-07
HARBIN INST OF TECH
View PDF7 Cites 9 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0005] The technical problem to be solved by the present invention lies in the problems that the prior art manipula

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
  • Mechanical arm trajectory tracking control method and device based on instruction filter
  • Mechanical arm trajectory tracking control method and device based on instruction filter
  • Mechanical arm trajectory tracking control method and device based on instruction filter

Examples

Experimental program
Comparison scheme
Effect test

Example Embodiment

[0066] Example 1

[0067] Such as figure 1 As shown, the trajectory tracking control method of a manipulator based on a command filter, the method includes:

[0068] Step S1: Establish a single-node robotic arm system model. According to the single-node robotic arm system model, construct a single-node robotic arm system state equation considering input saturation characteristics; the specific process is:

[0069] Use formula

[0070]

[0071] Establish a single-node robotic arm system model, where q represents the angle of the single-node robotic arm joint, Represents the angular velocity of a single-node robotic arm joint, Represents the angular acceleration of a single-node robotic arm joint; τ is the control torque generated by the motor subsystem, τ d Is the external disturbance torque and ω is the random disturbance moment, Is the first derivative of the random disturbance torque, u is the control input torque of the electromechanical system, D is the mechanical inertia const...

Example Embodiment

[0134] Example 2

[0135] Corresponding to Embodiment 1 of the present invention, Embodiment 2 of the present invention also provides a robot arm trajectory tracking control device based on a command filter, and the device includes:

[0136] The state equation acquisition module is used to build a single-node robotic arm system model. According to the single-node robotic arm system model, the state equation of the single-node robotic arm system is constructed considering input saturation characteristics;

[0137] The virtual controller establishment module is used to establish the first virtual controller and the second virtual controller according to the state equation of the single-node robotic arm system;

[0138] The command filter establishment module is used to establish the command filter according to the first virtual controller and the second virtual controller;

[0139] The closed-loop control system establishment module is used to establish a closed-loop control system accord...

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 mechanical arm trajectory tracking control method and device based on an instruction filter. The method comprises the following steps that a single-node mechanical arm systemmodel is built, and a single-node mechanical arm system state equation is considered to be input according to the single-node mechanical arm system model; a first virtual controller and a second virtual controller are established according to the single-node mechanical arm system state equation, and the instruction filter is established according to the first virtual controller and the second virtual controller; the instruction filter is established according to the first virtual controller and the second virtual controller; and trajectory tracking control is performed on a mechanical arm byusing a closed-loop control system. The mechanical arm trajectory tracking control method and device based on the instruction filter has the advantages that the application range is expanded, the design process of the controller is simple, and the implementation difficulty is low.

Description

technical field [0001] The present invention relates to the technical field of robot control, and more specifically to a method and device for tracking and controlling the trajectory of a manipulator based on a command filter. Background technique [0002] With the development of science and technology, scholars have deepened their research on robotic systems. In recent years, robot systems have been widely used in industry, agriculture, military and human family life. Since the emergence of robots greatly reduces the amount of labor required in complex production processes and effectively replaces humans in dangerous industries, research on robots is of great significance. The single-node manipulator system is a typical robot system. Since the single-node manipulator is often affected by unknown disturbances and mechanical friction during the work process, its accurate model is difficult to obtain, which makes it difficult to realize the trajectory tracking of the single-n...

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/16B25J9/1628B25J9/1664
Inventor 邱剑彬王桐马敏樊渊
Owner HARBIN INST OF 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