CN112975971A - Robot inertia force compensation method - Google Patents
Robot inertia force compensation method Download PDFInfo
- Publication number
- CN112975971A CN112975971A CN202110226160.8A CN202110226160A CN112975971A CN 112975971 A CN112975971 A CN 112975971A CN 202110226160 A CN202110226160 A CN 202110226160A CN 112975971 A CN112975971 A CN 112975971A
- 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.)
- Granted
Links
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 following steps of obtaining acceleration, obtaining inertia force, and establishing 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, including planning the robotThe tail end moves linearly, the starting point and the end point of the tail end are determined, and a motion trail parameter equation is established asSampling 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.
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 isThe total time of the linear motion of the tail end of the robot is T, wherein all points on the linear segment between the two points are positioned on the robot to doIn the 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 parametersAnd a sequence of discrete points
Wherein A is 2 pi L/T2,ω=2π/T;
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 methodAndfitting 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 the acceleration, including planning the end of the robot to do linear motion, anddetermining the starting point and the end point of the motion track, and establishing a motion track parameter equation ofSampling 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 twoDetermining 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 parameterAnd 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 profileDeriving t by the linear equation s (t):
c. as shown in FIG. 4, a sequence of acceleration discrete points is calculated for the acceleration curveDeriving t by the velocity equation v (t):
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 methodAndfitting 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=-TinertFor compensation of inertial forces with load measurement, improving the calculation for implementing compensationEfficiency.
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 asSampling 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 inertiaMapping between 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 isThe 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.
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 parametersAnd a sequence of discrete points
Wherein A is 2 pi L/T2,ω=2π/T;
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 methodAndfitting 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 true CN112975971A (en) | 2021-06-18 |
CN112975971B 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) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113829350A (en) * | 2021-10-12 | 2021-12-24 | 北京卫星环境工程研究所 | 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 | 株式会社Fuji | 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 | 株式会社Fuji | 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 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113829350A (en) * | 2021-10-12 | 2021-12-24 | 北京卫星环境工程研究所 | Method for compensating inertial force of spacecraft assembling robot |
Also Published As
Publication number | Publication date |
---|---|
CN112975971B (en) | 2022-03-11 |
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 | |
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 | |
JP5215378B2 (en) | Robot control device that controls force using a triaxial force sensor | |
KR20080088165A (en) | Robot calibration method | |
WO2006086021A2 (en) | Method and system to provide improved accuracies in multi-jointed robots through kinematic robot model parameters determination | |
JP6044511B2 (en) | Robot control method and robot system | |
CN113977578B (en) | Soft measurement method for end force of hydraulic mechanical arm | |
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 | |
JP2016052699A (en) | Robot control system and robot control method | |
JPH10301609A (en) | Position error detection method for robot and device therefor | |
CN107263463B (en) | Mechanism parameter correction method for robot arm system | |
JPH06143171A (en) | Robot | |
Malzahn et al. | Link elasticity exploited for payload estimation and force control | |
JPH0433006A (en) | Control method for robot system | |
CN115139305A (en) | Six-dimensional force sensor offset compensation method and system |
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 |