Looking for breakthrough ideas for innovation challenges? Try Patsnap Eureka!

Kalman estimation method of joint torque of SCARA robot

A technology of robot joints and joint torques, which is applied in manipulators, program-controlled manipulators, manufacturing tools, etc., and can solve problems that affect the realization of control algorithms and the real-time performance of filtering methods cannot be guaranteed.

Active Publication Date: 2017-11-17
SOUTH CHINA UNIV OF TECH
View PDF6 Cites 4 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

However, the real-time performance of some filtering methods cannot be guaranteed, which affects the realization of the control algorithm.

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
  • Kalman estimation method of joint torque of SCARA robot
  • Kalman estimation method of joint torque of SCARA robot
  • Kalman estimation method of joint torque of SCARA robot

Examples

Experimental program
Comparison scheme
Effect test

Embodiment Construction

[0060] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments.

[0061] A kind of Kalman estimation method of SCARA robot joint moment, comprises the following steps:

[0062] Step 1: Establish the dynamic model of the SCARA robot according to the Newton Euler method, and obtain the continuous nonlinear torque expression of each joint;

[0063] Step 2: Transform the continuous nonlinear joint moment expression into a recursive linear discrete joint moment expression by using the first-order Taylor expansion formula of the multivariate function;

[0064] Step 3: Take the linearly discretized expression of each joint torque as the process equation, and add the corresponding measurement equation, and combine the process equation and measurement equation into a discrete-time state-space model of each joint torque;

[0065] Step 4: According to the basic Kalman filter method, combined with the discrete-time stat...

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 Kalman estimation method of joint torque of an SCARA robot. The Kalman estimation method comprises the following steps: Step 1, acquiring a continuous nonlinearity torque expression of all joints; Step 2, utilizing the first-order Taylor expansion formula of a multivariate function to obtain a recursive linear discrete joint torque expression; Step 3, taking the linear discretized joint torque expression as a process equation, adding a corresponding measurement equation, and combining and arranging the process equation and the measurement equation into a discrete time state space model of the joint torque; and Step 4, determining a formula used in a stepping cycle by combining the discrete time state space model of the joint torque and according to the basic Kalman filtering method, and estimating the joint torque of the SCARA robot in real time by utilizing a read joint motor current signal and a motor encoder signal. According to the Kalman estimation method, the estimation precision of the joint torque is improved without using a sensor to provide reliable information for a robot control algorithm.

Description

technical field [0001] The invention relates to a method for estimating joint torque of a SCARA robot, in particular to a method for improving the estimation accuracy of joint torque based on a Kalman filter method and using a motor current signal with noise as basic information without using a torque sensor. Background technique [0002] The realization of high-speed and high-precision characteristics of SCARA robot depends on effective control algorithm, and the control algorithm has high requirements on the accuracy of control information such as joint torque. At present, there are two commonly used acquisition methods for joint torque, which are acquired through torque sensors or converted through joint motor current. [0003] 1) Obtain the joint torque through the torque sensor. The main problems of this method are high cost and difficult installation and maintenance. Especially for some finished robots, if the installation of sensors at the joints is not considered i...

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 Applications(China)
IPC IPC(8): B25J9/16
CPCB25J9/1633
Inventor 张铁梁骁翃
Owner SOUTH CHINA UNIV OF TECH
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Patsnap Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Patsnap Eureka Blog
Learn More
PatSnap group products