CN115855099A - 单舵轮移动装置的参数标定方法、装置及可读存储介质 - Google Patents

单舵轮移动装置的参数标定方法、装置及可读存储介质 Download PDF

Info

Publication number
CN115855099A
CN115855099A CN202211250957.2A CN202211250957A CN115855099A CN 115855099 A CN115855099 A CN 115855099A CN 202211250957 A CN202211250957 A CN 202211250957A CN 115855099 A CN115855099 A CN 115855099A
Authority
CN
China
Prior art keywords
steering wheel
movement data
data
data sequence
laser radar
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
Application number
CN202211250957.2A
Other languages
English (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.)
Zhejiang Huaray Technology Co Ltd
Original Assignee
Zhejiang Huaray Technology 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 Zhejiang Huaray Technology Co Ltd filed Critical Zhejiang Huaray Technology Co Ltd
Priority to CN202211250957.2A priority Critical patent/CN115855099A/zh
Publication of CN115855099A publication Critical patent/CN115855099A/zh
Pending legal-status Critical Current

Links

Images

Landscapes

  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本申请公开了一种单舵轮移动装置的参数标定方法、装置及可读存储介质。该方法包括:获取待标定单舵轮移动装置按设定路径移动生成的激光雷达数据序列和舵轮编码数据序列;将激光雷达数据序列和舵轮编码数据序列整合得到舵轮移动数据序列;以同一舵轮移动数据中的基于初始舵轮偏航角以及舵轮平均转速计算的第一旋转角度与由激光雷达位姿变换数据确定第二旋转角度相等为旋转约束条件,确定舵轮编码器内参中的舵轮零偏值;基于手眼标定的平移约束条件确定舵轮编码器内参中的舵轮半径、车体轴距,及确定激光雷达与舵轮编码器之间的外参。通过上述方式,本申请能够实现单舵轮移动装置外参和编码器内参的联合标定,准确度高,误差小,实现方式简单可靠。

Description

