CN114186189A - 坐标转换矩阵的计算方法、装置、设备及可读存储介质 - Google Patents
坐标转换矩阵的计算方法、装置、设备及可读存储介质 Download PDFInfo
- Publication number
- CN114186189A CN114186189A CN202111399313.5A CN202111399313A CN114186189A CN 114186189 A CN114186189 A CN 114186189A CN 202111399313 A CN202111399313 A CN 202111399313A CN 114186189 A CN114186189 A CN 114186189A
- Authority
- CN
- China
- Prior art keywords
- coordinate
- iteration
- calculating
- matrix
- rotation matrix
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- Mathematical Optimization (AREA)
- Theoretical Computer Science (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Operations Research (AREA)
- Probability & Statistics with Applications (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Bioinformatics & Computational Biology (AREA)
- Life Sciences & Earth Sciences (AREA)
- Evolutionary Biology (AREA)
- Computing Systems (AREA)
- Image Processing (AREA)
Abstract
本发明公开了一种坐标转换矩阵的计算方法、装置、设备及可读存储介质,该方法包括:获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;根据坐标转换方程组计算第一旋转矩阵;对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;根据第二旋转矩阵及坐标转换方程组计算平移向量;根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵。通过实施本发明,可以避免由于测量噪声和系统误差导致的坐标转换矩阵失去正交性的情况,可以得到准确的坐标转换矩阵。
Description
技术领域
本申请涉及数据处理技术领域,尤其涉及一种坐标转换矩阵的计算方法、装置、设备及可读存储介质。
背景技术
通过视觉等引导传感器引导机械臂进行自动化作业可以有效的代替人工进行重复、繁重和高强度、高危险的作业,而且机械作业具有更高和更一致的品控,因此在3C电子、汽车等智能制造行业具有极大应用潜力。机械臂按照预设程序进行自动化作业的前提条件之一是需要确定机械臂、(视觉等)引导传感器、作业位置和作业对象间的相对位姿。在实践应用中,此前提条件实现时需要通过测量(视觉等)引导传感器、作业位置和作业对象的特征点,利用标定算法分别计算得到引导传感器、作业位置和作业对象的坐标转换矩阵,坐标转换矩阵包括旋转矩阵R和平移向量t。
目前,一般通过halcon等机器视觉软件来计算坐标转换矩阵。halcon机器视觉软件,本质上是将标定问题转化为AX=XB的数学问题,然后使用Tsai-Lenz等算法依次求解得到坐标转换矩阵中的旋转矩阵和平移向量。而系统误差和测量噪声的存在导致计算得到的旋转矩阵失去正交性,坐标变换畸变,位姿计算误差增大。此外,算法采用的旋转轴角表述方式存在变量冗余,引入了非线性约束,增加了方程求解的复杂度。
发明内容
有鉴于此,本发明实施例了提供一种坐标转换矩阵的计算方法、装置、设备及可读存储介质。
根据第一方面,本发明实施例提供了一种坐标转换矩阵的计算方法,包括:获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;根据坐标转换方程组计算第一旋转矩阵;对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;根据第二旋转矩阵及坐标转换方程组计算平移向量;根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵。
可选地,根据坐标转换方程组计算第一旋转矩阵,包括:对两两相邻的方程组进行差分计算,得到多个差分方程;对多个差分方程进行合并,得到第一方程;对第一方程进行伪逆计算,得到第一旋转矩阵。
可选地,对第一旋转矩阵进行正交化处理,得到第二旋转矩阵,包括:根据第一旋转矩阵建立以最小矩阵正交误差为正交化优化目标的目标函数;目标函数包括第二旋转矩阵,第二旋转矩阵包括待优化旋转角度;根据待优化旋转角度的初始值、迭代参数的初始值对目标函数进行迭代计算,直到满足迭代终止条件,得到待优化旋转角度的第一更新值;根据待优化旋转角度的第一更新值计算第二旋转矩阵。
可选地,根据待优化旋转角度的初始值、迭代参数的初始值对目标函数进行迭代计算,直到满足迭代终止条件,包括:根据待优化旋转角度的初始值对目标函数进行偏导数计算;根据偏导数及迭代参数的初始值计算迭代增量;根据迭代增量计算迭代效果指标;根据迭代效果指标、迭代增量对待优化旋转角度及迭代参数进行更新,返回根据更新后的待优化旋转角度对目标函数进行偏导数计算,直到满足迭代终止条件。
可选地,根据迭代效果指标、迭代增量对待优化旋转角度及迭代参数进行更新,包括:在判定迭代效果指标满足预设条件的情况下,根据迭代增量对待优化旋转角度进行更新,根据迭代效果指标对迭代参数进行更新。
可选地,坐标转换矩阵的计算方法还包括:在判定迭代效果指标不满足预设条件的情况下,保持待优化旋转角度的值不变,将迭代参数进行更新。
可选地,根据偏导数及迭代参数的初始值计算迭代增量,包括:通过岭回归算法,利用偏导数及迭代参数的初始值计算迭代增量。
根据第二方面,本发明实施例提供了一种坐标转换矩阵的计算装置,包括:获取单元,用于获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;建立单元,用于根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;第一计算单元,用于根据坐标转换方程组计算第一旋转矩阵;处理单元,用于对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;第二计算单元,用于根据第二旋转矩阵及坐标转换方程组计算平移向量;确定单元,用于根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵。
根据第三方面,本发明实施例提供了一种电子设备,包括:至少一个处理器;以及与至少一个处理器通信连接的存储器;其中,存储器存储有可被至少一个处理器执行的指令,指令被至少一个处理器执行,以使至少一个处理器执行如第一方面或第一方面任意实施方式中的坐标转换矩阵的计算方法。
根据第四方面,本发明实施例提供了一种计算机可读存储介质,计算机可读存储介质存储有计算机指令,计算机指令用于使计算机执行如第一方面或第一方面任意实施方式中的坐标转换矩阵的计算方法。
本发明实施例提供的坐标转换矩阵的计算方法、装置、设备及可读存储介质,通过获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;根据坐标转换方程组计算第一旋转矩阵;对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;根据第二旋转矩阵及坐标转换方程组计算平移向量;根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵;从而由正交化处理后得到的第二旋转矩阵计算平移向量,并确定坐标转换矩阵,可以避免由于第一坐标数据和第二坐标数据的测量噪声和系统误差导致的坐标转换矩阵失去正交性的情况,可以得到准确的坐标转换矩阵,从而通过坐标转换矩阵变换坐标时,不会发生畸变,位姿计算准确。
上述说明仅是本申请技术方案的概述,为了能够更清楚了解本申请的技术手段,而可依照说明书的内容予以实施,并且为了让本申请的上述和其它目的、特征和优点能够更明显易懂,以下特举本申请的具体实施方式。
附图说明
图1为本发明实施例中一种坐标转换矩阵的计算方法的流程示意图;
图2为本发明实施例中一种坐标转换矩阵的计算装置的结构示意图;
图3为本发明实施例中一种电子设备的硬件结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供了一种坐标转换矩阵的计算方法,可应用于机械臂自动化作业中的机械臂、视觉引导传感器、作业位置、作业对象等的相对位姿的计算中,如图1所示,该方法包括:
S101.获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据。
在本实施例中,在本实施例中,目标物体可以为机械臂、视觉引导传感器、作业位置、作业对象中的任一种。目标物体的特征点在参考坐标系(以下简记为FR)和待标定坐标系(以下简记为FC)下的坐标数据为其中,N是特征点个数,是特征点i在FR坐标系坐标向量,是特征点i在FC坐标系的坐标向量。
S102.根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量。
在本实施例中,需要对第一坐标数据和第二坐标数据进行标定,得到参考坐标系和待标定坐标系之间的坐标转换矩阵,坐标转换方程组包括第一旋转矩阵和平移向量t。在进行标定时,由于第二坐标数据可以由第一坐标数据经过旋转和平移得到,因此,可以建立如下的坐标转换方程组:
在本实施例中,通过将目标物体的坐标转换矩阵的求解问题转换为对坐标转换方程的求解问题,由于坐标转换方程中包括了旋转矩阵和平移向量,则建立的坐标转换方程具有确切的物理意义,使得坐标转换矩阵的求解问题不再是纯粹的数学问题,增强了坐标转换矩阵计算过程的直观性和可理解性。
S103.根据坐标转换方程组计算第一旋转矩阵。
S104.对第一旋转矩阵进行正交化处理,得到第二旋转矩阵。
由于第一坐标数据和第二坐标数据存在测量噪声,导致求解得到的第一旋转或不满足单位正交矩阵的要求,因此,在本实施例中,需要对第一旋转矩阵进行正交化处理。正交化处理后得到的第二旋转矩阵,满足单位正交矩阵的要求。
S105.根据第二旋转矩阵及坐标转换方程组计算平移向量。
在本实施例中,对坐标转换方程组进行变换,可以得到平移向量将第二旋转矩阵作为第一旋转矩阵代入该平移向量计算式,可以计算到平移向量t。由于第二旋转矩阵满足单位正交矩阵的要求,因此通过平移向量的计算式计算到的平移向量消除了坐标变换的相对位置失真。
S106.根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵。
在本实施例中,由于第二旋转矩阵满足单位正交矩阵的要求,因此通过第二旋转矩阵和平移向量确定的坐标转换矩阵消除了坐标变换造成的畸变现象。
本发明实施例提供的坐标转换矩阵的计算方法,通过获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;根据坐标转换方程组计算第一旋转矩阵;对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;根据第二旋转矩阵及坐标转换方程组计算平移向量;根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵;从而由正交化处理后得到的第二旋转矩阵计算平移向量,并确定坐标转换矩阵,可以避免由于第一坐标数据和第二坐标数据的测量噪声和系统误差导致的坐标转换矩阵失去正交性的情况,可以得到准确的坐标转换矩阵,从而通过坐标转换矩阵变换坐标时,不会发生畸变,位姿计算准确。
在一个可选的实施例中,步骤S103,根据坐标转换方程组计算第一旋转矩阵,包括:对两两相邻的方程组进行差分计算,得到多个差分方程;对多个差分方程进行合并,得到第一方程;对第一方程进行伪逆计算,得到第一旋转矩阵。
具体地,可以依据平移的不变性,整理坐标转换方程组:
则对于N组测量数据,可以得到N-1个差分方程。将这N-1个差分方程进行合并,可以得到第一方程:
在本实施例中,通过差分原理计算第一旋转矩阵,从而可以消除测量数据的系统测量误差,使得计算到的第一旋转矩阵更加准确。
在一个可选的实施例中,步骤S104,对第一旋转矩阵进行正交化处理,得到第二旋转矩阵,包括:根据第一旋转矩阵建立以最小矩阵正交误差为正交化优化目标的目标函数;目标函数包括第二旋转矩阵,第二旋转矩阵包括待优化旋转角度;根据待优化旋转角度的初始值、迭代参数的初始值对目标函数进行迭代计算,直到满足迭代终止条件,得到待优化旋转角度的第一更新值;根据待优化旋转角度的第一更新值计算第二旋转矩阵。
具体地,可以将正交化问题转换为无约束的极值问题,建立以矩阵正交误差极小值为优化目标的目标函数,则目标函数表达式为:
其中,R(α)为第二旋转矩阵,tr为对矩阵取对角线上的各个数值的函数,S为优化目标,指矩阵正交误差。
α=(α0 α1 α2)T是第二旋转矩阵对应的待优化旋转角度,也是优化目标的待优化参数。
在本实施例中,可以通过迭代算法求解优化问题。迭代时,需要设定待优化旋转角度α的初始值,还需要设定迭代参数μ的初始值。
迭代时,需要计算每次迭代的迭代增量,迭代效果指标、优化目标的计算值。每次迭代后,需要对待优化参数和迭代参数进行更新,以进行下一次的迭代。
在一个可选的实施方式中,判定迭代满足迭代终止条件的步骤,包括:在判定迭代次数达到预设次数阈值的情况下;或,在判定标定误差小于优化指标阈值的情况下;或,在判定迭代增量小于迭代步长阈值的情况下,判定迭代满足迭代终止条件。
则迭代终止条件包括:1)迭代次数超限;
2)S<S0,S为优化目标,S0是优化指标阈值;
3)Δα<Δα0,Δα0是迭代步长阈值;Δα为迭代增量,也即迭代步长。
只要满足任一条件,迭代终止。迭代终止时,可以得到待优化旋转角度的第一更新值。将待优化旋转角度的第一更新值代入R(α)的计算式中,可以计算到第二旋转矩阵。
在本实施例中,在对第一旋转矩阵进行正交化处理过程中,选取旋转角度作为优化参数,可以消除正交化过程中的约束条件,降低算法计算复杂度。
在一个可选的实施例中,根据待优化旋转角度的初始值、迭代参数的初始值对目标函数进行迭代计算,直到满足迭代终止条件,包括:根据待优化旋转角度的初始值对目标函数进行偏导数计算;根据偏导数及迭代参数的初始值计算迭代增量;根据迭代增量计算迭代效果指标;根据迭代效果指标、迭代增量对待优化旋转角度及迭代参数进行更新,返回根据更新后的待优化旋转角度对目标函数进行偏导数计算,直到满足迭代终止条件。
具体地,可以通过迭代算法求解优化问题,具体计算步骤如下:
第一步:可以设置待优化旋转角度α的初始值为αk,迭代参数μ的初始值为μk(第一次迭代,k=0,)。
第二步:可以对优化问题优化目标S计算偏导数(雅克比矩阵J),计算过程如下:
第三步:迭代增量Δα计算:
在一个可选的实施方式中,根据偏导数及迭代参数的初始值计算迭代增量,包括:通过岭回归算法,利用偏导数及迭代参数的初始值计算迭代增量。
第四步:迭代效果指标ρ计算:
第五步:迭代增量判定,根据迭代增量判定的结果对待优化旋转角度和迭代参数的初始值进行更新。
第六步,返回第二步,继续下一次的迭代,直到满足迭代终止条件。
迭代终止条件包括:1)迭代次数超限;
2)S<S0,S0是优化指标阈值;
3)Δα<Δα0,Δα0是迭代步长阈值;
只要满足3个条件中的任一条件,迭代终止。
在本实施例中,在迭代算法求解优化问题的解时,在迭代增量的计算中加入了对角元素足够小的对角实数矩阵μI,这样可以确保待优化旋转角度之间一定是可逆的,可以解决特征点共面等导致的系数矩阵奇异等问题。
在一个可选的实施例中,根据迭代效果指标、迭代增量对待优化旋转角度及迭代参数进行更新,包括:在判定迭代效果指标满足预设条件的情况下,根据迭代增量对待优化旋转角度进行更新,根据迭代效果指标对迭代参数进行更新。在判定迭代效果指标不满足预设条件的情况下,保持待优化旋转角度的值不变,将迭代参数进行更新。
具体地,可以设定如果|ρ|<ρ0,则ak+1=ak-Δα, 否则ak+1=ak,μk+1=2μk,在本实施例中,将迭代参数进行更新时,是以μk+1=2μk为例进行更新的,在别的实施例或别的场景中,并不以此为限。
在本发明实施例中,在判定迭代效果指标满足预设条件的情况下,根据迭代增量对待优化旋转角度进行更新,根据迭代效果指标对迭代参数进行更新;在判定迭代效果指标不满足预设条件的情况下,保持待优化旋转角度的值不变,将迭代参数进行更新;从而在不同的迭代效果指标下,执行不同的迭代变量的更新方式,使得算法更加准确。
本发明实施例还提供了一种坐标转换矩阵的计算装置,如图2所示,包括:
获取单元21,用于获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;具体的实施方式详见上述方法实施例步骤S101的描述,在此不再赘述。
建立单元22,用于根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;具体的实施方式详见上述方法实施例步骤S102的描述,在此不再赘述。
第一计算单元23,用于根据坐标转换方程组计算第一旋转矩阵;具体的实施方式详见上述方法实施例步骤S103的描述,在此不再赘述。
处理单元24,用于对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;具体的实施方式详见上述方法实施例步骤S104的描述,在此不再赘述。
第二计算单元25,用于根据第二旋转矩阵及坐标转换方程组计算平移向量;具体的实施方式详见上述方法实施例步骤S105的描述,在此不再赘述。
确定单元26,用于根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵。具体的实施方式详见上述方法实施例步骤S106的描述,在此不再赘述。
本发明实施例提供的坐标转换矩阵的计算装置,通过获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;根据第一坐标数据和第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,坐标转换方程组包括待标定的第一旋转矩阵和平移向量;根据坐标转换方程组计算第一旋转矩阵;对第一旋转矩阵进行正交化处理,得到第二旋转矩阵;根据第二旋转矩阵及坐标转换方程组计算平移向量;根据计算到的第二旋转矩阵及平移向量确定坐标转换矩阵;从而由正交化处理后得到的第二旋转矩阵计算平移向量,并确定坐标转换矩阵,可以避免由于第一坐标数据和第二坐标数据的测量噪声和系统误差导致的坐标转换矩阵失去正交性的情况,可以得到准确的坐标转换矩阵,从而通过坐标转换矩阵变换坐标时,不会发生畸变,位姿计算准确。
基于与前述实施例中一种坐标转换矩阵的计算方法同样的发明构思,本发明实施例还提供一种电子设备,如图3所示,包括:处理器31和存储器32,其中处理器31和存储器32可以通过总线或者其他方式连接,图3中以通过总线连接为例进行说明。
处理器31可以为中央处理器(Central Processing Unit,CPU)。处理器31还可以为其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等芯片,或者上述各类芯片的组合。
存储器32作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态计算机可执行程序以及模块,如本发明实施例中的坐标转换矩阵的计算方法对应的程序指令/模块。处理器31通过运行存储在存储器32中的非暂态软件程序、指令以及模块,从而执行处理器的各种功能应用以及数据处理,即实现上述方法实施例中的坐标转换矩阵的计算方法。
存储器32可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储处理器31所创建的数据等。此外,存储器32可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器32可选包括相对于处理器31远程设置的存储器,这些远程存储器可以通过网络连接至处理器31。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
上述的一个或者多个模块存储在存储器32中,当被处理器31执行时,执行如图1所示实施例中的坐标转换矩阵的计算方法。
上述电子设备具体细节可以对应参阅图1所示的实施例中对应的相关描述和效果进行理解,此处不再赘述。
本领域技术人员可以理解,实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)、随机存储记忆体(Random AccessMemory,RAM)、快闪存储器(Flash Memory)、硬盘(Hard Disk Drive,缩写:HDD)或固态硬盘(Solid-State Drive,SSD)等;所述存储介质还可以包括上述种类的存储器的组合。
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程信息处理设备的处理器以产生一个机器,使得通过计算机或其他可编程信息处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程信息处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程信息处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。
Claims (10)
1.一种坐标转换矩阵的计算方法,其特征在于,包括:
获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;
根据所述第一坐标数据和所述第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,所述坐标转换方程组包括待标定的第一旋转矩阵和平移向量;
根据所述坐标转换方程组计算所述第一旋转矩阵;
对所述第一旋转矩阵进行正交化处理,得到第二旋转矩阵;
根据所述第二旋转矩阵及所述坐标转换方程组计算所述平移向量;
根据计算到的所述第二旋转矩阵及所述平移向量确定坐标转换矩阵。
2.根据权利要求1所述的坐标转换矩阵的计算方法,所述根据所述坐标转换方程组计算所述第一旋转矩阵,包括:
对两两相邻的所述方程组进行差分计算,得到多个差分方程;
对多个所述差分方程进行合并,得到第一方程;
对所述第一方程进行伪逆计算,得到所述第一旋转矩阵。
3.根据权利要求1所述的坐标转换矩阵的计算方法,所述对所述第一旋转矩阵进行正交化处理,得到第二旋转矩阵,包括:
根据所述第一旋转矩阵建立以最小矩阵正交误差为正交化优化目标的目标函数;所述目标函数包括第二旋转矩阵,所述第二旋转矩阵包括待优化旋转角度;
根据所述待优化旋转角度的初始值、迭代参数的初始值对所述目标函数进行迭代计算,直到满足迭代终止条件,得到所述待优化旋转角度的第一更新值;
根据所述待优化旋转角度的第一更新值计算所述第二旋转矩阵。
4.根据权利要求3所述的坐标转换矩阵的计算方法,其特征在于,所述根据所述待优化旋转角度的初始值、迭代参数的初始值对所述目标函数进行迭代计算,直到满足迭代终止条件,包括:
根据所述待优化旋转角度的初始值对所述目标函数进行偏导数计算;
根据所述偏导数及迭代参数的初始值计算迭代增量;
根据所述迭代增量计算迭代效果指标;
根据所述迭代效果指标、所述迭代增量对所述待优化旋转角度及所述迭代参数进行更新,返回根据更新后的所述待优化旋转角度对所述目标函数进行偏导数计算,直到满足迭代终止条件。
5.根据权利要求4所述的坐标转换矩阵的计算方法,其特征在于,所述根据所述迭代效果指标、所述迭代增量对所述待优化旋转角度及所述迭代参数进行更新,包括:
在判定所述迭代效果指标满足预设条件的情况下,根据所述迭代增量对所述待优化旋转角度进行更新,根据所述迭代效果指标对所述迭代参数进行更新。
6.根据权利要求5所述的坐标转换矩阵的计算方法,其特征在于,还包括:
在判定所述迭代效果指标不满足预设条件的情况下,保持所述待优化旋转角度的值不变,将所述迭代参数进行更新。
7.根据权利要求4所述的坐标转换矩阵的计算方法,其特征在于,根据所述偏导数及迭代参数的初始值计算迭代增量,包括:
通过岭回归算法,利用所述偏导数及迭代参数的初始值计算迭代增量。
8.一种坐标转换矩阵的计算装置,其特征在于,包括:
获取单元,用于获取目标物体的特征点在参考坐标系下的第一坐标数据和待标定坐标系下的第二坐标数据;
建立单元,用于根据所述第一坐标数据和所述第二坐标数据建立参考坐标系和待标定坐标系的坐标转换方程组,所述坐标转换方程组包括待标定的第一旋转矩阵和平移向量;
第一计算单元,用于根据所述坐标转换方程组计算所述第一旋转矩阵;
处理单元,用于对所述第一旋转矩阵进行正交化处理,得到第二旋转矩阵;
第二计算单元,用于根据所述第二旋转矩阵及所述坐标转换方程组计算所述平移向量;
确定单元,用于根据计算到的所述第二旋转矩阵及所述平移向量确定坐标转换矩阵。
9.一种电子设备,其特征在于,包括:
至少一个处理器;以及与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器执行如权利要求1-7任意一项所述的坐标转换矩阵的计算方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使计算机执行如权利要求1-7任意一项所述的坐标转换矩阵的计算方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111399313.5A CN114186189A (zh) | 2021-11-19 | 2021-11-19 | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111399313.5A CN114186189A (zh) | 2021-11-19 | 2021-11-19 | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114186189A true CN114186189A (zh) | 2022-03-15 |
Family
ID=80541306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111399313.5A Pending CN114186189A (zh) | 2021-11-19 | 2021-11-19 | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114186189A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023202157A1 (zh) * | 2022-12-26 | 2023-10-26 | 江苏徐工工程机械研究院有限公司 | 铲斗坐标标定方法和装置、更新方法和设备、挖掘机 |
CN117066843A (zh) * | 2023-10-08 | 2023-11-17 | 荣耀终端有限公司 | 产品组件的组装方法和设备 |
-
2021
- 2021-11-19 CN CN202111399313.5A patent/CN114186189A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023202157A1 (zh) * | 2022-12-26 | 2023-10-26 | 江苏徐工工程机械研究院有限公司 | 铲斗坐标标定方法和装置、更新方法和设备、挖掘机 |
CN117066843A (zh) * | 2023-10-08 | 2023-11-17 | 荣耀终端有限公司 | 产品组件的组装方法和设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114186189A (zh) | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 | |
CN110640747B (zh) | 机器人的手眼标定方法、系统、电子设备和存储介质 | |
CN112936301B (zh) | 一种机器人手眼标定方法、装置、可读存储介质及机器人 | |
CN108332758B (zh) | 一种移动机器人的走廊识别方法及装置 | |
CN111168719B (zh) | 一种基于定位工装的机器人校准方法及系统 | |
CN111055286B (zh) | 一种工业机器人轨迹生成方法、系统、装置和存储介质 | |
CN112183171A (zh) | 一种基于视觉信标建立信标地图方法、装置 | |
EP4012420B1 (en) | Wind estimation method and apparatus for carrier rocket, device and storage medium | |
CN109952176B (zh) | 一种机器人标定方法、系统、机器人及存储介质 | |
CN110097599B (zh) | 一种基于部件模型表达的工件位姿估计方法 | |
CN105654460A (zh) | 点云拼接系统及方法 | |
CN114186190A (zh) | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 | |
CN113119083B (zh) | 一种机器人标定方法、装置、机器人及存储介质 | |
CN110930444A (zh) | 一种基于双边优化的点云匹配方法、介质、终端和装置 | |
US11607806B2 (en) | Techniques for generating controllers for robots | |
CN105574884A (zh) | 一种医疗机器人dh参数标定方法 | |
CN114186191A (zh) | 坐标转换矩阵的计算方法、装置、设备及可读存储介质 | |
CN115511935A (zh) | 基于迭代离散化与线性插值的正态分布变换点云配准方法 | |
CN114387352A (zh) | 一种外参标定方法、装置、设备及存储介质 | |
CN112907505B (zh) | 一种水下机器人电缆三维形状估计方法 | |
CN110308724B (zh) | 自动驾驶控制方法、装置、车辆、存储介质及电子设备 | |
CN113985887A (zh) | 差速移动机器人运动轨迹生成方法和运动控制装置 | |
CN112907669A (zh) | 基于共面特征点的相机位姿测量方法及装置 | |
CN111156948A (zh) | 用于3c玻璃面板检测的三维数据坐标校正方法及装置 | |
CN117475399B (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 |