CN112518745A - Robot TCP rapid calibration method - Google Patents
Robot TCP rapid calibration method Download PDFInfo
- Publication number
- CN112518745A CN112518745A CN202011336145.0A CN202011336145A CN112518745A CN 112518745 A CN112518745 A CN 112518745A CN 202011336145 A CN202011336145 A CN 202011336145A CN 112518745 A CN112518745 A CN 112518745A
- Authority
- CN
- China
- Prior art keywords
- robot
- sensor
- force
- moment
- coordinate system
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 239000013598 vector Substances 0.000 claims description 15
- 239000011159 matrix material Substances 0.000 claims description 10
- 230000009466 transformation Effects 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 abstract 1
- 230000008569 process Effects 0.000 description 4
- 230000036544 posture Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 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
-
- 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/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
A rapid calibration method for a robot TCP (transmission control protocol) is characterized in that the contact force and moment information of the tail end of the robot is utilized to estimate the TCP coordinate, the description of the force and moment borne by the TCP in a coordinate system of the tail end of the robot is measured, and then a constraint equation is solved to obtain the coordinate value of the TCP in the coordinate system of the tail end of the robot. The method can measure the TCP coordinate value only by one-time contact, thereby saving the calibration time; the calibration can be automatically completed by the controller without manual alignment or calibration; there is no form and precision requirement for the fixed surface.
Description
Technical Field
The invention relates to the technical field of robot control, in particular to a rapid calibration method for a robot TCP.
Background
Patent 106502208A describes a TCP calibration method for an industrial robot, which requires teaching the robot to align TCP at the same fixed point under different postures, and then fitting out TCP coordinates by a least square method. Patent 105509671B describes a calibration method for TCP of a robot using a planar calibration plate, which requires the robot to contact TCP with the calibration plate more than 6 times at different postures. The TCP coordinates are then obtained by solving the constraint equations.
The prior art has the defects that:
(1) the robot needs to be taught for multiple times to coincide with a fixed point or a fixed surface in different postures, the calibration process is complicated, and the calibration precision is difficult to ensure because the robot is aligned in a manual mode; meanwhile, as the robot moves in a position control mode, a tool or a calibration plate can be damaged in the alignment process of the robot TCP;
(2) the precision requirement on the calibration tool is high, because the final TCP calibration precision is influenced;
(3) for a tool with certain flexibility, the deformation of the tool in the alignment process cannot be controlled, so that the calibration result is inaccurate.
Disclosure of Invention
The disclosure provides a robot TCP rapid calibration method, which can realize rapid calibration between TCP and a robot terminal coordinate system.
The invention provides a rapid calibration method for a robot TCP, which comprises the following steps:
setting the magnitude of the calibration contact force according to the rigidity or hardness of the robot tool and the calibration surface;
adjusting the tail end attitude of the robot to ensure that the contact force vector cannot be positioned in the x-y, y-z and x-z planes of the force sensor coordinate system;
controlling the TCP to move to a position close to the calibration surface, and then switching the robot to a force control mode;
controlling the tail end of the robot to contact with the calibration surface, and keeping the contact force above and below a set value;
when the contact force of the tail end of the robot is detected to enter a set range, acquiring the contact force and the moment of the tail end of the robot within a period of time, and solving the average value of the force and the moment;
and obtaining the final TCP coordinate according to the average value of the force and the moment.
Alternatively, in the case where a six-dimensional force sensor is integrated at the end of the robot, i.e. the coordinate system of the sensor coincides with the end coordinate system of the robot, the contact force and moment at the end of the robot are directly obtained from the six-dimensional force sensor.
Alternatively, when a six-dimensional force sensor is additionally installed at the robot tip, that is, the coordinate system of the sensor does not coincide with the tip coordinate system of the robot, the contact force and moment of the robot tip are obtained by the following methods:
wherein,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,a rotation transformation matrix representing the force sensor coordinate system to the robot tip coordinate system,endPsensorrepresenting the coordinates of the robot end coordinate system origin in the force sensor coordinate system,sensorFsensorwhich is indicative of the force to which the force sensor is subjected,sensorMsensorrepresenting the moment experienced by the force sensor.
Alternatively, in the case where the robot is equipped with a joint torque sensor, the contact force and torque of the robot tip are calculated from the joint torque of the robot by the following formula, that is, by
Fend=J·(τsensor-τrobot)
Wherein, FendRepresenting forces and moments (6-dimensional vectors) at the end of the robot, J representing the Jacobian matrix of the robot, τsensorRepresenting the moment, τ, received by a joint moment sensor of the robotrobotRepresenting the moment acting on the joint moment sensor due to the dynamics of the robot itself, which can be derived from the newton-euler method.
Alternatively, in the case where a six-dimensional force sensor is installed at a robot base, the contact force and moment of the robot tip are calculated by the following formulas:
wherein,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,a rotation transformation matrix representing a base coordinate system to an end coordinate system of the robot,endPbaserepresenting the coordinates of the origin of the coordinate system of the robot end in the base coordinate system,sensorFsensorindicating the forces to which the robot base is subjected,sensorMsensorthe moment applied to the robot base is shown,baseFbaserepresenting the forces acting on the base force sensor due to the dynamics of the robot itself,baseMbaserepresenting the moment acting on the base force sensor due to the dynamics of the robot itself, saidbaseFbaseAndbaseMbasethe values of (c) can be derived from the newton-euler equation.
Optionally, the coordinates of TCP in the robot end coordinate system are calculated according to the following formula:
wherein r is a coordinate of a force action point in a robot terminal coordinate system and a 3-dimensional vector; m is the contact moment of the tail end of the robot, and is a 3-dimensional vector; f is the contact force of the robot tip, a 3-dimensional vector,
according to the TCP quick calibration method provided by the disclosure, the TCP coordinates are calibrated by utilizing the contact force and moment information of the tail end of the robot, and as long as the description of the force and moment borne by the TCP in the coordinate system of the tail end of the robot can be measured, the coordinate values of the TCP in the coordinate system of the tail end of the robot can be obtained by solving a constraint equation. Compared with the prior art, the beneficial effect of this disclosure is: firstly, the contact force and moment information of the tail end of the robot are adopted to calculate the TCP coordinate, and the TCP coordinate value can be measured only by one-time contact, so that the calibration time is saved; secondly, the calibration can be automatically completed by the controller without manual point alignment or calibration, and meanwhile, no form and precision requirements are required on the fixed surface; and thirdly, for a tool with certain flexibility, the TCP calibration precision can be ensured through a force control mode.
Drawings
The foregoing and other objects, features and advantages of the disclosure will be apparent from the following more particular descriptions of exemplary embodiments of the disclosure as illustrated in the accompanying drawings wherein like reference numbers generally represent like parts throughout the exemplary embodiments of the disclosure.
Fig. 1 shows a flowchart of a robot TCP fast calibration method according to an exemplary embodiment.
Detailed Description
Preferred embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. While the preferred embodiments of the present disclosure are shown in the drawings, it should be understood that the present disclosure may be embodied in various forms and should not be limited to the embodiments set forth herein. Rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the scope of the disclosure to those skilled in the art.
Fig. 1 shows a flowchart of a robot TCP fast calibration method according to an exemplary embodiment, including the following steps:
s101: and setting the value of the calibrated contact force according to the rigidity or hardness of the robot tool and the calibrated surface.
S102: and adjusting the tail end attitude of the robot to meet the calibration requirement, namely ensuring that the contact force vector cannot be positioned in the x-y, y-z and x-z planes of the coordinate system of the force sensor.
S103: the control robot TCP is moved to a position close to the calibration surface and then the control mode of the robot is switched to the force control mode.
S104: and starting calibration, controlling the robot to move towards the calibration surface until the tail end of the robot is contacted with the calibration surface, and keeping the contact force above and below a set value, namely maintaining the contact force.
S105: when the contact force of the tail end of the robot is detected to enter a certain range above and below a set value, the contact force and the moment of the tail end of the robot in a period of time are collected.
Optionally: (1) in case the robot tip is integrated with a six-dimensional force sensor, i.e. the coordinate system of the sensor coincides with the tip coordinate system of the robot, the contact forces and moments of said robot tip are directly obtained from the six-dimensional force sensor.
(2) When a six-dimensional force sensor is additionally installed at the tail end of the robot, namely, when a coordinate system of the sensor does not coincide with a tail end coordinate system of the robot, the contact force and the moment of the tail end of the robot are obtained by the following methods:
wherein,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,a rotation transformation matrix representing the force sensor coordinate system to the robot tip coordinate system,endPsensorrepresenting the coordinates of the robot end coordinate system origin in the force sensor coordinate system,sensorFsensorwhich is indicative of the force to which the force sensor is subjected,sensorMsensorrepresenting the moment experienced by the force sensor.
(3) For the condition that the robot is provided with a joint moment sensor, the contact force and moment of the tail end of the robot are calculated by the joint moment of the robot through the Jacobian matrix of the robot, namely
Fend=J·(τsensor-τrobot)
Wherein, FendRepresenting forces and moments (6-dimensional vectors) at the end of the robot, J representing the Jacobian matrix of the robot, τsensorRepresenting the moment, τ, received by a joint moment sensor of the robotrobotRepresenting the moment acting on the joint moment sensor due to the dynamics of the robot itself, which can be derived from the newton-euler method.
(4) For the case where a six-dimensional force sensor is installed at a robot base, the contact force and moment of the robot tip are calculated by the following formulas:
wherein,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,a rotation transformation matrix representing a base coordinate system to an end coordinate system of the robot,endPbaserepresenting the coordinates of the origin of the coordinate system of the robot end in the base coordinate system,sensorFsensorindicating the forces to which the robot base is subjected,sensorMsensorthe moment applied to the robot base is shown,baseFbaserepresenting the forces acting on the base force sensor due to the dynamics of the robot itself,baseMbaserepresenting the moment acting on the base force sensor due to the dynamics of the robot itself,baseFbaseandbaseMbasethe values of (c) can be derived from the newton-euler equation.
S106: from each set of force and moment values, an average of the force and moment is calculated.
S107: according to the force and moment average value obtained by calculation, the final TCP coordinate is obtained
After the mean values of the robot terminal force and the moment are obtained, the coordinates of the TCP in the robot terminal coordinate system can be calculated according to the following formula:
wherein r is the coordinate (3-dimensional vector) of the action point of the force in the robot terminal coordinate system, M is the contact moment (3-dimensional vector) of the robot terminal, F is the contact force (3-dimensional vector) of the robot terminal,
because the robot runs in a force control mode in the process that the TCP is in contact with the fixed surface, the method can ensure that the contact force is within a certain threshold value range. Thus, for tools with some flexibility, the present method can still be employed.
According to the rapid calibration method for the TCP of the robot, the description of the force and the moment applied to the TCP in the terminal coordinate system of the robot is measured, and then the coordinate value of the TCP in the terminal coordinate system of the robot is obtained by solving a constraint equation. Compared with the prior art, the beneficial effect of this disclosure is:
the TCP coordinate is calculated by adopting the tail end force and moment information, and the TCP coordinate value can be measured only by one-time contact, so that the calibration time is saved. And calibration can be automatically finished by the controller without manual point alignment or calibration. Meanwhile, no form and precision requirements are required on the fixed surface. And thirdly, for a tool with certain flexibility, the TCP calibration precision can be ensured through a force control mode.
The foregoing is illustrative of the present invention and various modifications and changes in form or detail will readily occur to those skilled in the art based upon the teachings herein and the application of the principles and principles disclosed herein, which are to be regarded as illustrative rather than restrictive on the broad principles of the present invention.
Claims (6)
1. A robot TCP quick calibration method is characterized by comprising the following steps:
setting the magnitude of the calibration contact force according to the rigidity or hardness of the robot tool and the calibration surface;
adjusting the tail end attitude of the robot to ensure that the contact force vector cannot be positioned in the x-y, y-z and x-z planes of the force sensor coordinate system;
controlling the TCP to move to a position close to the calibration surface, and then switching the robot to a force control mode;
controlling the tail end of the robot to contact with the calibration surface, and keeping the contact force above and below a set value;
when the contact force of the tail end of the robot is detected to enter a set range, acquiring the contact force and the moment of the tail end of the robot within a period of time, and solving the average value of the force and the moment;
and obtaining the final TCP coordinate according to the average value of the force and the moment.
2. The robot TCP quick calibration method according to claim 1, wherein in the case that a six-dimensional force sensor is integrated at the end of the robot, that is, the coordinate system of the sensor coincides with the end coordinate system of the robot, the contact force and the moment at the end of the robot are directly obtained from the six-dimensional force sensor.
3. The robot TCP quick calibration method according to claim 1, characterized in that, when a six-dimensional force sensor is additionally installed at the tail end of the robot, that is, the coordinate system of the sensor does not coincide with the tail end coordinate system of the robot, the contact force and moment of the tail end of the robot are obtained by the following method:
wherein,endFendindicating the contact force of the robot tip,endMendindicating contact of robot tipThe moment of force is generated by the motor,a rotation transformation matrix representing the force sensor coordinate system to the robot tip coordinate system,endPsensorrepresenting the coordinates of the robot end coordinate system origin in the force sensor coordinate system,sensorFsensorwhich is indicative of the force to which the force sensor is subjected,sensorMsensorrepresenting the moment experienced by the force sensor.
4. The TCP quick calibration method for the robot according to claim 1, wherein for the case that the robot is installed with a joint torque sensor, the contact force and torque of the robot end are calculated from the joint torque of the robot by the following formula, that is, the contact force and torque are calculated
Fend=J·(τsensor-τrobot)
Wherein, FendRepresenting forces and moments (6-dimensional vectors) at the end of the robot, J representing the Jacobian matrix of the robot, τsensorRepresenting the moment, τ, received by a joint moment sensor of the robotrobotRepresenting the moment acting on the joint moment sensor due to the dynamics of the robot itself, which can be derived from the newton-euler method.
5. The robot TCP quick calibration method according to claim 1, wherein for the case that a six-dimensional force sensor is installed on a robot base, the contact force and moment of the robot end are calculated by the following formulas:
wherein,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,a rotation transformation matrix representing a base coordinate system to an end coordinate system of the robot,endPbaserepresenting the coordinates of the origin of the coordinate system of the robot end in the base coordinate system,sensorFsensorindicating the forces to which the robot base is subjected,sensorMsensorthe moment applied to the robot base is shown,baseFbaserepresenting the forces acting on the base force sensor due to the dynamics of the robot itself,baseMbaserepresenting the moment acting on the base force sensor due to the dynamics of the robot itself, saidbaseFbaseAndbaseMbasethe values of (c) can be derived from the newton-euler equation.
6. A robot TCP quick calibration method according to any one of claims 2-5, characterized by calculating the coordinates of TCP in the robot end coordinate system according to the following formula:
wherein r is a coordinate of a force action point in a robot terminal coordinate system and a 3-dimensional vector; m is the contact moment of the tail end of the robot, and is a 3-dimensional vector; f is the contact force of the robot tip, a 3-dimensional vector,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011336145.0A CN112518745B (en) | 2020-11-25 | 2020-11-25 | Robot TCP rapid calibration method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011336145.0A CN112518745B (en) | 2020-11-25 | 2020-11-25 | Robot TCP rapid calibration method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112518745A true CN112518745A (en) | 2021-03-19 |
CN112518745B CN112518745B (en) | 2022-06-10 |
Family
ID=74993265
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011336145.0A Active CN112518745B (en) | 2020-11-25 | 2020-11-25 | Robot TCP rapid calibration method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112518745B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114211483A (en) * | 2021-11-17 | 2022-03-22 | 合肥联宝信息技术有限公司 | Robot tool center point calibration method, device and storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5129044A (en) * | 1988-03-01 | 1992-07-07 | Hitachi Construction Machinery Co., Ltd. | Position/force controlling apparatus for working machine with multiple of degrees of freedom |
JP2012013537A (en) * | 2010-06-30 | 2012-01-19 | Canon Inc | Method of calibrating force sensor |
CN109483556A (en) * | 2018-10-30 | 2019-03-19 | 武汉大学 | A kind of robot polishing system and method based on learning from instruction |
CN109822574A (en) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | A kind of method of industrial robot end six-dimension force sensor calibration |
CN111624941A (en) * | 2020-06-15 | 2020-09-04 | 吉林大学 | Unknown environment-oriented six-degree-of-freedom robot power control method |
-
2020
- 2020-11-25 CN CN202011336145.0A patent/CN112518745B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5129044A (en) * | 1988-03-01 | 1992-07-07 | Hitachi Construction Machinery Co., Ltd. | Position/force controlling apparatus for working machine with multiple of degrees of freedom |
JP2012013537A (en) * | 2010-06-30 | 2012-01-19 | Canon Inc | Method of calibrating force sensor |
CN109483556A (en) * | 2018-10-30 | 2019-03-19 | 武汉大学 | A kind of robot polishing system and method based on learning from instruction |
CN109822574A (en) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | A kind of method of industrial robot end six-dimension force sensor calibration |
CN111624941A (en) * | 2020-06-15 | 2020-09-04 | 吉林大学 | Unknown environment-oriented six-degree-of-freedom robot power control method |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114211483A (en) * | 2021-11-17 | 2022-03-22 | 合肥联宝信息技术有限公司 | Robot tool center point calibration method, device and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN112518745B (en) | 2022-06-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107225569B (en) | Positioning device | |
US10350758B2 (en) | Robot control unit for assembly robot | |
US8726708B2 (en) | Roller hemming device using robot manipulator with force sensor | |
CN108789404B (en) | Vision-based serial robot kinematic parameter calibration method | |
JP3946711B2 (en) | Robot system | |
US4831549A (en) | Device and method for correction of robot inaccuracy | |
WO2004026537A3 (en) | Method and device for producing a connecting area on a production part | |
US20210197396A1 (en) | Method for measuring pose of robotic end tool | |
US20070210740A1 (en) | Controller | |
EP2837472A2 (en) | Robot system, robot control apparatus, method for controlling robot | |
CN109124769B (en) | Method and system for calibrating and controlling coordinate system of surgical robot | |
EP2159654A1 (en) | Automatic finishing machine and control method thereof | |
JP2018039099A (en) | Workpiece contact state estimating device and contact state estimation method | |
WO2016110320A1 (en) | Method for estimation of external forces and torques on a robot arm | |
CN112518745B (en) | Robot TCP rapid calibration method | |
CN110142762B (en) | Robot joint position control method and device and robot | |
US20180207755A1 (en) | Gear mechanism assembly apparatus and assembly method | |
KR20120038641A (en) | Apparatus and method for robot direct teaching using removable teaching handle and tool coordinate system transformation | |
JP2774939B2 (en) | Robot tool parameter derivation method and calibration method | |
JPH04233602A (en) | Deflection correcting system for robot | |
CN114012724B (en) | Automatic calibration method for industrial robot coordinate system based on probe | |
CN113799130B (en) | Robot pose calibration method in man-machine cooperation assembly | |
CN109397259B (en) | Method for determining an absolute position of a robot device and robot device | |
Sarić et al. | Reducing uncertainty in robotic surface assembly tasks based on contact information | |
KR100752782B1 (en) | System and method for three dimensional printing about work position of robot |
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 |