CN113510710A - 一种用于带有力传感器初始值的力牵引重力补偿方法 - Google Patents
一种用于带有力传感器初始值的力牵引重力补偿方法 Download PDFInfo
- Publication number
- CN113510710A CN113510710A CN202110873727.0A CN202110873727A CN113510710A CN 113510710 A CN113510710 A CN 113510710A CN 202110873727 A CN202110873727 A CN 202110873727A CN 113510710 A CN113510710 A CN 113510710A
- Authority
- CN
- China
- Prior art keywords
- force sensor
- dimensional force
- coordinate system
- axis
- dimensional
- 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
- 230000005484 gravity Effects 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000005259 measurement Methods 0.000 claims abstract description 13
- 230000036544 posture Effects 0.000 claims abstract description 13
- 230000009466 transformation Effects 0.000 claims abstract description 6
- 239000012636 effector Substances 0.000 claims description 19
- 239000011159 matrix material Substances 0.000 claims description 6
- 238000012935 Averaging Methods 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 210000004373 mandible Anatomy 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000011160 research 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
- 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)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明公开了一种用于带有力传感器初始值的力牵引重力补偿方法,包括:获取末端执行工具不受外力且机器人处于不同姿态下的多组六维力传感器测量数据;根据不同姿态下的六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数;根据六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在六维力传感器的坐标和六维力传感器力矩初始值;求解六维力传感器坐标系相对于机器人基坐标系的位姿变换;求解外界所施加给六维力传感器的力和力矩。用于有效对工具重力进行参数估计,实现工具重力补偿。
Description
技术领域
本发明涉及机器人力控技术领域,更具体的说是涉及用于带有力传感器初始值的力牵引重力补偿方法。
背景技术
在利用力传感器对机器人进行应用开发时,力传感器需要实时获取外界所施加的力和力矩。当力传感器连接工具时,力传感器会受工具重力及初始值的影响,无法实时获取外界所施加力的数据。在下颌骨截骨机器人力随动及力学安全监控系统中,对力传感器初始值及工具重力参数进行估计成为必要的工作。
由于力传感器工作方式的原因,力传感器在刚通电工作时,力传感器会受到温度等环境影响,初始值往往不固定,且力传感器末端往往连接着法兰和工具,无法实时获得力传感器的初始值,对力传感器初始值进行估计,可以通过拆卸工具和法兰,对力传感器的数值进行采集,求解平均值作为力传感器的初始值,但此种方法需要重复拆卸工具和法兰,增加了工作的繁琐性。为解决此问题,本发明提出不拆卸工具和法兰,利用参数估计的方法,对力传感器初始值进行估计。并且补充了机器人末端坐标系和力传感器坐标系的配准部分,以便提高重力补偿精度。
发明内容
有鉴于此,本发明提供了一种用于带有力传感器初始值的力牵引重力补偿方法,用于有效对工具重力进行参数估计,实现工具重力补偿。
为了实现上述目的,本发明采用如下技术方案:
一种用于带有力传感器初始值的力牵引重力补偿方法,包括:
获取末端执行工具不受外力且机器人处于不同姿态下的多组六维力传感器测量数据;
根据不同姿态下的所述多组六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数;
根据所述六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在所述六维力传感器的坐标和六维力传感器力矩初始值;
求解所述六维力传感器坐标系相对于机器人基坐标系的位姿变换;
求解末端执行工具不受外力时所施加给所述六维力传感器的力和力矩。
优选的,根据不同姿态下的所述六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数,具体包括:
从所述六维力传感器侧得的n组数据中选择d对不同的两组数据带入公式(1)中,a=1,2...d,d≥3;ai,aj≤n,ai≠aj,n≥4,其中 表示第a对数据中第i、j组六维力传感器测得数据的x、y、z轴力的大小,表示第a对数据中第i、j组六维力传感器测得数据的x、y、z轴力矩的大小;
构建方程为:
则:
优选的,根据所述六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在所述六维力传感器的坐标和六维力传感器力矩初始值,具体包括:
优选的,求解所述六维力传感器坐标系相对于机器人基坐标系的位姿变换,具体包括:
假设工具的重力方向一直竖直向下,且与机器人的基坐标系的z轴重合,方向相反。调整机器人的末端坐标系x轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:调整机器人的末端坐标系y轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:调整机器人的末端坐标系z轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:
设六维力学传感器坐标系为sensor,机器人末端坐标系为end,两者之间旋转矩阵为:
其中,ax、ox、nx为机器人末端坐标系x轴在六维力传感器坐标系中的方向余弦,ay、oy、ny为机器人末端坐标系y轴在六维力传感器坐标系中的方向余弦,az、oz、nz为机器人末端坐标系z轴在六维力传感器坐标系中的方向余弦。
由此实现力传感器坐标系和机器人末端坐标系之间的姿态配准。
优选的,求解外界所施加给所述六维力传感器的力和力矩,具体包括:
末端执行工具重力G在机器人本体基坐标系中的矢量方向为:
Gbase=[0 0 -1] (17)
经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种用于带有力传感器初始值的力牵引重力补偿方法,不拆卸力传感器末端的工具,就可以对力传感器初始值进行参数估计的方法。首先使机器人变换n种不同的姿态,获得力传感器测得的数据,根据不同姿态工具重力值为固定值构建方程组,并利用最小二乘法求解最优值,以此获得力传感器初始值参数,并根据重力分解公式求得工具重力对六维力传感器所施加的力,便可实时估计出所施加的力。将本发明应用到力传感器工具重力补偿,具有操作方便、应用普遍性等优点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1附图为一种应用于本发明重力补偿方法的结构示意图。
图2附图为本发明重力补偿方法流程图。
其中,1、机械臂;2、六维力传感器;3、末端执行工具。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种用于带有力传感器初始值的力牵引重力补偿方法,流程图如图2所示,包括:
S1:获取末端执行工具不受外力且机器人处于4种不同姿态下的多组六维力传感器测量数据,此时六维力传感器所显示的数据,包括工具重力加力传感器初始值以及力矩初始值,研究目的是从多组力传感器测量数据和机器人位姿中估计出力传感器初始值和工具重力等;机器人处于4种不同姿态下的六维力传感器xyz轴力和力矩的测量数据具体数值为:
S2:根据不同姿态下的六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数;具体的:
从六维力传感器侧得的4组数据中选择6对不同的两组数据
ai,aj≤n,ai≠aj,令ai,aj取代k带入(1),
其中:
构建方程为:
则:
求得:
S3:根据六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在六维力传感器的坐标和六维力传感器力矩初始值;具体的:
S4:求解六维力传感器坐标系相对于机器人基坐标系的位姿变换;具体的:
此处认为工具的重力方向一直竖直向下,且与机器人的基坐标系的z轴重合,方向相反,力学传感器坐标系z轴与机器人末端坐标系z轴方向相同。调整机器人的末端坐标系x轴与机器人基坐标系z轴重合,方向相反,获得力传感器的测量数据为:
S5:求解外界所施加给六维力传感器的力和力矩,具体的:
末端执行工具重力G在机器人本体基坐标系中的矢量方向为:
Gbase=[0 0 -1] (17)
末端执行工具重力G在六维力传感器坐标系的矢量方向为:
末端执行工具质心施加给六维力传感器的力和力矩为:
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (6)
1.一种用于带有力传感器初始值的力牵引重力补偿方法,其特征在于,包括:
获取末端执行工具不受外力且机器人处于不同姿态下的多组六维力传感器测量数据;
根据不同姿态下的所述六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数;
根据所述六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在所述六维力传感器的坐标和六维力传感器力矩初始值;
求解所述六维力传感器坐标系相对于机器人基坐标系的位姿变换;
求解末端执行工具不受外力时所施加给所述六维力传感器的力和力矩。
2.根据权利要求1所述的一种用于带有力传感器初始值的力牵引重力补偿方法,其特征在于,根据不同姿态下的所述六维力传感器测量数据为固定值建立方程组,并利用最小二乘法求解最优值,求得六维力传感器初始值参数,具体包括:
从所述六维力传感器测得的n组数据中选择d对不同的两组数据带入公式(1)中,a=1,2...d,d≥3;ai,aj≤n,ai≠aj,n≥4,其中 表示第a对数据中第i、j组六维力传感器测得数据的x、y、z轴力的大小,表示第a对数据中第i、j组六维力传感器测得数据的x、y、z轴力矩的大小;
构建方程为:
则:
3.根据权利要求2所述的一种用于带有力传感器初始值的力牵引重力补偿方法,其特征在于,根据所述六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在所述六维力传感器的坐标和六维力传感器力矩初始值,具体包括:
4.根据权利要求3所述的一种用于带有力传感器初始值的力牵引重力补偿方法,其特征在于,求解所述六维力传感器坐标系相对于机器人基坐标系的位姿变换,具体包括:
调整机器人的末端坐标系x轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:调整机器人的末端坐标系y轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:调整机器人的末端坐标系z轴与机器人基坐标系z轴重合,方向相反,获得六维力传感器xyz轴力和力矩测量数据为:
设六维力学传感器坐标系为sensor,机器人末端坐标系为end,两者之间旋转矩阵为:
其中,ax、ox、nx为机器人末端坐标系x轴在六维力传感器坐标系中的方向余弦,ay、oy、ny为机器人末端坐标系y轴在六维力传感器坐标系中的方向余弦,az、oz、nz为机器人末端坐标系z轴在六维力传感器坐标系中的方向余弦。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110873727.0A CN113510710B (zh) | 2021-07-30 | 2021-07-30 | 一种用于带有力传感器初始值的力牵引重力补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110873727.0A CN113510710B (zh) | 2021-07-30 | 2021-07-30 | 一种用于带有力传感器初始值的力牵引重力补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113510710A true CN113510710A (zh) | 2021-10-19 |
CN113510710B CN113510710B (zh) | 2022-12-13 |
Family
ID=78068754
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110873727.0A Active CN113510710B (zh) | 2021-07-30 | 2021-07-30 | 一种用于带有力传感器初始值的力牵引重力补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113510710B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114310878A (zh) * | 2021-12-22 | 2022-04-12 | 上海智能制造功能平台有限公司 | 基于力控的大质量零件人工引导装配方法、系统及介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN108789363A (zh) * | 2018-05-25 | 2018-11-13 | 雅客智慧(北京)科技有限公司 | 一种基于力传感器的直接拖动示教系统及方法 |
CN111590564A (zh) * | 2020-05-07 | 2020-08-28 | 北京控制工程研究所 | 一种六维力传感器重力补偿方法及系统 |
-
2021
- 2021-07-30 CN CN202110873727.0A patent/CN113510710B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN108789363A (zh) * | 2018-05-25 | 2018-11-13 | 雅客智慧(北京)科技有限公司 | 一种基于力传感器的直接拖动示教系统及方法 |
CN111590564A (zh) * | 2020-05-07 | 2020-08-28 | 北京控制工程研究所 | 一种六维力传感器重力补偿方法及系统 |
Non-Patent Citations (1)
Title |
---|
张昱东: "基于六维力传感器的机器人力控制方法研究", 《万方》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114310878A (zh) * | 2021-12-22 | 2022-04-12 | 上海智能制造功能平台有限公司 | 基于力控的大质量零件人工引导装配方法、系统及介质 |
CN114310878B (zh) * | 2021-12-22 | 2024-03-15 | 上海智能制造功能平台有限公司 | 基于力控的大质量零件人工引导装配方法、系统及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN113510710B (zh) | 2022-12-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111618857B (zh) | 一种机械臂的多负载自适应重力补偿方法 | |
CN109822574B (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN107717994B (zh) | 基于主从空间映射的主从异构机器人通用控制方法及系统 | |
CN107433590B (zh) | 一种基于机械臂负载质量和传感器零漂在线辨识的重力补偿方法 | |
CN107589934B (zh) | 一种关节型机械臂逆运动学解析解的求取方法 | |
US9969088B2 (en) | Force sensor correcting method | |
CN110716557B (zh) | 基于先验动力学知识的机器人参数识别及接触力监测方法 | |
CN108015774B (zh) | 一种无需传感器的机械臂碰撞检测方法 | |
CN107856014B (zh) | 基于手势识别的机械臂位姿控制方法 | |
CN110802585A (zh) | 机械臂末端传感器补偿方法及接触力/力矩测量方法 | |
CN114310880B (zh) | 一种机械臂标定方法及装置 | |
CN111618859A (zh) | 一种对于静止或低速工况下机械臂高精度力反馈的方法 | |
CN113189950B (zh) | 用于大型弱刚性结构件装配的双机器人协同柔顺装调方法 | |
CN113510710B (zh) | 一种用于带有力传感器初始值的力牵引重力补偿方法 | |
CN115157260B (zh) | 一种机械臂末端六维力传感器重力和惯性力补偿方法 | |
Zou et al. | An approach for peg-in-hole assembling based on force feedback control | |
CN113799130B (zh) | 一种人机协作装配中的机器人位姿标定方法 | |
CN114012716A (zh) | 一种基于视觉定位和力控制的工业机器人轴孔装配方法 | |
CN109311155B (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN109866224B (zh) | 一种机器人雅可比矩阵计算方法、装置及存储介质 | |
Xiong et al. | Dynamic surface control-backstepping based impedance control for 5-DOF flexible joint robots | |
CN113580131A (zh) | 一种基于动作映射的机械臂末端位姿控制装置及控制方法 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
CN113001069A (zh) | 一种六关节机器人的焊缝跟踪方法 | |
CN110053054B (zh) | 基于Android手机IMU的机械臂示教方法 |
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 |