CN112518745B - 机器人tcp快速标定方法 - Google Patents
机器人tcp快速标定方法 Download PDFInfo
- Publication number
- CN112518745B CN112518745B CN202011336145.0A CN202011336145A CN112518745B CN 112518745 B CN112518745 B CN 112518745B CN 202011336145 A CN202011336145 A CN 202011336145A CN 112518745 B CN112518745 B CN 112518745B
- Authority
- CN
- China
- Prior art keywords
- robot
- force
- coordinate system
- moment
- sensor
- 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 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
一种机器人TCP快速标定方法,该方法利用机器人末端的接触力和力矩信息对TCP坐标进行估计,通过测出TCP所受力和力矩在机器人末端坐标系中的描述,然后通过求解约束方程即可求得TCP在机器人末端坐标系中的坐标值。该方法只需要一次接触就可以测得TCP坐标值,节省标定时间;无需人工进行对点或者校准,可以由控制器自动完成标定;对固定面没有形式及精度要求。
Description
技术领域
本发明涉及机器人控制技术领域,特别涉及一种机器人TCP快速标定方法。
背景技术
专利106502208A描述了一种工业机器人TCP标定方法,需要示教机器人在不同的姿态下将TCP对准同一固定点,然后通过最小二乘方法拟合出TCP坐标。专利105509671B描述了一种利用平面标定板的机器人TCP标定方法,需要机器人在不同的姿态下将TCP与标定板接触6次以上。然后通过求解约束方程获得TCP坐标。
背景技术存在的缺陷:
(1)需要多次示教机器人以不同的姿态与固定点或者固定面重合,标定过程繁琐,且由于是采用人工的方式去进行对准,很难保证标定精度;同时,由于机器人是以位置控制的方式进行运动的,在机器人TCP对准过程中可会造成工具或者标定板损坏;
(2)对标定工具的精度要求较高,因为会影响最终的TCP标定精度;
(3)对于具有一定柔性的工具,无法控制在对准过程中工具的变形量,导致标定结果不准确。
发明内容
本公开提供一种机器人TCP快速标定方法,其能够实现TCP与机器人末端坐标系之间的快速标定。
本公开提供一种机器人TCP快速标定方法,包括以下步骤:
根据机器人工具及标定面的刚度或硬度,设置标定接触力的大小;
调整机器人末端姿态,保证接触力矢量不能位于力传感器坐标系的x-y、y-z和x-z平面内;
控制机器人TCP移动至接近标定面的位置,然后切换机器人至力控制模式;
控制机器人末端与标定面接触,并使接触力保持在设定值上下;
当检测到机器人末端的接触力进入设定范围内时,采集一段时间内机器人末端的接触力和力矩,并求取力和力矩的平均值;
根据所述力和力矩的平均值,求得最终的TCP坐标。
可选的,在机器人末端集成有六维力传感器的情况下,即传感器的坐标系与机器人的末端坐标系重合,所述机器人末端的接触力和力矩直接从六维力传感器获取。
可选地,在机器人末端附加安装有六维力传感器的情况下,即传感器的坐标系与机器人的末端坐标系不重合,通过以下方法求得机器人末端的接触力和力矩:
其中,endFend表示机器人末端的接触力,endMend表示机器人末端的接触力矩,表示力传感器坐标系到机器人末端坐标系的旋转变换矩阵,endPsensor表示机器人末端坐标系原点在力传感器坐标系中的坐标,sensorFsensor表示力传感器所受的力,sensorMsensor表示力传感器所受的力矩。
可选地,对于机器人安装有关节力矩传感器的情况,通过以下公式,由机器人的关节力矩计算出所述机器人末端的接触力和力矩,即
Fend=J·(τsensor-τrobot)
其中,Fend表示机器人末端的力和力矩(6维向量),J表示机器人的雅克比矩阵,τsensor表示机器人的关节力矩传感器收到的力矩,τrobot表示由于机器人自身的动力学特性作用在关节力矩传感器上的力矩,该值可由牛顿-欧拉方法推导得出。
可选地,对于在机器人底座安装有六维力传感器的情况,通过以下公式计算所述机器人末端的接触力和力矩:
其中,endFend表示机器人末端的接触力,endMend表示机器人末端的接触力矩,表示机器人基坐标系到末端坐标系的旋转变换矩阵,endPbase表示机器人末端坐标系原点在基坐标系中坐标,sensorFsensor表示机器人底座所受的力,sensorMsensor表示机器人底座所受的力矩,baseFbase表示由于机器人自身的动力学特性作用在底座力传感器上的力,baseMbase表示由于机器人自身的动力学特性作用在底座力传感器上的力矩,所述baseFbase和baseMbase的值都可由牛顿-欧拉方程推导得出。
可选地,根据以下公式计算TCP在机器人末端坐标系中的坐标:
其中,r为力的作用点在机器人末端坐标系中的坐标,3维向量;M是机器人末端的接触力矩,3维向量;F是机器人末端的接触力,3维向量,
本公开提供的TCP快速标定方法,利用机器人末端的接触力和力矩信息对TCP坐标进行标定,只要能够测出TCP所受力和力矩在机器人末端坐标系中的描述,就可以通过求解约束方程来求得TCP在机器人末端坐标系中的坐标值。与现有技术相比,本公开的有益效果是:①采用机器人末端接触力和力矩信息计算TCP坐标,只需要一次接触就可以测得TCP坐标值,节省标定时间;②无需人工进行对点或者校准,可以由控制器自动完成标定,同时对固定面没有形式及精度要求;③对于具有一定柔性的工具,可以通过力控制模式保证TCP标定精度。
附图说明
通过结合附图对本公开示例性实施例进行更详细的描述,本公开的上述以及其它目的、特征和优势将变得更加明显,其中,在本公开示例性实施例方式中,相同的参考标号通常代表相同部件。
图1显示根据示例性实施例的机器人TCP快速标定方法流程图。
具体实施方式
下面将参照附图更详细地描述本公开的优选实施例。虽然附图中显示了本公开的优选实施例,然而应该理解,可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反,提供这些实施例是为了使本公开更加透彻和完整,并且能够将本公开的范围完整地传达给本领域的技术人员。
图1显示根据示例性实施例的机器人TCP快速标定方法的流程图,包括以下步骤:
S101:根据机器人工具及标定面的刚度或硬度,设置标定接触力的值。
S102:调整机器人末端姿态,使其符合标定要求,即保证接触力矢量不能位于力传感器坐标系的x-y、y-z和x-z平面内。
S103:控制机器人TCP移动至接近标定面的位置,然后切换机器人的控制模式至力控制模式。
S104:启动标定,控制机器人往标定面运动至末端与标定面接触,并使接触力保持在设定值上下,即维持接触力。
S105:当检测到机器人末端的接触力进入设定值上下一定范围内时,采集一段时间内机器人末端的接触力和力矩。
可选的:(1)在机器人末端集成有六维力传感器的情况下,即传感器的坐标系与机器人的末端坐标系重合的情况下,所述机器人末端的接触力和力矩直接从六维力传感器获取。
(2)在机器人末端附加安装有六维力传感器的情况下,即传感器的坐标系与机器人的末端坐标系不重合的情况下,通过以下方法求得机器人末端的接触力和力矩:
其中,endFend表示机器人末端的接触力,endMend表示机器人末端的接触力矩,表示力传感器坐标系到机器人末端坐标系的旋转变换矩阵,endPsensor表示机器人末端坐标系原点在力传感器坐标系中的坐标,sensorFsensor表示力传感器所受的力,sensorMsensor表示力传感器所受的力矩。
(3)对于机器人安装有关节力矩传感器的情况,通过机器人的雅克比矩阵,由机器人的关节力矩计算出所述机器人末端的接触力和力矩,即
Fend=J·(τsensor-τrobot)
其中,Fend表示机器人末端的力和力矩(6维向量),J表示机器人的雅克比矩阵,τsensor表示机器人的关节力矩传感器收到的力矩,τrobot表示由于机器人自身的动力学特性作用在关节力矩传感器上的力矩,该值可由牛顿-欧拉方法推导得出。
(4)对于在机器人底座安装有六维力传感器的情况,通过以下公式计算所述机器人末端的接触力和力矩:
其中,endFend表示机器人末端的接触力,endMend表示机器人末端的接触力矩,表示机器人基坐标系到末端坐标系的旋转变换矩阵,endPbase表示机器人末端坐标系原点在基坐标系中坐标,sensorFsensor表示机器人底座所受的力,sensorMsensor表示机器人底座所受的力矩,baseFbase表示由于机器人自身的动力学特性作用在底座力传感器上的力,baseMbase表示由于机器人自身的动力学特性作用在底座力传感器上的力矩,baseFbase和baseMbase的值都可由牛顿-欧拉方程推导得出。
S106:根据每一组力和力矩值,计算力和力矩的平均值。
S107:根据计算得到的力和力矩平均值,求得最终的TCP坐标
在得到机器人末端力和力矩均值后,具体可以根据以下公式计算TCP在机器人末端坐标系中的坐标:
其中,r为力的作用点在机器人末端坐标系中的坐标(3维向量),M是机器人末端的接触力矩(3维向量),F是机器人末端的接触力(3维向量),
由于该方法在TCP与固定面接触的过程中机器人是运行在力控制模式,可以保证在接触力在一定的阈值范围内。因此,对于具有一定柔性的工具,仍然可以采用本方法。
根据示例性实施例的机器人TCP快速标定方法,通过测出TCP所受力和力矩在机器人末端坐标系中的描述,进而通过求解约束方程来求得TCP在机器人末端坐标系中的坐标值。与现有技术相比,本公开的有益效果是:
①采用末端力和力矩信息计算TCP坐标,只需要一次接触就可以测得TCP坐标值,节省标定时间。②无需人工进行对点或者校准,可以由控制器自动完成标定。同时对固定面没有形式及精度要求。③对于具有一定柔性的工具,可以通过力控制模式保证TCP标定精度。
上述技术方案只是本发明的示例性实施例,对于本领域内的技术人员而言,在本发明公开了应用方法和原理的基础上,很容易做出各种类型的改进或变形,而不仅限于本发明上述具体实施例所描述的方法,因此前面描述的方式只是优选的,而并不具有限制性的意义。
Claims (6)
1.一种机器人TCP快速标定方法,其特征在于,包括以下步骤:
根据机器人工具及标定面的刚度或硬度,设置标定接触力的大小;
调整机器人末端姿态,保证接触力矢量不能位于力传感器坐标系的x-y、y-z和x-z平面内;
控制机器人TCP移动至接近标定面的位置,然后切换机器人至力控制模式;
控制机器人末端与标定面接触,并使接触力保持在设定值上下;
当检测到机器人末端的接触力进入设定范围内时,采集一段时间内机器人末端的接触力和力矩,并求取力和力矩的平均值;
根据所述力和力矩的平均值,求得最终的TCP坐标;
其中,所述机器人末端的接触力和力矩获取手段包括:机器人末端集成有六维力传感器,或机器人末端附加安装有六维力传感器,或者机器人安装有关节力矩传感器,或者机器人底座安装有六维力传感器。
2.根据权利要求1所述的机器人TCP快速标定方法,其特征在于,在机器人末端集成有六维力传感器的情况下,即传感器的坐标系与机器人的末端坐标系重合,所述机器人末端的接触力和力矩直接从六维力传感器获取。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011336145.0A CN112518745B (zh) | 2020-11-25 | 2020-11-25 | 机器人tcp快速标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011336145.0A CN112518745B (zh) | 2020-11-25 | 2020-11-25 | 机器人tcp快速标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112518745A CN112518745A (zh) | 2021-03-19 |
CN112518745B true CN112518745B (zh) | 2022-06-10 |
Family
ID=74993265
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011336145.0A Active CN112518745B (zh) | 2020-11-25 | 2020-11-25 | 机器人tcp快速标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112518745B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114211483A (zh) * | 2021-11-17 | 2022-03-22 | 合肥联宝信息技术有限公司 | 一种机器人工具中心点标定方法、设备及存储介质 |
Family Cites Families (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 |
JP5550468B2 (ja) * | 2010-06-30 | 2014-07-16 | キヤノン株式会社 | 力覚センサの校正方法 |
CN109483556B (zh) * | 2018-10-30 | 2021-04-16 | 武汉大学 | 一种基于示教学习的机器人打磨***及方法 |
CN109822574B (zh) * | 2019-03-20 | 2021-01-05 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
CN111624941A (zh) * | 2020-06-15 | 2020-09-04 | 吉林大学 | 一种面向未知环境的六自由度机器人力控方法 |
-
2020
- 2020-11-25 CN CN202011336145.0A patent/CN112518745B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112518745A (zh) | 2021-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107225569B (zh) | 定位装置 | |
CN108789404B (zh) | 一种基于视觉的串联机器人运动学参数标定方法 | |
US10695910B2 (en) | Automatic calibration method for robot system | |
US10350758B2 (en) | Robot control unit for assembly robot | |
JP5321532B2 (ja) | ロボットキャリブレーション装置及びキャリブレーション方法 | |
JP3946711B2 (ja) | ロボットシステム | |
US8726708B2 (en) | Roller hemming device using robot manipulator with force sensor | |
CN109124769B (zh) | 手术机器人的坐标系标定、控制的方法及*** | |
US20210197396A1 (en) | Method for measuring pose of robotic end tool | |
WO2004026537A3 (de) | Verfahren und vorrichtung zum herstellen eines verbindungsbereichs auf einem werkstück | |
US20150045953A1 (en) | Robot system, robot control apparatus, method for controlling robot | |
EP2159654A1 (en) | Automatic finishing machine and control method thereof | |
JP2007237312A (ja) | 制御装置 | |
CN112518745B (zh) | 机器人tcp快速标定方法 | |
US20180207755A1 (en) | Gear mechanism assembly apparatus and assembly method | |
CN110142762B (zh) | 一种机器人关节位置控制方法、装置和机器人 | |
JPH04233602A (ja) | ロボットのたわみ補正方法及びたわみ認識方法 | |
JP2774939B2 (ja) | ロボットのツールパラメータ導出方法及び較正方法 | |
KR20120038641A (ko) | 착탈식 교시 핸들 및 공구 좌표계 변환을 이용한 로봇 직접교시 장치 및 방법 | |
WO2021141039A1 (ja) | ワーク搬送システム | |
CN116423526B (zh) | 一种机械臂工具坐标的自动标定方法及***、存储介质 | |
CN112902898B (zh) | 三维测量装置及所适用的机械手臂的校正方法 | |
CN113799130B (zh) | 一种人机协作装配中的机器人位姿标定方法 | |
CN114012724B (zh) | 一种基于探针的工业机器人坐标系自动标定方法 | |
CN109397259B (zh) | 用于确定机器人设备的绝对位置的方法和机器人设备 |
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 |