CN112518745A - Robot TCP rapid calibration method - Google Patents

Robot TCP rapid calibration method Download PDF

Info

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
Application number
CN202011336145.0A
Other languages
Chinese (zh)
Other versions
CN112518745B (en
Inventor
杨跞
王琰
李法设
张一楠
汪宇星
许楠
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Siasun Co Ltd
Original Assignee
Siasun Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Siasun Co Ltd filed Critical Siasun Co Ltd
Priority to CN202011336145.0A priority Critical patent/CN112518745B/en
Publication of CN112518745A publication Critical patent/CN112518745A/en
Application granted granted Critical
Publication of CN112518745B publication Critical patent/CN112518745B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • 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

Robot TCP rapid calibration method
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:
Figure BDA0002797202790000021
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,
Figure BDA0002797202790000022
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:
Figure BDA0002797202790000031
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,
Figure BDA0002797202790000032
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:
Figure BDA0002797202790000033
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,
Figure BDA0002797202790000034
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:
Figure BDA0002797202790000051
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,
Figure BDA0002797202790000052
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:
Figure BDA0002797202790000053
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,
Figure BDA0002797202790000054
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:
Figure BDA0002797202790000061
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,
Figure BDA0002797202790000062
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:
Figure FDA0002797202780000011
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating contact of robot tipThe moment of force is generated by the motor,
Figure FDA0002797202780000012
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:
Figure FDA0002797202780000021
wherein the content of the first and second substances,endFendindicating the contact force of the robot tip,endMendindicating the contact moment of the robot tip,
Figure FDA0002797202780000022
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:
Figure FDA0002797202780000023
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,
Figure FDA0002797202780000024
CN202011336145.0A 2020-11-25 2020-11-25 Robot TCP rapid calibration method Active CN112518745B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (5)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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
US8726708B2 (en) Roller hemming device using robot manipulator with force sensor
US10350758B2 (en) Robot control unit for assembly robot
US7508155B2 (en) Controller
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
CN110666799A (en) Six-degree-of-freedom series robot compliance control method based on gravity compensation
EP2159654A1 (en) Automatic finishing machine and control method thereof
CN109124769B (en) Method and system for calibrating and controlling coordinate system of surgical robot
CN107796276B (en) Device and method for estimating absolute positioning accuracy of industrial robot
JP2018039099A (en) Workpiece contact state estimating device and contact state estimation method
CN112518745B (en) Robot TCP rapid calibration method
JP4997145B2 (en) Power assist device and control method thereof
JPH04233602A (en) Deflection correcting system for robot
JP2774939B2 (en) Robot tool parameter derivation method and calibration method
CN102768006A (en) Method for automatically measuring and adjusting large-curvature curve part in normal direction
CN113927599A (en) Absolute precision compensation method, system, device and computer readable storage medium
CN111267143A (en) Six-degree-of-freedom industrial series robot joint stiffness identification method and system
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
CN112902898A (en) Three-dimensional measuring device and applicable mechanical arm correction method
CN115139305A (en) Six-dimensional force sensor offset compensation method and system
WO2018088199A1 (en) Robot control device, robot, robotic system, and robotic control method

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