CN112975971B - Robot inertia force compensation method - Google Patents
Robot inertia force compensation method Download PDFInfo
- Publication number
- CN112975971B CN112975971B CN202110226160.8A CN202110226160A CN112975971B CN 112975971 B CN112975971 B CN 112975971B CN 202110226160 A CN202110226160 A CN 202110226160A CN 112975971 B CN112975971 B CN 112975971B
- Authority
- CN
- China
- Prior art keywords
- robot
- inert
- gravity
- meas
- acceleration
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 230000001133 acceleration Effects 0.000 claims abstract description 33
- 238000005259 measurement Methods 0.000 claims abstract description 15
- 239000012636 effector Substances 0.000 claims abstract description 9
- 238000013507 mapping Methods 0.000 claims abstract description 7
- 230000005484 gravity Effects 0.000 claims description 40
- 238000005070 sampling Methods 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 abstract description 11
- 239000000463 material Substances 0.000 abstract description 4
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000003754 machining Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000037237 body shape Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1638—Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a robot inertia force compensation method, which comprises the steps of obtainingObtaining acceleration, obtaining inertia force, and establishing a mapping between the inertia force and the acceleration: finert＝[M]A, calculating an inertial force compensation parameter [ M]Let the compensating force Fcomp＝‑FinertCompensating the moment Tcomp＝‑TinertThe method is used for compensating the inertia force with load measurement, wherein the tail end of the robot makes linear motion, a linear motion track parameter equation is established, the form is concise, the implementation is convenient, the acceleration changes according to a sine rule, the measurement is efficient and concise, and the smooth and simple control of the motion is ensured; in addition, by measuring the inertial force FinertThe measured acceleration a is utilized to establish the mapping relation between the inertia force and the acceleration, so that the inertia force is accurately compensated, the real-time calculation efficiency is improved, the shape and the material of the end effector of the robot do not need to be measured, and the complexity and the calculation error of integral calculation of the rotational inertia are avoided.
Description
Technical Field
The invention relates to the technical field of robot processing, in particular to a robot inertia force compensation method.
Background
The processing precision of the robot is closely related to acceleration and deceleration motion control and dynamics control of the robot. At present, when an industrial robot is applied to industries such as machining and assembly, the contact force between a robot terminal tool or a workpiece and the external environment needs to be accurately sensed so as to ensure the flexibility of operation. In the existing application, a six-component sensor is usually selected, which can measure three-dimensional orthogonal force and three-dimensional orthogonal moment, three-dimensional orthogonal acceleration and three-dimensional orthogonal angular acceleration in any force system in space; under dynamic conditions, the moment measured by the robot end sensor comprises load gravity, load inertia force and external contact force applied to the load. In a closed-loop force control algorithm, a robot controller corrects the motion of the robot at the next moment according to the force feedback and the pose feedback of a sensor;
in the process of movement of the robot mechanical arm, an inertial mass effect can be generated, which is caused by acceleration generated by a load end (a clamp, an actuator, a sensor and the like) of the sensor; the inertia force can be generated under the influence of the acceleration, and the measurement value of the sensor can be directly influenced;
the traditional load end inertial mass is obtained by performing integral calculation by using a theoretical mechanics theory according to the rigid body shape and the material of a robot end actuator (including a sensor and a clamp), and when the overall shape of the actuator is more regular, the calculation result is higher in precision, but in general, the actuator is formed by assembling a plurality of different components, and the material of each component is also larger in difference, so that the calculation error of the inertial mass M of the actuator is larger; therefore, the inertia force error obtained by multiplying the acceleration value a measured by the sensor by M obtained by theoretical calculation is also large, so that a robot inertia force compensation method is urgently needed to solve the problem in order to meet the requirement of the measurement accuracy of the machining contact force.
Disclosure of Invention
The invention provides a robot inertial force compensation method which can eliminate the influence of load inertial force on a sensor measurement value so as to accurately analyze the external contact force applied to a load, and solves the problems in the prior art.
In order to achieve the purpose, the invention provides the following technical scheme: a robot inertial force compensation method, comprising:
s1, obtaining acceleration, planning the tail end of the robot to do linear motion, determining the starting point and the end point of the robot, and establishing a motion trail parameter equation as
Sampling all time step points in the linear motion, and calculating the acceleration a (t) of all the time step points;
s2, obtaining an inertia force, comprising:
a. method for obtaining sensor three-dimensional force F by using no-load motion of robotmeas＝(Fx，Fy，Fz) And three-way moment Tmeas＝(Tx，Ty，Tz)；
b. Identifying the gravity magnitude G and the centroid position C ═ C (C) by using a gravity compensation algorithmx,Cy,Cz)；
c. Dividing gravity and gravity moment along sensor coordinate systemHydrolyzing to obtain G '═ G'x,G′y,G′z) And T ═ T'x,T′y,T′z)；
d. Measuring a sensor value F in a sensor coordinate systemmeasAnd TmeasRespectively subtracting the gravity value G 'and the gravity moment T' to obtain an inertia force FinertAnd moment of inertia Tinert；
S3, establishing a mapping between inertia force and acceleration: finert＝[M]A, calculating an inertial force compensation parameter [ M]；
S4, make the compensation force Fcomp＝-FinertCompensating the moment Tcomp＝-TinertAnd the method is used for compensating the inertia force with load measurement.
Preferably, in step S1, the starting point Ps of the linear motion of the robot end is determined as (x)s,ys,zs) And end point Pe ═ xe,ye,ze) The straight-line distance between two points is
The total time of the linear motion of the tail end of the robot is T, wherein all points on a straight line section between the two points are positioned in the robot working space.
Preferably, in step S1, the trajectory parameter equation S is subjected to isoparameter sampling on t, and the acceleration a (t) is calculated as:
a. sampling parameters of the straight line s (t) to obtain discrete parameters
And a sequence of discrete points
Wherein A is 2 pi L/T2，ω＝2π/T；
b. Calculating speedDegree-discrete point sequence
Deriving t by the linear equation s (t):
wherein at each time sampling point tiIn the above-mentioned manner,
c. calculating acceleration discrete point sequences
Deriving t by the velocity equation v (t):
wherein at each time sampling point tiIn the above-mentioned manner,
preferably, in step S2, the robot performs idle motion, that is, only the end effector of the robot moves along the above-mentioned linear track, and does not need to contact with the real workpiece, so as to ensure that the sensor measurement value only includes gravity and inertia force.
Preferably, in step S2, when the gravity and the moment of gravity are resolved along the sensor coordinate system, the direction of the gravity of the robot end effector does not coincide with the Z direction of the sensor coordinate system, and the gravity is projected in three directions of the sensor coordinate system according to the posture of the robot end effector.
Preferably, in step S2, FmeasAnd TmeasRespectively subtracting the gravity value G 'and the gravity moment T', and specifically:
Finert_x＝Fmeas_x-G′x；
Finert_y＝Fmeas_y-G′y；
Finert_z＝Fmeas_z-G′z；
Tinert_x＝Tmeas_x-T′x；
Tinert_y＝Tmeas_y-T′y；
Tinert_z＝Tmeas_z-T′z。
preferably, in step S3, the discrete series of measurements are formed by a least squares method
And
fitting to obtain an inertia force compensation parameter M, wherein M is mass corresponding to translational motion, M is rotational motion, and M is rotational inertia, and in the F ═ Ma, when R is>(n +1), the least squares method is an over-determined equation whose solution is: m ═ aTa)-1aTF, wherein the dimension of F is [ R ]]Dimension of a [ R ]]And R is the number of rows of data.
Compared with the prior art, the invention has the beneficial effects that:
in the invention, the tail end of the robot makes linear motion, and a linear motion track parameter equation is established, so that the method has a simple form and is convenient to implement, and meanwhile, the acceleration sine law changes, the measurement is efficient and simple, and the smooth motion is ensured and is simple and controlled; in addition, by measuring the inertial force FinertThe measured acceleration a is utilized to establish the mapping relation between the inertia force and the acceleration, so that the inertia force is accurately compensated, the real-time calculation efficiency is improved, the shape and the material of the end effector of the robot are not required to be measured, the complexity and the calculation error of integral calculation of the rotational inertia are avoided, the influence of the action of the load inertia force on the measurement value of the sensor is eliminated, and the external contact force applied to the load is accurately analyzed.
Drawings
The accompanying drawings, which are included to provide a further understanding of the invention and are incorporated in and constitute a part of this specification, illustrate embodiments of the invention and together with the description serve to explain the principles of the invention and not to limit the invention.
In the drawings:
FIG. 1 is a general flowchart of a robot inertial force compensation method;
FIG. 2 is a graph of displacement versus time for a straight line trajectory;
FIG. 3 is a graph of velocity versus time for a straight-line trajectory;
FIG. 4 is a graph of acceleration versus time for a straight line trajectory.
Detailed Description
The preferred embodiments of the present invention will be described in conjunction with the accompanying drawings, and it will be understood that they are described herein for the purpose of illustration and explanation and not limitation.
Example (b): as shown in fig. 1, a robot inertial force compensation method for accurately compensating an inertial force by measuring the inertial force and using a measured acceleration to establish a mapping relationship between the inertial force and the acceleration, includes:
s1, obtaining acceleration, planning the tail end of the robot to do linear motion, determining the starting point and the end point of the robot, and establishing a motion trail parameter equation as
Sampling all time step points in the linear motion, and calculating the acceleration a (t) of all the time step points;
first, the starting point Ps of the linear motion of the robot end is determined as (x)s,ys,zs) And end point Pe ═ xe,ye,ze) Calculating the linear distance between the two
Determining the total linear motion time of the tail end of the robot as T, wherein the distance between the two points is equal to the distance between the two points and is located in the robot working space, in the embodiment, L is 0.8m, and T is 8 s;
performing equal parameter sampling on t by using a track parameter equation s, and calculating an acceleration a (t) specifically as follows:
a. as shown in FIG. 1, for the displacement curve, the parameter sampling is performed on the straight line s (t) to obtain the discrete parameter
And a sequence of discrete points
Wherein A is 2 pi L/T2，ω＝2π/T；
b. As shown in FIG. 3, a velocity discrete point sequence is calculated for the velocity profile
Deriving t by the linear equation s (t):
wherein at each time sampling point tiIn the above-mentioned manner,
c. as shown in FIG. 4, a sequence of acceleration discrete points is calculated for the acceleration curve
Deriving t by the velocity equation v (t):
wherein at each time sampling point tiIn the above-mentioned manner,
s2, obtaining an inertia force, comprising:
a. method for obtaining sensor three-dimensional force F by using no-load motion of robotmeas＝(Fx，Fy，Fz) And three-way moment Tmeas＝(Tx，Ty，Tz) (ii) a In order to ensure that the measured value of the sensor only contains gravity and inertia force, the robot does no-load motion, namely, the tail end of the robot only moves along the linear track without contacting with a real workpiece;
b. identifying the gravity magnitude G and the centroid position C ═ C (C) by using a gravity compensation algorithmx,Cy,Cz) Wherein the Gravity Compensation algorithm adopts an algorithm disclosed in the document Bias Estimation and Gravity Compensation For Force-Torque Sensors;
c. decomposing gravity and gravity moment along the sensor coordinate system to obtain G '═ G'x,G′y,G′z) And T ═ T'x,T′y,T′z)；
When the gravity and the gravity moment are decomposed along a sensor coordinate system, wherein the gravity direction of the robot end effector is inconsistent with the Z direction of the sensor coordinate system, and the gravity is projected to three directions of the sensor coordinate system according to the posture of the robot end effector;
d. measuring a sensor value F in a sensor coordinate systemmeasAnd TmeasRespectively subtracting the gravity value G 'and the gravity moment T' to obtain an inertia force FinertAnd moment of inertia TinertThe method specifically comprises the following steps:
Finert_x＝Fmeas_x-G′x；
Finert_y＝Fmeas_y-G′y；
Finert_z＝Fmeas_z-G′z；
Tinert_x＝Tmeas_x-T′x；
Tinert_y＝Tmeas_y-T′y；
Tinert_z＝Tmeas_z-T′z。
s3, establishing a mapping between inertia force and acceleration: finert＝[M]A, calculating an inertial force compensation parameter [ M]；
Wherein, in step S3, the discrete sequence of measurement values is determined by the least squares method
And
fitting to obtain an inertia force compensation parameter M, wherein M is mass corresponding to translational motion, M is rotational motion, and M is rotational inertia, and in the F ═ Ma, when R is>(n +1), the least squares method is an over-determined equation whose solution is: m ═ aTa)-1aTF, wherein the dimension of F is [ R ]]Dimension of a [ R ]]R is the number of rows of data;
s4, make the compensation force Fcomp＝-FinertCompensating the moment Tcomp＝-TinertThe method is used for inertial force compensation with load measurement, and the calculation efficiency of compensation implementation is improved.
Finally, it should be noted that: although the present invention has been described in detail with reference to the foregoing embodiments, it will be apparent to those skilled in the art that changes may be made in the embodiments and/or equivalents thereof without departing from the spirit and scope of the invention. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (7)
1. A robot inertial force compensation method is characterized by comprising the following steps:
s1, obtaining acceleration, planning the tail end of the robot to do linear motion, determining the starting point and the end point of the robot, and establishing a motion trail parameter equation as
Sampling all time step points in the linear motion, and calculating the acceleration a (t) of all the time step points;
s2, obtaining an inertia force, comprising:
a. method for obtaining sensor three-dimensional force F by using no-load motion of robotmeas＝(Fx，Fy，Fz) And three-way moment Tmeas＝(Tx，Ty，Tz)；
b. Identifying the gravity magnitude G and the centroid position C ═ C (C) by using a gravity compensation algorithmx,Cy,Cz)；
c. Decomposing gravity and gravity moment along the sensor coordinate system to obtain G '═ G'x,G′y,G′z) And T ═ T'x,T′y,T′z)；
d. Measuring a sensor value F in a sensor coordinate systemmeasAnd TmeasRespectively subtracting the gravity value G 'and the gravity moment T' to obtain an inertia force FinertAnd moment of inertia Tinert；
S3, establishing a mapping between inertia force and acceleration: finert＝[M]A, calculating an inertial force compensation parameter [ M]；
S4, make the compensation force Fcomp＝-FinertCompensating the moment Tcomp＝-TinertAnd the method is used for compensating the inertia force with load measurement.
2. The method of claim 1, wherein the method further comprises: in step S1, the start point Ps of the linear motion of the robot end is determined as (x)s,ys,zs) And end point Pe ═ xe,ye,ze) The straight-line distance between two points is
The total time of the linear motion of the tail end of the robot is T, wherein the straight line between the two pointsAll points on the line segment are positioned in the robot work space.
3. The method of claim 2, wherein the method further comprises: in step S1, the trajectory parameter equation S is subjected to equal parameter sampling on t, and the acceleration a (t) is calculated as:
a. sampling parameters of the straight line s (t) to obtain discrete parameters
And a sequence of discrete points
Wherein A is 2 pi L/T2，ω＝2π/T；
b. Computing a sequence of velocity discrete points
Deriving t by the linear equation s (t):
wherein at each time sampling point tiIn the above-mentioned manner,
c. calculating acceleration discrete point sequences
Deriving t by the velocity equation v (t):
wherein at each time sampling point tiIn the above-mentioned manner,
4. the method of claim 1, wherein the method further comprises: in step S2, the robot performs idle motion, that is, only the actuator at the end of the robot moves along the above-mentioned linear track, and does not need to contact with the real workpiece, so as to ensure that the sensor measurement value only includes gravity and inertia force.
5. The method of claim 1, wherein the method further comprises: in step S2, when the gravity and the moment of gravity are resolved along the sensor coordinate system, the direction of the gravity of the robot end effector does not coincide with the Z direction of the sensor coordinate system, and the gravity is projected in three directions of the sensor coordinate system according to the posture of the robot end effector.
6. The method of claim 1, wherein the method further comprises: in step S2, FmeasAnd TmeasRespectively subtracting the gravity value G 'and the gravity moment T', and specifically:
Finert_x＝Fmeas_x-G′x；
Finert_y＝Fmeas_y-G′y；
Finert_z＝Fmeas_z-G′z；
Tinert_x＝Tmeas_x-T′x；
Tinert_y＝Tmeas_y-T′y；
Tinert_z＝Tmeas_z-T′z。
7. the method of claim 1, wherein the method further comprises: in step S3, the discrete sequence of measurements is determined by a least squares method
And
fitting to obtain an inertia force compensation parameter M, wherein M is mass corresponding to translational motion, M is rotational motion, and M is rotational inertia, and in the F ═ Ma, when R is>(n +1), the least squares method is an over-determined equation whose solution is: m ═ aTa)-1aTF, wherein the dimension of F is [ R ]]Dimension of a [ R ]]And R is the number of rows of data.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110226160.8A CN112975971B (en) | 2021-03-01 | 2021-03-01 | Robot inertia force compensation method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110226160.8A CN112975971B (en) | 2021-03-01 | 2021-03-01 | Robot inertia force compensation method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112975971A CN112975971A (en) | 2021-06-18 |
| CN112975971B true CN112975971B (en) | 2022-03-11 |
Family
ID=76351617
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110226160.8A Active CN112975971B (en) | 2021-03-01 | 2021-03-01 | Robot inertia force compensation method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112975971B (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113829350B (en) * | 2021-10-12 | 2023-03-14 | 北京卫星环境工程研究所 | Method for compensating inertial force of spacecraft assembling robot |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2009088828A1 (en) * | 2007-12-31 | 2009-07-16 | Abb Research Ltd. | Method and apparatus using a force sensor to provide load compensation for a robot |
| CN104339351A (en) * | 2013-08-05 | 2015-02-11 | 株式会社东芝 | Robot control device |
| CN106313044A (en) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | Feedforward torque compensating method used for industrial robot |
| CN106918438A (en) * | 2017-03-31 | 2017-07-04 | 中国空气动力研究与发展中心高速空气动力研究所 | The measuring method and system of a kind of multi -components power and torque |
| CN107708937A (en) * | 2015-06-22 | 2018-02-16 | 三菱电机株式会社 | Calibrating installation and the robot system using the calibrating installation |
| WO2019171516A1 (en) * | 2018-03-07 | 2019-09-12 | 株式会社Ｆｕｊｉ | Inertial parameter identification system of vertically articulated robot, inertial parameter identification method, and control device and control method for vertically articulated robot |
| CN110411641A (en) * | 2019-08-13 | 2019-11-05 | 上海交通大学 | Six-dimensional force/torque sensor, compensation device and method |
| CN110450143A (en) * | 2019-08-02 | 2019-11-15 | 珞石（北京）科技有限公司 | workpiece fatigue testing method based on cooperative robot |
-
2021
- 2021-03-01 CN CN202110226160.8A patent/CN112975971B/en active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2009088828A1 (en) * | 2007-12-31 | 2009-07-16 | Abb Research Ltd. | Method and apparatus using a force sensor to provide load compensation for a robot |
| CN104339351A (en) * | 2013-08-05 | 2015-02-11 | 株式会社东芝 | Robot control device |
| CN107708937A (en) * | 2015-06-22 | 2018-02-16 | 三菱电机株式会社 | Calibrating installation and the robot system using the calibrating installation |
| CN106313044A (en) * | 2016-09-20 | 2017-01-11 | 华南理工大学 | Feedforward torque compensating method used for industrial robot |
| CN106918438A (en) * | 2017-03-31 | 2017-07-04 | 中国空气动力研究与发展中心高速空气动力研究所 | The measuring method and system of a kind of multi -components power and torque |
| WO2019171516A1 (en) * | 2018-03-07 | 2019-09-12 | 株式会社Ｆｕｊｉ | Inertial parameter identification system of vertically articulated robot, inertial parameter identification method, and control device and control method for vertically articulated robot |
| CN110450143A (en) * | 2019-08-02 | 2019-11-15 | 珞石（北京）科技有限公司 | workpiece fatigue testing method based on cooperative robot |
| CN110411641A (en) * | 2019-08-13 | 2019-11-05 | 上海交通大学 | Six-dimensional force/torque sensor, compensation device and method |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112975971A (en) | 2021-06-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107042528B (en) | A kind of Kinematic Calibration system and method for industrial robot | |
| CN112873199B (en) | Robot absolute positioning precision calibration method based on kinematics and spatial interpolation | |
| JP5321532B2 (en) | Robot calibration apparatus and calibration method | |
| US11465288B2 (en) | Method of controlling robot | |
| JP4829359B2 (en) | Calculation method of probe mounting position of on-machine measuring device | |
| CN107703748B (en) | Heavy-load robot static stiffness identification method based on offset plate design | |
| CN113927599B (en) | Absolute precision compensation method, system, device and computer readable storage medium | |
| KR20080088165A (en) | Robot calibration method | |
| JP5215378B2 (en) | Robot control device that controls force using a triaxial force sensor | |
| WO2006086021A2 (en) | Method and system to provide improved accuracies in multi-jointed robots through kinematic robot model parameters determination | |
| CN113977578B (en) | Soft measurement method for end force of hydraulic mechanical arm | |
| JP6044511B2 (en) | Robot control method and robot system | |
| KR20110004788A (en) | Method and apparatus for operating a manipulator | |
| US11707842B2 (en) | Robot system and coordinate conversion method | |
| KR101987823B1 (en) | Dual Arm Robot System | |
| CN112975971B (en) | Robot inertia force compensation method | |
| Ahmad et al. | Shape recovery from robot contour-tracking with force feedback | |
| Ding et al. | In situ calibration of six-axis force–torque sensors for industrial robots with tilting base | |
| Chavez et al. | Model based in situ calibration of six axis force torque sensors | |
| CN107263463B (en) | Mechanism parameter correction method for robot arm system | |
| JPH06143171A (en) | Robot | |
| JPH0433006A (en) | Control method for robot system | |
| WO2022025060A1 (en) | Robot control device | |
| CN115139305A (en) | Six-dimensional force sensor offset compensation method and system | |
| Tavakoli et al. | Self calibration of step-by-step based climbing robots |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |