CN117067221B - 基于六自由度工业机器人误差模型和交叉辨识方法及装置 - Google Patents
基于六自由度工业机器人误差模型和交叉辨识方法及装置 Download PDFInfo
- Publication number
- CN117067221B CN117067221B CN202311330263.4A CN202311330263A CN117067221B CN 117067221 B CN117067221 B CN 117067221B CN 202311330263 A CN202311330263 A CN 202311330263A CN 117067221 B CN117067221 B CN 117067221B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- parameters
- representing
- industrial robot
- parameter
- 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 75
- 238000005259 measurement Methods 0.000 claims abstract description 65
- 238000012897 Levenberg–Marquardt algorithm Methods 0.000 claims abstract description 12
- 230000009466 transformation Effects 0.000 claims description 119
- 239000011159 matrix material Substances 0.000 claims description 108
- 238000013519 translation Methods 0.000 claims description 40
- 238000006243 chemical reaction Methods 0.000 claims description 10
- 238000010276 construction Methods 0.000 claims description 8
- 238000004804 winding Methods 0.000 claims description 7
- 230000015654 memory Effects 0.000 description 5
- 238000003860 storage Methods 0.000 description 5
- 238000005457 optimization Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 239000013598 vector Substances 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001568 sexual effect Effects 0.000 description 1
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/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于六自由度工业机器人误差模型和交叉辨识方法及装置,涉及工业机器人校准技术领域。包括:获取待辨识的几何参数,将几何参数分为线性参数和非线性参数;构建几何参数误差模型;根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。本发明通过引入工具坐标相对于法兰坐标系、基坐标系相对于测量坐标系的标定误差,建立了更完善的工业机器人几何参数误差模型。同时,设计了基Levenberg Marquardt算法的交叉辨识策略,能准确标定工业机器人的实际连杆结构参数,从而提高工业机器人末端位置精度和姿态精度。
Description
技术领域
本发明涉及工业机器人校准技术领域,尤其涉及一种基于六自由度工业机器人误差模型和交叉辨识方法及装置。
背景技术
工业机器人在自动化生产中扮演着重要角色,能够代替人类从事重复性强的工作。然而,工业机器人的绝对定位精度通常较低,并且随运行时间的增加会衰减,这对产品质量产生不利影响。为了提高工业机器人的位姿精度,需要进行误差建模和参数标定。
现有的工业机器人误差建模和参数标定方法主要基于MDH(Modified Denavit-Hartenberg,改进的DH参数)模型和LM (Levenberg Marquardt,列文伯格-马夸尔特)算法,其中MDH模型通过定义连杆长度、连杆偏距、连杆纽角和关节转角等参数来描述相邻关节之间的空间坐标变换关系。然而,现有方法存在一些问题:首先,这些方法主要关注位置误差,忽略了姿态精度对于一些精密任务的影响,这在需要精确姿态控制的操作中是不可忽视的;其次,当工具坐标系和测量坐标系的标定不够准确时,基于MDH模型法的辨识结果通常与工业机器人实际连杆结构参数差异较大,导致校准后机器人末端位姿精度提升有限;此外,受工具坐标系、测量坐标系标定误差和其他随机噪声的影响,工业机器人参数辨识容易陷入局部最优,从而导致校准的准确性和鲁棒性不足。
发明内容
本发明针对如何建立一种全面考虑位姿精度和坐标系标定误差在内的工业机器人几何误差模型,并进行准确的参数辨识的问题,提出了本发明。
为解决上述技术问题,本发明提供如下技术方案:
一方面,本发明提供了一种基于六自由度工业机器人误差模型和交叉辨识方法,该方法由电子设备实现,该方法包括:
S1、获取待辨识的几何参数,将几何参数分为线性参数和非线性参数。
S2、构建几何参数误差模型。
S3、根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。
可选地,S2中的几何参数误差模型的构建过程,包括:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数;其中,坐标系包括:测量坐标系MCF、基坐标系BCF、关节坐标系JCF、法兰坐标系FCF和工具坐标系TCF。
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程。
S23、根据坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差。
S24、根据旋转参数和平移参数,计算法兰坐标系相对基坐标系的第一微分变换矩阵、基坐标系相对测量坐标系的第二微分变换矩阵以及工具坐标系相对于法兰坐标系的第三微分变换矩阵,根据第一微分变换矩阵、第二微分变换矩阵、第三微分变换矩阵以及工具末端的位姿误差,得到工具坐标系相对于测量坐标系的微分变换矩阵,进而建立工业机器人的几何参数误差模型。
可选地,S21中的坐标系间的变换关系包括:BCF相对于MCF的变换、TCF相对于FCF的变换/>、FCF相对于BCF的变换/>以及TCF相对于MCF的变换/>。
可选地,S21中的旋转参数包括:基坐标系相对于测量坐标系的旋转参数以及工具坐标系相对于法兰坐标系的旋转参数/>。
平移参数包括:基坐标系相对于测量坐标系的平移参数以及工具坐标系相对于法兰坐标系的平移参数/>。
可选地,S22中的连杆结构参数包括:连杆长度、连杆偏距/>、关节转角/>、关节纽角/>和绕/>轴旋转角/>。
可选地,S24中的法兰坐标系相对基坐标系的微分变换矩阵,如下式(1)所示:
(1)
其中,表示机器人自由度,/>表示相邻两关节坐标系的变换关系,/>表示相邻关节坐标系的微分变换矩阵,/>表示工业机器人关节i的关节转角偏差、/>表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的绕/>轴旋转角偏差、表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的连杆偏距偏差,表示基于连杆参数偏差计算得到的关节转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的绕/>轴旋转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的连杆偏距矩阵、/>表示基于连杆参数偏差计算得到的矩阵,/>表示/>偏差,表示连杆结构参数。
可选地,S24中的基坐标系相对测量坐标系的微分变换矩阵,如下式(2)所示:
(2)
其中, 表示基坐标系相对于测量坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,S24中的工具坐标系相对于法兰坐标系的微分变换矩阵,如下式(3)所示:
(3)
其中, 表示工业机器人工具坐标系相对于法兰坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,S3中的根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果,包括:
S31、基于微分旋转参数,获取几何参数误差模型中与非线性参数相关的等式,构建线性方程组,利用列文伯格-马夸尔特Levenberg Marquardt算法对线性方程组进行求解,得到辨识到的非线性参数。
S32、基于位置误差和微分旋转参数/>,将辨识到的非线性参数作为初始值,根据几何参数交叉辨识方法以及几何参数误差模型,得到辨识到的线性参数和非线性参数。
S33、重复步骤S31和步骤S32,直到满足预设的迭代停止条件,得到几何参数的辨识结果。
另一方面,本发明提供了一种基于六自由度工业机器人误差模型和交叉辨识装置,该装置应用于实现基于六自由度工业机器人误差模型和交叉辨识方法,该装置包括:
获取模块,用于获取待辨识的几何参数,将几何参数分为线性参数和非线性参数。
构建模块,用于构建几何参数误差模型。
输出模块,用于根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。
可选地,构建模块,进一步用于:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数;其中,坐标系包括:测量坐标系MCF、基坐标系BCF、关节坐标系JCF、法兰坐标系FCF和工具坐标系TCF。
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程。
S23、根据坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差。
S24、根据旋转参数和平移参数,计算法兰坐标系相对基坐标系的第一微分变换矩阵、基坐标系相对测量坐标系的第二微分变换矩阵以及工具坐标系相对于法兰坐标系的第三微分变换矩阵,根据第一微分变换矩阵、第二微分变换矩阵、第三微分变换矩阵以及工具末端的位姿误差,得到工具坐标系相对于测量坐标系的微分变换矩阵,进而建立工业机器人的几何参数误差模型。
可选地,坐标系间的变换关系包括:BCF相对于MCF的变换、TCF相对于FCF的变换/>、FCF相对于BCF的变换/>以及TCF相对于MCF的变换/>。
可选地,旋转参数包括:基坐标系相对于测量坐标系的旋转参数以及工具坐标系相对于法兰坐标系的旋转参数/>。
平移参数包括:基坐标系相对于测量坐标系的平移参数以及工具坐标系相对于法兰坐标系的平移参数/>。
可选地,连杆结构参数包括:连杆长度、连杆偏距/>、关节转角/>、关节纽角和绕/>轴旋转角/>。
可选地,法兰坐标系相对基坐标系的微分变换矩阵,如下式(1)所示:
(1)
其中,表示机器人自由度,/>表示相邻两关节坐标系的变换关系,/>表示相邻关节坐标系的微分变换矩阵,/>表示工业机器人关节i的关节转角偏差、/>表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的绕/>轴旋转角偏差、/>表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的连杆偏距偏差,/>表示基于连杆参数偏差计算得到的关节转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的绕/>轴旋转角矩阵、表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的连杆偏距矩阵、/>表示基于连杆参数偏差计算得到的矩阵,/>表示/>偏差,表示连杆结构参数。
可选地,基坐标系相对测量坐标系的微分变换矩阵,如下式(2)所示:
(2)
其中, 表示基坐标系相对于测量坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,工具坐标系相对于法兰坐标系的微分变换矩阵,如下式(3)所示:
(3)
其中, 表示工业机器人工具坐标系相对于法兰坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,输出模块,进一步用于:
S31、基于微分旋转参数,获取几何参数误差模型中与非线性参数相关的等式,构建线性方程组,利用列文伯格-马夸尔特Levenberg Marquardt算法对线性方程组进行求解,得到辨识到的非线性参数。
S32、基于位置误差和微分旋转参数/>,将辨识到的非线性参数作为初始值,根据几何参数交叉辨识方法以及几何参数误差模型,得到辨识到的线性参数和非线性参数。
S33、重复步骤S31和步骤S32,直到满足预设的迭代停止条件,得到几何参数的辨识结果。
一方面,提供了一种电子设备,所述电子设备包括处理器和存储器,所述存储器中存储有至少一条指令,所述至少一条指令由所述处理器加载并执行以实现上述基于六自由度工业机器人误差模型和交叉辨识方法。
一方面,提供了一种计算机可读存储介质,所述存储介质中存储有至少一条指令,所述至少一条指令由处理器加载并执行以实现上述基于六自由度工业机器人误差模型和交叉辨识方法。
上述技术方案,与现有技术相比至少具有如下有益效果:
上述方案,提出一种基于六自由度位姿的工业机器人误差模型和交叉辨识方法。所提出的基于六自由度位姿的工业机器人几何参数误差模型考虑了工具坐标系和测量坐标系发标定误差,可以解决由于坐标系标定精度不高引起的工业机器人连杆结构参数辨识精度不高的问题。而且,该几何参数误差模型综合考虑位置误差和姿态误差,不仅可用于提高工业机器人位置精度,还可以用于提高姿态精度。所提出的基于Levenberg Marquardt算法的几何参数交叉辨识方法根据微分旋转先辨识与角度相关的非线性参数,再以其为初始值辨识所有待求几何参数,解决了同时辨识几何参数时由于线性参数、非线性参数相互干扰导致的局部最优问题。因此,和同时辨识所有参数策略相比,本发明提出的交叉辨识方案更容易逃出局部极值,收敛域更广,辨识结果的精度更高。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的基于六自由度工业机器人误差模型和交叉辨识方法流程示意图;
图2是本发明实施例提供的工业机器人校准过程中所涉及的坐标系及其变换定义;
图3是本发明实施例提供的、/>、/>、/>和/>的计算方式;
图4是本发明实施例提供的、/>、/>、/>、/>和/>的计算方式;
图5是本发明实施例提供的基于Levenberg Marquardt算法的几何参数交叉辨识方法流程图;
图6是本发明实施例提供的基于六自由度工业机器人误差模型和交叉辨识装置框图;
图7是本发明实施例提供的一种电子设备的结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例的附图,对本发明实施例的技术方案进行清楚、完整地描述。显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于所描述的本发明的实施例,本领域普通技术人员在无需创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,本发明实施例提供了一种基于六自由度工业机器人误差模型和交叉辨识方法,该方法可以由电子设备实现。如图1所示的基于六自由度工业机器人误差模型和交叉辨识方法流程图,该方法的处理流程可以包括如下的步骤:
S1、获取待辨识的几何参数,将几何参数分为线性参数和非线性参数。
其中,几何参数可以包括BCF相对于MCF的变换的6个参数、TCF相对于FCF的变换/>的6个参数/>以及连杆结构参数/>。
线性参数可以包括、/>、/>和,非线性参数则指与角度相关的参数,可以包括/>、、/>、/>和/>。
进一步地,姿态误差仅与非线性参数相关,位置误差则和线性参数及非线性参数都相关。
S2、构建几何参数误差模型。
一种可行的实施方式中,基于MDH模型,考虑位置精度和姿态精度,并引入测量坐标系和工具坐标系的标定误差,建立了新的工业机器人几何参数误差模型。
可选地,S2中的几何参数误差模型的构建过程可以包括S21- S24:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数。
其中,如图2所示,坐标系包括:测量坐标系(Measure Coordinate Frame, MCF)、基坐标系(Base Coordinate Frame, BCF)、关节坐标系(Joint Coordinate Frame, JCF)、法兰坐标系(Flange Coordinate Frame, FCF)和工具坐标系(Tool Coordinate Frame,TCF)。
进一步地,BCF建立在工业机器人底座上,其相对于MCF的变换被定义为,需事先标定且存在标定误差;TCF固定在工具末端上,其相对FCF的变换被定义为/>, 也需事先标定且存在标误差;FCF相对于BCF的变换被定义为/>,其等于相邻关节坐标系(JCF)变换的顺序相乘;TCF相对于MCF的变换被定义为/>,其表示TCF在MCF的位姿。
坐标系间的变换关系包括:BCF相对于MCF的变换、TCF相对于FCF的变换/>、FCF相对于BCF的变换/>以及TCF相对于MCF的变换/>。
进一步度,相对于测量坐标系的变换需事先标定且存在标定误差;所述的工具坐标系固定在工具末端上,其相对于法兰坐标系的变换/>也需事先标定且同样存在标定误差。
旋转参数包括:基坐标系相对于测量坐标系的旋转参数以及工具坐标系相对于法兰坐标系的旋转参数/>。
平移参数包括:基坐标系相对于测量坐标系的平移参数以及工具坐标系相对于法兰坐标系的平移参数/>。
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程。
其中,连杆结构参数包括:连杆长度、连杆偏距/>、关节转角/>、关节纽角/>和绕/>轴旋转角/>。绕/>轴旋转角/>,仅在相邻两关节轴线平行时或近似平行时才存在,并且理论值为0。
进一步地,基于MDH模型的相邻两关节坐标系的变换关系为:
(1)
对于自由度工业机器人,其正向运动学方程为:
(2)
本发明提出了一种基于六自由度位姿的工业机器人几何参数误差模型。该误差模型综合考虑了位置误差和姿态误差,并针对工具坐标系和测量坐标系的标定误差进行建模。具体而言,该几何参数误差模型以MDH模型为基础,考虑了工具坐标系和测量坐标系的标定误差,能够更全面地描述测量坐标系下工具末端位姿误差和工业机器人几何参数偏差的关系。
S23、根据坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差。
一种可行的实施方式中,表示绕/>轴旋转的航向角,/>表示绕/>轴旋转的俯仰角,/>表示绕/>轴旋转的滚转角,包含旋转和平移的变换矩阵一般表示法如下:
(3)
记为/>、/>为/>,则工具坐标系在测量坐标系下的名义位姿为:
(4)
S24、通过求偏导数以及忽略高阶项获得法兰坐标系相对工业机器人基坐标系的微分变换阵、工业机器人基坐标系相对测量坐标系的微分变换矩阵、工具坐标系相对于法兰坐标系的微分变换矩阵以及工具末端的位姿误差,得到工具坐标系相对于测量坐标系微分变矩阵,进而建立工业机器人的几何参数误差模型。
可选地,设工业机器人关节的连杆参数偏差为/>,推导法兰坐标系相对工业机器人基坐标系的微分变换阵为/>。
则相邻关节变换矩阵的实际值与名义值的偏差为:
(5)
对于自由度机器人,当连杆参数存在偏差时,工业机器人法兰末端相对于基坐标系的位姿为:
(6)
于是,工业机器人法兰坐标系相对基坐标系的微分变换阵为:
(7)
其中,表示机器人自由度,/>表示相邻两关节坐标系的变换关系,/>表示相邻关节坐标系的微分变换矩阵,/>、/>、/>、/>、/>表示工业机器人关节i的连杆参数偏差,/>、/>、/>、/>、/>、/>表示基于连杆参数偏差计算得到的矩阵,计算方式如图3所示,/>表示/>偏差,/>表示连杆结构参数。
可选地,设工业机器人基坐标系相对于测量坐标系的平移误差和旋转误差为,推导工业机器人基坐标系相对测量坐标系的微分变换矩阵/>。
如图4是、/>、/>、/>、/>和/>的计算方式,则工业机器人基坐标系相对于测量坐标系的变换矩阵的实际值和名义值的偏差为:
(8)
于是,工业机器人基坐标系相对测量坐标系的微分变换矩阵为:
(9)
其中, 表示工业机器人基坐标系相对于测量坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,表示平移参数,/>表示旋转参数。
可选地,设工具坐标系相对于工业机器人法兰坐标系的平移误差和旋转误差为,推导工具坐标系相对于法兰坐标系的微分变换矩阵/>。
工具坐标系相对于工业机器人法兰坐标系的微分变换矩阵与/>相似,如下式(10)所示:
(10)
其中, 表示工业机器人工具坐标系相对于法兰坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
进一步地,结合微分变换矩阵,推导出工具坐标系相对于测量坐标系微分变换阵,然后利用微分变换阵/>建立工业机器人几何参数误差模型。
考虑基坐标系相对于测量坐标系、工具坐标系相对于法兰坐标系的变换矩阵存在标定误差,则工具坐标系在测量坐标系下的位姿为:
(11)
于是,工具坐标系相对于测量坐标系的微分变换阵为:
(12)
和/>取值如下:
(13)
(14)
进一步地,记工具坐标系相对于测量坐标系的微分平移为,记工具坐标系相对于测量坐标系的微分旋转为,则/>服从以下形式:/>
(15)
记工业机器人的连杆结构参数误差为,,/>,/>,。根据等式(15),可建立工业机器人几何参数误差模型如下:
(16)
其中,
(17)
等式(17)中,;/>表示取对应矩阵的第/>个元素组成列向量;/>表示取对应矩阵的第/>个元素组成的列向量;和/>为3×n矩阵;/>、/>、/>和/>为3×6矩阵。
S3、根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。
一种可行的实施方式中,针对几何参数同时辨识易陷入局部最优的缺点,提出了一种基于LM (Levenberg Marquardt,)算法的几何参数交叉辨识方法。
本发明所涉及基于Levenberg Marquardt算法的几何参数交叉辨识方法流程如图5所示。观察到,等式(17)中,矩阵的第一列为0,当以仅以微分平移/>为优化目标时,关节角/>无法辨识;/>和/>矩阵都为0,/>和/>的前三列也为0,当仅以微分旋转/>为优化目标时,连杆长度/>、连杆偏距/>、基坐标系相对测量坐标系的平移/>和工具坐标系相对法兰坐标系的平移/>无法辨识。综合考虑上述特征,为克服同时辨识所有几何参数时易陷入局部最优的问题,提出了基于Levenberg Marquardt算法的几何参数交叉辨识方法,可以包括如下步骤S31- S33:
S31、仅考虑微分旋转,获取几何参数误差模型中与非线性参数相关的等式(即等式(16)的后三列),构建线性方程组,利用列文伯格-马夸尔特Levenberg Marquardt算法对线性方程组进行求解,以初步辨识与角度相关的非线性参数。
S32、考虑位置误差和微分旋转/>,将辨识到的非线性参数作为初始值,根据几何参数交叉辨识方法以及几何参数误差模型,辨识所有待估的线性和非线性参数。其中,位置误差/>为工具坐标系在测量坐标系下的位置偏差,和微分平移/>有所区别,两者相差一个雅可比矩阵,当仅位置误差为优化目标时,关节角/>是可以辨识的。
S33、重复步骤S31和步骤S32,直到满足预设的迭代停止条件,得到几何参数的辨识结果。
本发明线性参数和非线性参数的辨识结果能够在较短时间内获得,并且具有更高的精度和更广的收敛域,相比于同时辨识所有参数的方法,能够更容易避免陷入局部最优解的问题。
本发明实施例中,提出一种基于六自由度位姿的工业机器人误差模型和交叉辨识方法。所提出的基于六自由度位姿的工业机器人几何参数误差模型考虑了工具坐标系和测量坐标系发标定误差,可以解决由于坐标系标定精度不高引起的工业机器人连杆结构参数辨识精度不高的问题。而且,该几何参数误差模型综合考虑位置误差和姿态误差,不仅可用于提高工业机器人位置精度,还可以用于提高姿态精度。所提出的基于LevenbergMarquardt算法的几何参数交叉辨识方法根据微分旋转先辨识与角度相关的非线性参数,再以其为初始值辨识所有待求几何参数,解决了同时辨识几何参数时由于线性参数、非线性参数相互干扰导致的局部最优问题。因此,和同时辨识所有参数策略相比,本发明提出的交叉辨识方案更容易逃出局部极值,收敛域更广,辨识结果的精度更高。
如图6所示,本发明实施例提供了一种基于六自由度工业机器人误差模型和交叉辨识装置600,该装置600应用于实现基于六自由度工业机器人误差模型和交叉辨识方法,该装置600包括:
获取模块610,用于获取待辨识的几何参数,将几何参数分为线性参数和非线性参数。
构建模块620,用于构建几何参数误差模型。
输出模块630,用于根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。
可选地,构建模块620,进一步用于:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数;其中,坐标系包括:测量坐标系MCF、基坐标系BCF、关节坐标系JCF、法兰坐标系FCF和工具坐标系TCF。
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程。
S23、根据坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差。
S24、根据旋转参数和平移参数,计算法兰坐标系相对基坐标系的第一微分变换矩阵、基坐标系相对测量坐标系的第二微分变换矩阵以及工具坐标系相对于法兰坐标系的第三微分变换矩阵,根据第一微分变换矩阵、第二微分变换矩阵、第三微分变换矩阵以及工具末端的位姿误差,得到工具坐标系相对于测量坐标系的微分变换矩阵,进而建立工业机器人的几何参数误差模型。
可选地,坐标系间的变换关系包括:BCF相对于MCF的变换、TCF相对于FCF的变换/>、FCF相对于BCF的变换/>以及TCF相对于MCF的变换/>。
可选地,旋转参数包括:基坐标系相对于测量坐标系的旋转参数以及工具坐标系相对于法兰坐标系的旋转参数/>。
平移参数包括:基坐标系相对于测量坐标系的平移参数以及工具坐标系相对于法兰坐标系的平移参数/>。
可选地,连杆结构参数包括:连杆长度、连杆偏距/>、关节转角/>、关节纽角和绕/>轴旋转角/>。
可选地,法兰坐标系相对基坐标系的微分变换矩阵,如下式(1)所示:
(1)
其中,表示机器人自由度,/>表示相邻两关节坐标系的变换关系,/>表示相邻关节坐标系的微分变换矩阵,/>表示工业机器人关节i的关节转角偏差、/>表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的绕/>轴旋转角偏差、表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的连杆偏距偏差,表示基于连杆参数偏差计算得到的关节转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的绕/>轴旋转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的连杆偏距矩阵、/>表示基于连杆参数偏差计算得到的矩阵,/>表示/>偏差,表示连杆结构参数。
可选地,基坐标系相对测量坐标系的微分变换矩阵,如下式(2)所示:
(2)
其中, 表示基坐标系相对于测量坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,工具坐标系相对于法兰坐标系的微分变换矩阵,如下式(3)所示:
(3)
其中, 表示工业机器人工具坐标系相对于法兰坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,/>表示旋转参数。
可选地,输出模块630,进一步用于:
S31、基于微分旋转参数,获取几何参数误差模型中与非线性参数相关的等式,构建线性方程组,利用列文伯格-马夸尔特Levenberg Marquardt算法对线性方程组进行求解,得到辨识到的非线性参数。
S32、基于位置误差和微分旋转参数/>,将辨识到的非线性参数作为初始值,根据几何参数交叉辨识方法以及几何参数误差模型,得到辨识到的线性参数和非线性参数。
S33、重复步骤S31和步骤S32,直到满足预设的迭代停止条件,得到几何参数的辨识结果。
本发明实施例中,提出一种基于六自由度位姿的工业机器人误差模型和交叉辨识方法。所提出的基于六自由度位姿的工业机器人几何参数误差模型考虑了工具坐标系和测量坐标系发标定误差,可以解决由于坐标系标定精度不高引起的工业机器人连杆结构参数辨识精度不高的问题。而且,该几何参数误差模型综合考虑位置误差和姿态误差,不仅可用于提高工业机器人位置精度,还可以用于提高姿态精度。所提出的基于LevenbergMarquardt算法的几何参数交叉辨识方法根据微分旋转先辨识与角度相关的非线性参数,再以其为初始值辨识所有待求几何参数,解决了同时辨识几何参数时由于线性参数、非线性参数相互干扰导致的局部最优问题。因此,和同时辨识所有参数策略相比,本发明提出的交叉辨识方案更容易逃出局部极值,收敛域更广,辨识结果的精度更高。
图7是本发明实施例提供的一种电子设备700的结构示意图,该电子设备700可因配置或性能不同而产生比较大的差异,可以包括一个或一个以上处理器(centralprocessing units,CPU)701和一个或一个以上的存储器702,其中,存储器702中存储有至少一条指令,至少一条指令由处理器701加载并执行以实现下述基于六自由度工业机器人误差模型和交叉辨识方法:
S1、获取待辨识的几何参数,将几何参数分为线性参数和非线性参数。
S2、构建几何参数误差模型。
S3、根据几何参数交叉辨识方法以及几何参数误差模型,对线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果。
在示例性实施例中,还提供了一种计算机可读存储介质,例如包括指令的存储器,上述指令可由终端中的处理器执行以完成上述基于六自由度工业机器人误差模型和交叉辨识方法。例如,计算机可读存储介质可以是ROM、随机存取存储器(RAM)、CD-ROM、磁带、软盘和光数据存储设备等。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成,也可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器,磁盘或光盘等。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种基于六自由度工业机器人误差模型的交叉辨识方法,其特征在于,所述方法包括:
S1、获取待辨识的几何参数,将所述几何参数分为线性参数和非线性参数;
S2、构建几何参数误差模型;
S3、根据几何参数交叉辨识方法以及所述几何参数误差模型,对所述线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果;
所述S2中的几何参数误差模型的构建过程,包括:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数;其中,所述坐标系包括:测量坐标系MCF、基坐标系BCF、关节坐标系JCF、法兰坐标系FCF和工具坐标系TCF;
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程;
S23、根据所述坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差;
S24、根据所述旋转参数和平移参数,计算法兰坐标系相对基坐标系的第一微分变换矩阵、基坐标系相对测量坐标系的第二微分变换矩阵以及工具坐标系相对于法兰坐标系的第三微分变换矩阵,根据所述第一微分变换矩阵、第二微分变换矩阵、第三微分变换矩阵以及所述工具末端的位姿误差,得到工具坐标系相对于测量坐标系的微分变换矩阵,进而建立工业机器人的几何参数误差模型。
2.根据权利要求1所述的方法,其特征在于,所述S21中的坐标系间的变换关系包括:BCF相对于MCF的变换、TCF相对于FCF的变换/>、FCF相对于BCF的变换/>以及TCF相对于MCF的变换/>。
3.根据权利要求1所述的方法,其特征在于,所述S21中的旋转参数包括:基坐标系相对于测量坐标系的旋转参数以及工具坐标系相对于法兰坐标系的旋转参数;
平移参数包括:基坐标系相对于测量坐标系的平移参数以及工具坐标系相对于法兰坐标系的平移参数/>。
4.根据权利要求1所述的方法,其特征在于,所述S22中的连杆结构参数包括:连杆长度、连杆偏距/>、关节转角/>、关节纽角/>和绕/>轴旋转角/>。
5.根据权利要求1所述的方法,其特征在于,所述S24中的法兰坐标系相对基坐标系的微分变换矩阵,如下式(1)所示:
(1)
其中,表示机器人自由度,/>表示相邻两关节坐标系的变换关系,/>表示相邻关节坐标系的微分变换矩阵,/>表示工业机器人关节i的关节转角偏差、/>表示工业机器人关节i的关节纽角偏差、/>表示工业机器人关节i的绕/>轴旋转角偏差、/>表示工业机器人关节i的连杆长度偏差、/>表示工业机器人关节i的连杆偏距偏差,/>表示基于连杆参数偏差计算得到的关节转角矩阵、/>表示基于连杆参数偏差计算得到的关节纽角矩阵、/>表示基于连杆参数偏差计算得到的绕/>轴旋转角矩阵、/>表示基于连杆参数偏差计算得到的连杆长度矩阵、/>表示基于连杆参数偏差计算得到的连杆偏距矩阵、/>表示基于连杆参数偏差计算得到的矩阵,/>表示/>偏差,/>表示连杆结构参数。
6.根据权利要求1所述的方法,其特征在于,所述S24中的基坐标系相对测量坐标系的微分变换矩阵,如下式(2)所示:
(2)
其中,表示基坐标系相对于测量坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,/>表示平移参数,表示旋转参数。
7.根据权利要求1所述的方法,其特征在于,所述S24中的工具坐标系相对于法兰坐标系的微分变换矩阵,如下式(3)所示:
(3)
其中,表示工业机器人工具坐标系相对于法兰坐标系的平移误差和旋转误差,/>表示基于平移误差和旋转误差计算得到的矩阵,表示平移参数,/>表示旋转参数。
8.根据权利要求1所述的方法,其特征在于,所述S3中的根据几何参数交叉辨识方法以及所述几何参数误差模型,对所述线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果,包括:
S31、基于微分旋转参数,获取所述几何参数误差模型中与非线性参数相关的等式,构建线性方程组,利用列文伯格-马夸尔特Levenberg Marquardt算法对所述线性方程组进行求解,得到辨识到的非线性参数;
S32、基于位置误差和微分旋转参数/>,将所述辨识到的非线性参数作为初始值,根据几何参数交叉辨识方法以及所述几何参数误差模型,得到辨识到的线性参数和非线性参数;
S33、重复步骤S31和步骤S32,直到满足预设的迭代停止条件,得到几何参数的辨识结果。
9.一种基于六自由度工业机器人误差模型的交叉辨识装置,其特征在于,所述装置包括:
获取模块,用于获取待辨识的几何参数,将所述几何参数分为线性参数和非线性参数;
构建模块,用于构建几何参数误差模型;
输出模块,用于根据几何参数交叉辨识方法以及所述几何参数误差模型,对所述线性参数和非线性参数进行交叉辨识,得到几何参数的辨识结果;
所述几何参数误差模型的构建过程,包括:
S21、定义工业机器人校准过程中的坐标系及坐标系间的变换关系;定义用于表示坐标系间的变换关系的旋转参数和平移参数;其中,所述坐标系包括:测量坐标系MCF、基坐标系BCF、关节坐标系JCF、法兰坐标系FCF和工具坐标系TCF;
S22、利用改进的DH参数MDH模型描述工业机器人的连杆结构参数,建立相邻两关节的坐标系间的变换关系,并通过顺序相乘计算工业机器人的正向运动学方程;
S23、根据所述坐标系间的变换关系以及正向运动学方程,计算工具坐标系在测量坐标系下的名义位姿,并与实际测量到的位姿进行比较,得到工具末端的位姿误差;
S24、根据所述旋转参数和平移参数,计算法兰坐标系相对基坐标系的第一微分变换矩阵、基坐标系相对测量坐标系的第二微分变换矩阵以及工具坐标系相对于法兰坐标系的第三微分变换矩阵,根据所述第一微分变换矩阵、第二微分变换矩阵、第三微分变换矩阵以及所述工具末端的位姿误差,得到工具坐标系相对于测量坐标系的微分变换矩阵,进而建立工业机器人的几何参数误差模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311330263.4A CN117067221B (zh) | 2023-10-16 | 2023-10-16 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311330263.4A CN117067221B (zh) | 2023-10-16 | 2023-10-16 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117067221A CN117067221A (zh) | 2023-11-17 |
CN117067221B true CN117067221B (zh) | 2024-02-09 |
Family
ID=88717472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311330263.4A Active CN117067221B (zh) | 2023-10-16 | 2023-10-16 | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117067221B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019168775A (ja) * | 2018-03-22 | 2019-10-03 | 三菱重工業株式会社 | パラメータ同定装置及びその方法並びにプログラム |
CN110815204A (zh) * | 2018-08-14 | 2020-02-21 | 中国科学院沈阳自动化研究所 | 一种工业机器人运动学标定方法 |
CN111055273A (zh) * | 2019-05-16 | 2020-04-24 | 广西大学 | 一种用于机器人的两步误差补偿方法 |
CN113119130A (zh) * | 2021-04-28 | 2021-07-16 | 浙江大学 | 一种面向工业机器人的几何误差辨识方法 |
CN114029959A (zh) * | 2021-12-13 | 2022-02-11 | 中国计量大学 | 一种机械臂结构参数辨识方法及装置 |
CN114147726A (zh) * | 2021-12-27 | 2022-03-08 | 哈尔滨工业大学 | 一种几何误差与非几何误差相结合的机器人标定方法 |
CN114714348A (zh) * | 2022-03-17 | 2022-07-08 | 浙江大学 | 一种工业机器人绝对定位精度提高方法 |
CN114833834A (zh) * | 2022-06-01 | 2022-08-02 | 浙江大学 | 一种基于多源误差建模的工业机器人精度补偿方法 |
CN114952861A (zh) * | 2022-06-27 | 2022-08-30 | 西南交通大学 | 基于位姿测量数据的机器人运动学参数误差精准辨识方法 |
-
2023
- 2023-10-16 CN CN202311330263.4A patent/CN117067221B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019168775A (ja) * | 2018-03-22 | 2019-10-03 | 三菱重工業株式会社 | パラメータ同定装置及びその方法並びにプログラム |
CN110815204A (zh) * | 2018-08-14 | 2020-02-21 | 中国科学院沈阳自动化研究所 | 一种工业机器人运动学标定方法 |
CN111055273A (zh) * | 2019-05-16 | 2020-04-24 | 广西大学 | 一种用于机器人的两步误差补偿方法 |
CN113119130A (zh) * | 2021-04-28 | 2021-07-16 | 浙江大学 | 一种面向工业机器人的几何误差辨识方法 |
CN114029959A (zh) * | 2021-12-13 | 2022-02-11 | 中国计量大学 | 一种机械臂结构参数辨识方法及装置 |
CN114147726A (zh) * | 2021-12-27 | 2022-03-08 | 哈尔滨工业大学 | 一种几何误差与非几何误差相结合的机器人标定方法 |
CN114714348A (zh) * | 2022-03-17 | 2022-07-08 | 浙江大学 | 一种工业机器人绝对定位精度提高方法 |
CN114833834A (zh) * | 2022-06-01 | 2022-08-02 | 浙江大学 | 一种基于多源误差建模的工业机器人精度补偿方法 |
CN114952861A (zh) * | 2022-06-27 | 2022-08-30 | 西南交通大学 | 基于位姿测量数据的机器人运动学参数误差精准辨识方法 |
Non-Patent Citations (1)
Title |
---|
机械臂全工作空间域非参数约束位姿误差估算;杨聚庆;王大勇;董登峰;程智;劳达宝;周维虎;;光学精密工程(第10期);2430-2437 * |
Also Published As
Publication number | Publication date |
---|---|
CN117067221A (zh) | 2023-11-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109249392B (zh) | 工件抓取系统的校准方法、标定件、装置、设备和介质 | |
EP3157715B1 (en) | Method for calibrating a robot and a robot system | |
CN108731591B (zh) | 一种基于平面约束的机器人工具坐标系标定方法 | |
CN113001535B (zh) | 机器人工件坐标系自动校正系统与方法 | |
CN111055273B (zh) | 一种用于机器人的两步误差补偿方法 | |
Wang et al. | Calibration method of robot base frame using unit quaternion form | |
CN108972543B (zh) | 自动高精度非接触式机器人tcp标定方法 | |
CN101239469A (zh) | 机器人机构的校准装置及方法 | |
CN107901038B (zh) | 一种位置标定方法、装置、双臂机器人及存储介质 | |
JP2774939B2 (ja) | ロボットのツールパラメータ導出方法及び較正方法 | |
TWI701123B (zh) | 機器人工件座標系自動校正系統與方法 | |
CN117067221B (zh) | 基于六自由度工业机器人误差模型和交叉辨识方法及装置 | |
CN113799130B (zh) | 一种人机协作装配中的机器人位姿标定方法 | |
TW202302301A (zh) | 機械手臂與輪廓感測器座標系相對關係之自動校正方法與系統 | |
Lapresté et al. | An efficient method to compute the inverse jacobian matrix in visual servoing | |
CN111687845A (zh) | 一种基于惯性测量单元的机械臂运动学参数标定方法 | |
CN114186189A (zh) | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 | |
JP2021012882A5 (zh) | ||
CN109397293B (zh) | 一种基于移动机器人的地面水平误差建模及补偿方法 | |
CN111604904A (zh) | 机器人的定位校准方法及装置、电子设备 | |
CN113442144B (zh) | 欠约束下的最优位姿确定方法、装置、存储介质及机械臂 | |
CN114453981A (zh) | 工件找正方法及装置 | |
CN112907505B (zh) | 一种水下机器人电缆三维形状估计方法 | |
CN108592838B (zh) | 工具坐标系的标定方法、装置以及计算机存储介质 | |
CN114186190A (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20240115 Address after: 100083 No. 30, Haidian District, Beijing, Xueyuan Road Applicant after: University OF SCIENCE AND TECHNOLOGY BEIJING Applicant after: Shunde Innovation College of Beijing University of Science and Technology Address before: 100083 No. 30, Haidian District, Beijing, Xueyuan Road Applicant before: University OF SCIENCE AND TECHNOLOGY BEIJING |
|
GR01 | Patent grant | ||
GR01 | Patent grant |