单舵轮移动装置的参数标定方法、装置及可读存储介质
技术领域
本申请涉及移动机器人标定领域,特别是涉及一种单舵轮移动装 置的参数标定方法、装置及可读存储介质。
背景技术
装载有多传感器的移动机器人以其高效性和高精度而被广泛应用。 移动机器人通常融合多个传感器的数据进行定位,例如激光雷达和编 码器是移动机器人中最常用的两个传感器,在实际应用中,为了方便 装配,两个传感器被装配在移动机器人的不同位置上,他们的坐标系 并不重叠,需对两个传感器的坐标系以及编码器的内参进行校准。
发明内容
本申请主要提供一种单舵轮移动装置的参数标定方法、装置及可 读存储介质,解决了现有技术中单舵轮移动装置标定准确度低的问题。
为解决上述技术问题,本申请第一方面提供了一种单舵轮移动装 置的参数标定方法,包括:获取待标定单舵轮移动装置按设定路径移 动生成的激光雷达数据序列和舵轮编码数据序列;将所述激光雷达数 据序列和舵轮编码数据序列整合得到舵轮移动数据序列,其中所述舵 轮移动数据序列包括多组按照时间顺序排列的舵轮移动数据,每组舵 轮移动数据包括由两个激光雷达数据的采样时刻所确定的所述舵轮移 动数据的起始时间和终止时间以及激光雷达位姿变换数据,以及由所 述舵轮编码数据所确定的位于所述起始时间和终止时间之间的至少一 初始舵轮偏航角以及舵轮平均转速;以同一所述舵轮移动数据中的基 于所述初始舵轮偏航角以及舵轮平均转速计算的第一旋转角度与由所 述激光雷达位姿变换数据确定第二旋转角度相等为旋转约束条件,确 定舵轮编码器内参中的舵轮零偏值;基于手眼标定的平移约束条件确 定所述舵轮编码器内参中的舵轮半径、车体轴距,以及确定激光雷达 与所述舵轮编码器之间的外参。
为解决上述技术问题,本申请第二方面提供了一种单舵轮移动装 置标定装置,所述装置包括相互耦接的处理器和存储器;所述存储器 中存储有计算机程序,所述处理器用于执行所述计算机程序以实现如 上述第一方面提供的单舵轮移动装置的参数标定方法。
为解决上述技术问题,本申请第三方面提供了一种计算机可读存 储介质,计算机可读存储介质存储有程序数据,所述程序数据被处理 器执行时,实现上述第一方面提供的单舵轮移动装置的参数标定方法。
本申请的有益效果是:区别于现有技术的情况,本申请获取待标 定单舵轮移动装置按设定路径移动生成的激光雷达数据序列和舵轮编 码数据序列,然后将激光雷达数据序列和舵轮编码数据序列整合得到 舵轮移动数据序列,其中,舵轮移动数据序列包括多组按照时间顺序 排列的舵轮移动数据,每组舵轮移动数据包括由两个激光雷达数据的 采样时刻所确定的舵轮移动数据的起始时间和终止时间以及激光雷达 位姿变换数据,以及由舵轮编码数据所确定的位于起始时间和终止时 间之间的至少一初始舵轮偏航角以及舵轮平均转速,最后以同一舵轮 移动数据中的基于初始舵轮偏航角以及舵轮平均转速计算的第一旋转 角度与由激光雷达位姿变换数据确定第二旋转角度相等为旋转约束条 件,确定舵轮编码器内参中的舵轮零偏值,并基于手眼标定的平移约 束条件确定舵轮编码器内参中的舵轮半径、车体轴距,以及确定激光 雷达与舵轮编码器之间的外参。通过上述方式,本申请能够仅获取激 光雷达的数据序列和舵轮编码的数据序列,实现单舵轮移动装置外参和编码器内参的联合标定,准确度高,误差小,实现方式简单可靠。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例 描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的 附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在 不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本申请单舵轮移动装置一实施例的结构示意简图;
图2是本申请单舵轮移动装置的参数标定方法一实施例的流程示 意框图;
图3是本申请步骤S13一实施例的流程示意框图;
图4是本申请对外参进行优化一实施例的流程示意框图;
图5是本申请舵轮移动装置标定装置一实施例的结构示意框图;
图6是本申请单舵轮移动装置标定装置另一实施例的结构示意框 图
图7是本申请计算机可读存储介质一实施例的结构示意框图。
具体实施方式
下面将结合本申请实施例中的附图,对本申请实施例中的技术方 案进行清楚、完整地描述,显然,所描述的实施例仅是本申请的一部 分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普 通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例, 都属于本申请保护的范围。
本申请中的术语“第一”、“第二”仅用于描述目的,而不能理 解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。 由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至 少一个该特征。本申请的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。此外,术语“包括”和 “具有”以及它们任何变形,意图在于覆盖不排他的包含。例如包含 了一系列步骤或单元的过程、方法、***、产品或设备没有限定于已 列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可 选地还包括对于这些过程、方法、产品或设备固有的其它步骤或单元。
在本文中提及“实施例”意味着,结合实施例描述的特定特征、 结构或特性可以包含在本申请的至少一个实施例中。在说明书中的各 个位置出现该短语不一定均是指相同的实施例,也不是与其它实施例 互斥的独立的或备选的实施例。本领域技术人员显式地和隐式地理解 是,本文所描述的实施例可以与其他实施例结合。
本文提供的标定方法用于单舵轮装置的参数标定,单舵轮装置为 包括一个舵轮的可移动装置,请参阅图1,该单舵轮移动装置其包括一 个舵轮A及两个从动轮B、C,该单舵轮装置定义舵轮A偏离正前方的 角为偏航角度θ,舵轮A与两个从动轮B、C连线之间的垂直距离为车 体轴距b。
请参阅图2,图2是本申请单舵轮移动装置的参数标定方法一实施 例的流程示意框图。需注意的是,若有实质上相同的结果,本实施例 并不以图2所示的流程顺序为限。本实施例包括以下步骤:
步骤S11:获取待标定单舵轮移动装置按设定路径移动生成的激光 雷达数据序列和舵轮编码数据序列。
本步骤通过控制单舵轮移动装置按照设定路径移动,并在舵轮移 动装置的移动过程中,控制激光雷达传感器发出激光,同步采集激光 雷达点云数据,以及采集舵轮编码器生成的舵轮编码数据序列,将点 云数据匹配得到激光雷达数据序列。
设定路径例如可包括直线路径、弯曲路径。例如是“8”字型封闭 路径,其既包括直行路径,也包括弯曲路径,获取到的数据序列更加 全面。
其中,点云数据序列可表示为:{S1,S2,...,Sn},点云数据序列中的每 帧点云数据中至少包括采样时间戳t以及激光点云C。
本步骤可按照设定帧数间隔对两帧点云数据进行配准,以得到激 光雷达数据序列。例如,从{S1,S2,...,Sn}中第一帧数据开始,每隔6帧匹 配一次,即S1与S7进行匹配得到位姿T1=[Δxl Δyl Δθl]T,该位姿对应的 开始时间和结束时间分别为S1的采样时间戳和S7的采样时间戳,之后S7与S13进行匹配并依次类推直至数据序列末尾,最终可以得到激光雷达 数据序列{T1,T2,...,Tr},激光雷达数据序列中的每组激光雷达数据包括激 光位姿变换信息(Δxl,Δyl,Δθl)以及该组数据采集的起始时间tstart和终止时 间tend
舵轮编码数据序列可表示为{E1,E2,...,Em}。舵轮编码数据序列中的 每个舵轮编码数据至少包括起始时间tstart、舵轮转速n以及舵轮偏航角 度θ。
步骤S12:将激光雷达数据序列和舵轮编码数据序列整合得到舵轮 移动数据序列。
其中,舵轮移动数据序列包括多组按照时间顺序排列的舵轮移动 数据,每组舵轮移动数据包括由两个激光雷达数据的采样时刻所确定 的舵轮移动数据的起始时间和终止时间以及激光雷达位姿变换数据, 以及由舵轮编码数据所确定的位于起始时间和终止时间之间的舵轮平 均转速和至少一初始舵轮偏航角。
舵轮移动数据序列可表示为:
{D1,D2,...,Dr}
其中,Di=(Ti,{Es,Es+1,...,Ee}),i=1…r,{Es,Es+1,...,Ee}为对应于起始 时间和终止时间之间的舵轮编码数据序列,{Es,Es+1,...,Ee}的时间戳分别 为Ti的起始时间tstart和终止时间tend,e-s≥0,即,每组舵轮编码数据所 确定的位于起始时间和终止时间之间对应至少一组舵轮编码数据。故, 每组舵轮移动数据Di包含起始时间tstart、终止时间tend、激光位姿变换信 息(Δxl,Δyl,Δθl),以及由舵轮编码数据序列确定的舵轮平均转速nw以及 tstart时刻初始舵轮偏航角θw
在步骤S12之前,可对舵轮编码数据序列进行插值,使得每个激 光雷达数据对应的tstart和终止时间tend均对应一舵轮编码数据。例如,以 激光雷达数据序列中的每个数据的起始和终止时间戳tstart和tend为基准, 采用匀加速模型对时间戳在tstart和tend周围的舵轮编码数据进行插值计算, 得到插值后的舵轮编码数据序列。
可选地,本实施例还包括:去除舵轮移动数据序列中不符合设定 规则的舵轮移动数据。
在一实施例中,可去除舵轮移动数据序列中舵轮平均转速小于设 定速度阈值的舵轮移动数据。可以理解地,该数据表示在该时间段内 装置几乎处于静止状态,可以去除。
在一实施例中,可去除舵轮移动数据序列中激光雷达偏转方向与 舵轮编码器偏转方向相反的舵轮移动数据。也即,激光旋转角度Δθl和 舵轮编码器旋转角度
Figure BDA0003887612470000061
所表征的旋转方向相反时,该数据表示装 置异常或者数据延迟,可以去除。
在一实施例中,可去除舵轮移动数据序列中,从起始时间到终止 时间的舵轮偏转角变化超过设定角度偏差阈值的舵轮移动数据。由于
Figure BDA0003887612470000062
较大的数据会导致编码器轨迹积分的过程中有较大误差,可以 去除。
步骤S13:以同一舵轮移动数据中的基于初始舵轮偏航角以及舵轮 平均转速计算的第一旋转角度与由激光雷达位姿变换数据确定的第二 旋转角度相等为旋转约束条件,确定舵轮编码器内参中的舵轮零偏值。
一组舵轮移动数据Di=(Ti,{Es,Es+1,...,Ee})中,tstart到tend时间段内,由 激光雷达位姿变换数据确定的第二旋转角度为Δθl,由初始舵轮偏航角 以及舵轮平均转速计算的第一旋转角度为Δθo,则旋转约束可表示为 Δθl=Δθo
请参阅图3,图3是本申请步骤S13一实施例的流程示意框图。需 注意的是,若有实质上相同的结果,本实施例并不以图3所示的流程 顺序为限。本实施例可根据以下步骤确定舵轮编码器内参中的舵轮零 偏值:
步骤S131:利用初始舵轮偏航角和舵轮零偏值的求和结果的正弦 值、舵轮平均转速以及舵轮半径的乘积结果与车体轴距的比值所计算 获得的第一旋转角度与对应的第二旋转角度构建等量关系式。
其中,等量关系式可表示为式(1):
Figure BDA0003887612470000071
其中,k1、k2为待计算参数,
Figure BDA0003887612470000072
θl、θw、nw分别 为第二旋转角度、起始时间的初始舵轮偏航角、起始时间和终止时间 之间的舵轮平均转速,r为舵轮半径,b为车体轴距,tend和tstart分别为 终止时间和起始时间。
步骤S132:基于至少两组等量关系式,确定舵轮零偏值。
可基于至少两组舵轮移动数据结合前一步骤确定的等量关系式, 确定出至少两组等量关系式组成的方程组,根据方程组可计算出待计 算参数的k1、k2,并基于以下公式计算得到舵轮零偏值:
Figure BDA0003887612470000073
其中,舵轮移动数据包括与起始时间和终止时间对应的两个舵轮 编码数据以及位于两个舵轮编码数据之间的至少一个舵轮编码数据, 利用一组舵轮移动数据可将上述等量关系式利用中值积分方法表示为 式(2)的形式:
Figure BDA0003887612470000074
其中,M为舵轮编码数据的数量,θl为第二旋转角度,tk+1和tk分 别是第k+1个舵轮编码数据和第k个舵轮编码数据的采样时间,
Figure BDA0003887612470000075
是由在tk+1和tk所采集的舵轮转速
Figure BDA0003887612470000076
和/>
Figure BDA0003887612470000077
计算的舵轮平均转 速,/>
Figure BDA0003887612470000078
和/>
Figure BDA0003887612470000079
在tk+1和tk时刻所采集到的初始舵轮偏航角。
在一舵轮移动数据对应的舵轮编码数据序列中,上述M与上述 {Es,Es+1,...,Ee}中的舵轮编码数据等同,可以理解地,在实际应用时,tk+1和tk的所表征的时间在总的时间序列上与上述舵轮编码数据序列 {Es,Es+1,...,Ee}中各数据对应的时间信息相对应。
步骤S14:基于手眼标定的平移约束条件确定舵轮编码器内参中的 舵轮半径、车体轴距,以及确定激光雷达与舵轮编码器之间的外参。
数据Di=(Ti,{Es,Es+1,...,Ee})中每组数据从tstart到tend时间段内,激光平 移向量为
Figure BDA0003887612470000081
编码器平移向量为/>
Figure BDA0003887612470000082
平移约束在二维平面可表示为:
Figure BDA0003887612470000083
其中,xo_l为激光雷达与舵轮编码器之间的外参在x方向的分量, 为外参在y方向的分量,θo_l为外参的角度分量。
其中编码器的平移向量
Figure BDA0003887612470000084
待求解,采用中值积分和闭式积分方 法求解比编码器平移向量,可表示为式(4)的形式:
Figure BDA0003887612470000085
其中:
Figure BDA0003887612470000086
Figure BDA0003887612470000087
/>
Figure BDA0003887612470000088
其中,θo_k
Figure BDA0003887612470000089
Figure BDA00038876124700000810
均为中间参数。
进一步地,舵轮移动数据序列{D1,D2,...,Dr}中的每组数据对都满足 式(3),将其做矩阵展开并化简得到式(5):
Figure RE-GDA0004035917580000091
构建如下有约束的最小二乘方程:
Figure BDA0003887612470000092
其中:
M=∑Qk TQk
Figure BDA0003887612470000093
Figure RE-GDA0004035917580000094
求解上述式(6)的优化方程,可以得到:
Figure BDA0003887612470000095
随后利用式(7)求解外参中的舵轮半径:
Figure BDA0003887612470000096
区别于现有技术,本实施例根据安装于单舵轮移动装置的激光雷 达传感器和舵轮编码器的数据序列处理得到舵轮移动数据序列,根据 单舵轮移动装置的移动规则上在数据序列上的表现,计算得出舵轮编 码器内参以及激光雷达与舵轮编码器之间的外参,提高单舵轮移动装 置的标定准确性,且只需输入激光雷达传感器和舵轮编码器的数据序 列即可实现,简便且可靠。
利用上述方式初步得到激光雷达与舵轮编码器之间的外参初值 (xo_l,yo_lo_l),本文还可利用下述方式对该外参初值进行优化。
请参阅图4,图4是本申请对外参进行优化一实施例的流程示意框 图。需注意的是,若有实质上相同的结果,本实施例并不以图4所示 的流程顺序为限。本实施例可根据以下步骤对外参进行优化:
步骤S21:计算每个舵轮移动数据所对应的激光位姿增量矩阵和由 外参构建的外参矩阵的乘积与外参矩阵和编码器位姿增量矩阵的乘积 的差值。
其中,每一组舵轮移动数据的激光位姿增量矩阵可表示为: [Δxl Δyl Δθl]T;编码器位姿增量矩阵可根据上述式(4)以及式(2) 求得,可表示为:[Δxo Δyo Δθo]T。该差值可表示为:
[Δxl Δyl Δθl]T*[xo_l yo_l θo_l]-[xo_l yo_l θo_l]*[Δxo Δyo Δθo]T
步骤S22:以舵轮移动数据序列中的多个舵轮移动数据所对应的差 值之和最小化为目标对外参进行优化。
优化函数可表示为:min∑(AX-XB),其中,A为激光位姿增量矩 阵,X为外参矩阵,B为编码器位姿增量矩阵。
该无约束优化可利用最小二乘法、梯度法等方式解得优化外参。
步骤S23:将差值不符合判定条件的舵轮移动数据去除,得到新的 舵轮移动数据序列。
对于舵轮移动数据序列中的每个舵轮移动数据,根据AX-XB计算 激光位姿增量矩阵和由优化外参构建的优化外参矩阵的乘积AX与优化 外参矩阵和编码器位姿增量矩阵的乘积XB的差值,差值不符合预设判 定条件的,则去除相应的舵轮移动数据,未去除的舵轮移动数据组成 新的舵轮移动数据序列,利用新的舵轮移动数据序列继续迭代优化。
确定差值是否符合预设判定条件,例如是确定差值是否超过设定 差异阈值,若超过,则确定该差值不符合预设判定条件。
步骤S24:返回步骤S21。
重复执行上述步骤S21-S24,直到满足迭代结束条件,迭代结束条 件例如是本次优化结果与上次的优化结果差值小于设定值,迭代结束 条件还可根据实际需求设定。
区别于现有技术,上述方式在确定外参初值后,对该外参初值进 行迭代优化,进而得到优化外参,提高算法可靠性,进而提高本法取 得外参的可信度。
请参阅图5,图5是本申请舵轮移动装置标定装置一实施例的结构 示意框图。本实施例单舵轮移动装置标定装置100包括:获取模块110、 数据处理模块120以及参数计算模块130,其中,获取模块110用于获 取待标定单舵轮移动装置按设定路径移动生成的激光雷达数据序列和 舵轮编码数据序列,数据处理模块120用于将激光雷达数据序列和舵 轮编码数据序列整合得到舵轮移动数据序列,其中舵轮移动数据序列 包括多组按照时间顺序排列的舵轮移动数据,每组舵轮移动数据包括 由两个激光雷达数据的采样时刻所确定的舵轮移动数据的起始时间和 终止时间以及激光雷达位姿变换数据,以及由舵轮编码数据所确定的 位于起始时间和终止时间之间的至少一初始舵轮偏航角以及舵轮平均 转速,参数计算模块130用于以同一舵轮移动数据中的基于初始舵轮 偏航角以及舵轮平均转速计算的第一旋转角度与由激光雷达位姿变换 数据确定第二旋转角度相等为旋转约束条件,确定舵轮编码器内参中 的舵轮零偏值,以及基于手眼标定的平移约束条件确定舵轮编码器内 参中的舵轮半径、车体轴距,以及确定激光雷达与舵轮编码器之间的 外参。
其中,单舵轮移动装置标定装置100可以是连接于舵轮移动装置 本身,用于数据处理的处理单元或模块,也可以是可连接于单舵轮移 动装置激光雷达传感器数据输出接口和舵轮编码器数据输出接口的处 理单元或模块。
关于各处理执行的各步骤的具体方式请参照上述本申请单舵轮移 动装置的参数标定方法实施例的各步骤的描述,在此不再赘述。
请参阅图6,图6是本申请单舵轮移动装置标定装置另一实施例的 结构示意框图。该单舵轮移动装置标定装置200包括相互耦接的处理 器210和存储器220,存储器220中存储有计算机程序,处理器210用 于执行计算机程序以实现上述各实施例所述的单舵轮移动装置的参数 标定方法。
关于处理执行的各步骤的描述请参照上述本申请单舵轮移动装置 的参数标定方法实施例的各步骤的描述,在此不再赘述。
存储器220可用于存储程序数据以及模块,处理器210通过运行 存储在存储器220的程序数据以及模块,从而执行各种功能应用以及 数据处理。存储器220可主要包括存储程序区和存储数据区,其中, 存储程序区可存储操作***、至少一个功能所需的应用程序(比如数据 序列整合处理功能等)等;存储数据区可存储根据单舵轮移动装置标定 装置200的使用所创建的数据(比如激光雷达数据序列、舵轮编码数据 序列、舵轮移动数据序列等)等。此外,存储器220可以包括高速随机 存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器 件、闪存器件、或其他易失性固态存储器件。相应地,存储器220还 可以包括存储器控制器,以提供处理器210对存储器220的访问。
在本申请的各实施例中,所揭露的方法、装置,可以通过其它的 方式实现。例如,以上所描述的单舵轮移动装置标定装置200的各实 施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻 辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组 件可以结合或者可以集成到另一个***,或一些特征可以忽略,或不 执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连 接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是 电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开 的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位 于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需 要选择其中的部分或者全部单元来实现本实施方式方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理 单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单 元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现, 也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产 品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这 样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部 分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该 计算机软件产品存储在一个存储介质中。
参阅图7,图7是本申请计算机可读存储介质一实施例的结构示意 框图,计算机可读存储介质300存储有程序数据310,程序数据310被 执行时实现如上述单舵轮移动装置的参数标定方法各实施例的步骤。
关于处理执行的各步骤的描述请参照上述本申请单舵轮移动装置 的参数标定方法实施例的各步骤的描述,在此不再赘述。
计算机可读存储介质300可以是U盘、移动硬盘、只读存储器 (ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅为本申请的实施例,并非因此限制本申请的专利范围, 凡是利用本申请说明书及附图内容所作的等效结构或等效流程变换, 或直接或间接运用在其他相关的技术领域,均同理包括在本申请的专 利保护范围内。

Claims (11)

1.一种单舵轮移动装置的参数标定方法,其特征在于,所述方法包括:
获取待标定单舵轮移动装置按设定路径移动生成的激光雷达数据序列和舵轮编码数据序列;
将所述激光雷达数据序列和舵轮编码数据序列整合得到舵轮移动数据序列,其中所述舵轮移动数据序列包括多组按照时间顺序排列的舵轮移动数据,每组舵轮移动数据包括由两个激光雷达数据的采样时刻所确定的所述舵轮移动数据的起始时间和终止时间以及激光雷达位姿变换数据,以及由所述舵轮编码数据所确定的位于所述起始时间和终止时间之间舵轮平均转速和至少一初始舵轮偏航角;
以同一所述舵轮移动数据中的基于所述初始舵轮偏航角以及舵轮平均转速计算的第一旋转角度与由所述激光雷达位姿变换数据确定第二旋转角度相等为旋转约束条件,确定舵轮编码器内参中的舵轮零偏值;
基于手眼标定的平移约束条件确定所述舵轮编码器内参中的舵轮半径、车体轴距,以及确定激光雷达与所述舵轮编码器之间的外参。
2.根据权利要求1所述的方法,其特征在于,所述以同一所述舵轮移动数据中的基于所述初始舵轮偏航角以及舵轮平均转速计算的第一旋转角度与由所述激光雷达位姿变换数据确定的第二旋转角度相等为旋转约束条件,确定舵轮编码器内参中的舵轮零偏值,包括:
利用所述初始舵轮偏航角和所述舵轮零偏值的求和结果的正弦值、所述舵轮平均转速以及舵轮半径的乘积结果与所述车体轴距的比值所计算获得的所述第一旋转角度与对应的所述第二旋转角度构建等量关系式,其中,所述车体轴距为所述舵轮的转动轴心与两个从动轮中心点连线之间的垂直距离;
基于至少两组所述等量关系式,确定所述舵轮零偏值。
3.根据权利要求2所述的方法,其特征在于,所述等量关系式表示为:
Figure FDA0003887612460000021
其中,k1、k2为待计算参数,
Figure FDA0003887612460000022
θl、θw、nw分别为所述第二旋转角度、所述起始时间的初始舵轮偏航角、所述起始时间和所述终止时间之间的舵轮平均转速,r为所述舵轮半径,b为所述车体轴距,tend和tstart分别为终止时间和起始时间;
所述基于至少两组所述等量关系式,确定所述舵轮零偏值,包括:
基于至少两组所述等量关系式计算出所述待计算参数的k1、k2
基于以下公式计算所述舵轮零偏值:
Figure FDA0003887612460000023
4.根据权利要求2所述的方法,其特征在于,所述舵轮移动数据包括与所述起始时间和所述终止时间对应的两个舵轮编码数据以及位于所述两个舵轮编码数据之间的至少一个舵轮编码数据,所述等量关系式表示为:
Figure FDA0003887612460000024
其中,M为所述舵轮编码数据的数量,θl为所述第二旋转角度,tk+1和tk是第k个舵轮编码数据和第k+1个舵轮编码数据的采样时间,
Figure FDA0003887612460000025
是由在tk+1和tk所采集的舵轮转速/>
Figure FDA0003887612460000026
和/>
Figure FDA0003887612460000027
计算的舵轮平均转速,/>
Figure FDA0003887612460000028
和/>
Figure FDA0003887612460000029
在tk+1和tk所采集的初始舵轮偏航角。
5.根据权利要求1所述的方法,其特征在于,所述方法还包括:去除所述舵轮移动数据序列中不符合设定规则的舵轮移动数据。
6.根据权利要求5所述的方法,其特征在于,所述去除所述舵轮移动数据序列中不符合设定规则的舵轮移动数据,包括:
去除所述舵轮移动数据序列中舵轮平均转速小于设定速度阈值的舵轮移动数据。
7.根据权利要求5所述的方法,其特征在于,所述去除所述舵轮移动数据序列中不符合设定规则的舵轮移动数据,包括:
去除所述舵轮移动数据序列中激光雷达偏转方向与舵轮编码器偏转方向相反的舵轮移动数据。
8.根据权利要求5所述的方法,其特征在于,所述去除所述舵轮移动数据序列中不符合设定规则的舵轮移动数据,包括:
去除所述舵轮移动数据序列中,从所述起始时间到终止时间的舵轮偏转角变化超过设定角度偏差阈值的舵轮移动数据。
9.根据权利要求1所述的方法,其特征在于,所述方法还包括:
计算每个所述舵轮移动数据所对应的激光位姿增量矩阵和由所述外参构建的外参矩阵的乘积与所述外参矩阵和编码器位姿增量矩阵的乘积的差值;
以所述舵轮移动数据序列中的多个舵轮移动数据所对应的差值之和最小化为目标对所述外参进行优化;
将所述差值不符合判定条件的舵轮移动数据去除,得到新的舵轮移动数据序列;
返回所述计算每个所述舵轮移动数据所对应的激光位姿增量矩阵和由所述外参构建的外参矩阵的乘积与所述外参矩阵和编码器位姿增量矩阵的乘积的差值的步骤,直至满足迭代结束条件。
10.一种单舵轮移动装置的参数标定装置,其特征在于,所述装置包括相互耦接的处理器和存储器;所述存储器中存储有计算机程序,所述处理器用于执行所述计算机程序以实现如权利要求1-9中任一项所述方法的步骤。
11.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有程序数据,所述程序数据被处理器执行时实现如权利要求1-9中任一项所述方法的步骤。
CN202211250957.2A 2022-10-12 2022-10-12 单舵轮移动装置的参数标定方法、装置及可读存储介质 Pending CN115855099A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211250957.2A CN115855099A (zh) 2022-10-12 2022-10-12 单舵轮移动装置的参数标定方法、装置及可读存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211250957.2A CN115855099A (zh) 2022-10-12 2022-10-12 单舵轮移动装置的参数标定方法、装置及可读存储介质

Publications (1)

Publication Number Publication Date
CN115855099A true CN115855099A (zh) 2023-03-28

Family

ID=85661491

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211250957.2A Pending CN115855099A (zh) 2022-10-12 2022-10-12 单舵轮移动装置的参数标定方法、装置及可读存储介质

Country Status (1)

Country Link
CN (1) CN115855099A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117415858A (zh) * 2023-12-18 2024-01-19 上海仙工智能科技有限公司 单舵轮移动机器人舵角补偿标定方法及***、存储介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117415858A (zh) * 2023-12-18 2024-01-19 上海仙工智能科技有限公司 单舵轮移动机器人舵角补偿标定方法及***、存储介质
CN117415858B (zh) * 2023-12-18 2024-03-19 上海仙工智能科技有限公司 单舵轮移动机器人舵角补偿标定方法及***、存储介质

Similar Documents

Publication Publication Date Title
CN107516326B (zh) 融合单目视觉和编码器信息的机器人定位方法和***
CN109959381B (zh) 一种定位方法、装置、机器人及计算机可读存储介质
Wu et al. Hand-eye calibration: 4-D procrustes analysis approach
CN113066105A (zh) 激光雷达和惯性测量单元融合的定位与建图方法及***
CN113625288A (zh) 基于点云配准的相机与激光雷达位姿标定方法和装置
CN115855099A (zh) 单舵轮移动装置的参数标定方法、装置及可读存储介质
CN111160298B (zh) 一种机器人及其位姿估计方法和装置
WO2021161682A1 (en) System and method for tracking expanded state of an object
CN113311411A (zh) 一种用于移动机器人的激光雷达点云运动畸变校正方法
CN112183171A (zh) 一种基于视觉信标建立信标地图方法、装置
CN111307174A (zh) 一种传感器的标定方法、运动物体及存储介质
CN110930444B (zh) 一种基于双边优化的点云匹配方法、介质、终端和装置
CN114913242A (zh) 相机标定方法、装置、***、电子设备和存储介质
CN113658194A (zh) 一种基于参照物的点云拼接方法、装置及存储介质
CN110515060B (zh) 多线激光雷达反射率标定的方法
CN116038720A (zh) 一种基于点云配准的手眼标定方法、装置及设备
CN113763434B (zh) 一种基于卡尔曼滤波多运动模型切换的目标轨迹预测方法
CN111380562A (zh) 一种双轮差速机器人里程计参数的校准方法及装置
CN116372941B (zh) 机器人参数标定方法及装置和轮式机器人
US12014551B2 (en) Method, device, computer program and computer program product for providing a trajectory of an object for a vehicle
CN113450411A (zh) 一种基于方差分量估计理论的实时自生位姿计算方法
KR102250687B1 (ko) 3차원 VR을 위한 2차원 LiDAR 기반 전 방향 3차원 계측 기법 및 이의 장치
CN113375658A (zh) 移动机器人故障下同时fdd和slam的方法及***
CN114764830A (zh) 一种基于四元数ekf和未标定手眼***的物***姿估算方法
CN115342830A (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