CN114442054A - 一种移动机器人的传感器与底盘联合标定系统及方法 - Google Patents
一种移动机器人的传感器与底盘联合标定系统及方法 Download PDFInfo
- Publication number
- CN114442054A CN114442054A CN202111579789.7A CN202111579789A CN114442054A CN 114442054 A CN114442054 A CN 114442054A CN 202111579789 A CN202111579789 A CN 202111579789A CN 114442054 A CN114442054 A CN 114442054A
- Authority
- CN
- China
- Prior art keywords
- calibration
- mobile robot
- sensor
- chassis
- point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims description 25
- 238000011065 in-situ storage Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 abstract description 3
- 238000009434 installation Methods 0.000 abstract description 3
- 238000012423 maintenance Methods 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/40—Means for monitoring or calibrating
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
Abstract
本发明公开了一种移动机器人的传感器与底盘联合标定系统及方法,包括底盘和传感器机构,传感器机构包括至少一个能够同步建图与定位的传感器;标定系统的标定参数包括传感器外参、轮径、轮间距、舵轮零位和里程计参数等;本发明公开的移动机器人的传感器与底盘联合标定方法,可自动对移动机器人下发移动指令并根据实际移动向量进行标定直至参数收敛成功,即可实现标定;本发明提供的一种移动机器人的传感器与底盘联合标定系统及方法中移动机器人参数标定无需复杂的标定件或设备,并且一次操作,计算输出传感器安装位姿和底盘运动参数全套参数,节省维护的设备成本和时间成本;本发明标定精确度高,操作成本低,能够应用于各种场合,适宜推广。
Description
技术领域
本发明涉及移动机器人感知与标定技术,具体是一种移动机器人的传感器与底盘联合标定系统及方法。
背景技术
近年来,移动机器人技术在多个应用领域蓬勃发展,包括工业物流、电商仓储、自动驾驶等。其中,“参数标定”是移动机器人的关键技术。通过一系列辅助设备及方法,获取精确的传感器相对于底盘的安装参数以及执行机构的控制参数,使得移动机器人可以平稳运行,达到最佳精度。然而,目前的“参数标定”技术架构有如下局限:依赖精密的标定件或运动捕捉仪器,若移动机器人由于长途运输或长时间工作中的振动、疲劳、碰撞等导致变形,则需要重新标定传感器和底盘参数,此时需要将标定件或仪器同步运往应用现场,成本高。且该类标定件或仪器,要求机械加工精度高,装配误差小,制造成本高;传统“参数标定”方法,一次标定一个传感器的参数,若想将多传感器如雷达、相机,以及驱动器参数全部标定完成,花费时间长,尤其是在多移动机器人系统中,时间成本高。目前的移动机器人参数标定相关专利如下。公开号为CN105758426A的中国专利中公开了一种移动机器人的多传感器的联合标定方法,其中移动机器人包括2D、3D雷达和相机。公开号为CN112097792A中国专利中公开了一种阿克曼模型移动机器人里程计标定方法。公开号为CN106289327B的中国专利中公开了一种差分移动机器人里程计标定方法。公开号为CN106289327B的中国专利中公开了一种双轮差速移动机器人里程计标定的轮间距修正方法。综合上面公开的材料来看,目前的移动机器人标定方法有以下局限:一是依赖外部高精度标定件或运动捕捉系统,在工作现场参数标定成本高;二是只能标定传感器参数,或只能根据精确的传感器参数来标定底盘参数,时间成本高。
发明内容
本发明的目的在于提供一种移动机器人的传感器与底盘联合标定系统,以解决上述背景技术中提出的问题。
为实现上述目的,本发明提供如下技术方案:一种移动机器人的传感器与底盘联合标定系统,所述联合标定系统包括底盘和传感器机构,所述传感器机构包括至少一个能够同步建图与定位的传感器;所述标定系统的标定参数包括传感器外参、轮径、轮间距、舵轮零位和里程计参数。
作为本发明的一种优选技术方案,上述底盘为阿克曼模型底盘、单舵轮型底盘、差速轮型底盘、双舵轮型底盘或者全向轮型底盘中的一种。
作为本发明的一种优选技术方案,上述传感器为2D雷达、3D雷达、深度相机或者相机中的一种。
一种移动机器人的传感器与底盘联合标定方法,所述标定方法包括以下步骤:
步骤一、选取水平的地面;
步骤二、标定传感器外参:选定原点,坐标为U0(x0,y0,θ0),其中x0为坐标系中横坐标,y0为坐标系中纵坐标,θ0为航向角度坐标;移动机器人到第一个点记录为第一个目标点,此点坐标为U1(x1,y1,θ1);将移动机器人手动移动到第二个点,记录为第二个目标点,此点坐标为U2(x2,y2,θ2);原地旋转移动机器人180°,记录为第三个目标点,此点坐标为U3(x3,y3,θ3);
步骤三、标定底盘控制参数和里程计参数:手动移动机器人在地面缓慢绕一圈;将移动机器人停在围出的一圈的内部区域的中央,给机器人发送移动指令移动结束后通过SLAM计算实际移动向量比较移动指令和实际移动向量直至对移动机器人进行标定矩阵收敛成功;标定控制参数标定完成后,再将移动机器人停在围出的一圈的内部区域的中央,给机器人发送移动指令移动结束后通过SLAM计算实际移动向量比较里程计反馈和实际移动向量直至对移动机器人进行标定矩阵收敛成功。
作为本发明的一种优选技术方案,上述步骤一中的水平地面为矩形区域,矩形区域的长度大于等于8m,矩形区域的宽度大于等于3m。
作为本发明的一种优选技术方案,上述步骤二中第一个目标点U1(x1,y1,θ1),其中x1为坐标系中横坐标,y1为坐标系中纵坐标,θ1为航向角度坐标;第二个目标点坐标为U2(x2,y2,θ2),其中x2为坐标系中横坐标,y2为坐标系中纵坐标,θ2为航向角度坐标;接着再将车体原地旋转180°,第三个目标点为U3(x3,y3,θ3),其中x3为坐标系中横坐标,y3为坐标系中纵坐标,θ3为航向角度坐标;移动机器人外参为其中 uiθ=θ0-(arctan((y2-y1)/(x2-x1))-θ1)。
作为本发明的一种优选技术方案,上述步骤二中以矩形区域较长的一边的一个端点为原点,此点坐标为U0;移动机器人沿矩形区域较长的一边移动一段大于等于5m距离,记录为第一个目标点,此点坐标为U1;将移动机器人手动移动到步骤二所述的较长的一边的另一个端点,记录为第二个目标点,此点坐标为U2。
作为本发明的一种优选技术方案,上述步骤二中U1(x1,y1,θ1)、U2(x2,y2,θ2)及U3(x3,y3,θ3)可以选取一个瞬时的点坐标,也可以选取一组连续的点集,求得其均值获得的坐标点。
通过下面公式解算标定矩阵X的近似解,获取标定数值;
X=(ui Tui)-1ui Tui *
上述公式可以改为:
上述公式为每一帧提供的方程组,可以通过解算标定矩阵X的近似解获取标定数值,计算公式如下:
与现有技术相比,本发明的有益效果是:
本发明通过此方法,移动机器人参数标定无需复杂的标定件或设备,并且一次操作,计算输出传感器安装位姿和底盘运动参数全套参数,节省维护的设备成本和时间成本。本发明标定精确度高,操作成本低,能够应用于各种场合,适宜推广。
附图说明
附图1是矩形区域示意图;
附图2是移动机器人沿着矩形区域较长的边移动示意图;
附图3是移动机器人原地旋转180°示意图;
附图4是移动机器人沿区域边界行驶一圈示意图;
附图5是移动机器人圈出的区域内自主移动路径示意图。
具体实施方式
为了使本领域的技术人员更好地理解本申请方案,下面将结合本申请实施例中的附图对本申请实施例中的技术方案进行清楚、完整的描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动成果前提下所获得的所有其他实施例,都应当属于本申请保护的范围。
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合,下面将参考附图1-5,并结合实施例来详细说明本申请。一种移动机器人的传感器与底盘联合标定系统,所述联合标定系统包括底盘和传感器机构,所述底盘为阿克曼模型底盘,
在本发明的另一个实施例中底盘为单舵轮型底盘;
在本发明的另一个实施例中底盘为差速轮型底盘;
在本发明的另一个实施例中底盘为双舵轮型底盘;
所述传感器机构包括至少一个能够同步建图与定位的传感器;所述传感器为2D雷达;
在本发明的另一个实施例中传感器为3D雷达;
在本发明的另一个实施例中传感器为深度相机;
在本发明的另一个实施例中传感器为相机;
所述标定系统的标定参数包括轮径、轮间距、舵轮零位和里程计参数。
本实施例还提供了一种移动机器人的传感器与底盘联合标定方法,所述标定方法包括以下步骤:
步骤一、选取水平的地面,如图1所示,本实施例选取的水平地面为矩形区域,矩形区域的长度大于等于8m,矩形区域的宽度大于等于3m;
在地面上选定一点为原点,此点坐标记为U0(x0,y0,θ0),其中x0为坐标系中横坐标,y0为坐标系中纵坐标,θ0为航向角度坐标;
步骤二、标定传感器外参:在地面上选定一点为原点,此点坐标记为U0(x0,y0,θ0),其中x0为坐标系中横坐标,y0为坐标系中纵坐标,θ0为航向角度坐标;移动机器人沿矩形区域较长的一边移动一段大于等于5m距离,记录为第一个目标点,此点坐标为U1;将移动机器人手动移动到步骤二所述的较长的一边的另一个端点,记录为第二个目标点,此点坐标为U2。接着再将车体原地旋转180°,采集车体的定位点U3(x3,y3,θ3)。基于采集的三组点坐标,即可计算出激光雷达相对于车体坐标系的移动机器人外参 其中
uiθ=θ0-(arctan((y2-y1)/(x2-x1))-θ1)。上述的点A、点B及点C可以是一个瞬时的点坐标,也可以是分别采集一组连续的点集,求得其均值获得的坐标点,以降低激光雷达定位误差对外参标定误差的影响。
步骤三、标定底盘控制参数:手动移动机器人在地面缓慢绕一圈;将移动机器人停在围出的一圈的内部区域的中央,给机器人发送移动指令移动结束后通过SLAM计算实际移动向量这样我们可以获得标定矩阵为使得u* i=X*ui;对标定矩阵X重新组合,得到所以u* i=X*ui可以改为:
通过下面公式解算标定矩阵X的近似解,获取标定数值;
X=(ui Tui)-1ui Tui *
上述公式可以改为:
上述公式为每一帧提供的方程组,可以通过解算标定矩阵X的近似解获取标定数值,计算公式如下:
以上的,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (10)
1.一种移动机器人的传感器与底盘联合标定系统,其特征在于,所述联合标定系统包括底盘和传感器机构,所述传感器机构包括至少一个能够同步建图与定位的传感器;所述标定系统的标定参数包括传感器外参、轮径、轮间距、舵轮零位和里程计参数。
2.根据权利要求1所述的一种移动机器人的传感器与底盘联合标定系统,其特征在于,所述底盘为阿克曼模型底盘、单舵轮型底盘、差速轮型底盘、双舵轮型底盘或者全向轮型底盘中的一种。
3.根据权利要求1所述的一种移动机器人的传感器与底盘联合标定系统,其特征在于,所述传感器为2D雷达、3D雷达、深度相机或者相机中的一种。
4.一种移动机器人的传感器与底盘联合标定方法,其特征在于,所述标定方法包括以下步骤:
步骤一、选取水平的地面;
步骤二、标定传感器外参:选定原点,坐标为U0(x0,y0,θ0),其中x0为坐标系中横坐标,y0为坐标系中纵坐标,θ0为航向角度坐标;移动机器人到第一个点记录为第一个目标点,此点坐标为U1(x1,y1,θ1);将移动机器人手动移动到第二个点,记录为第二个目标点,此点坐标为U2(x2,y2,θ2);原地旋转移动机器人180°,记录为第三个目标点,此点坐标为U3(x3,y3,θ3);
5.根据权利要求4所述的一种移动机器人的传感器与底盘联合标定方法,其特征在于,所述步骤一中的水平地面为矩形区域,矩形区域的长度大于等于8m,矩形区域的宽度大于等于3m。
7.根据权利要求4所述的一种移动机器人的传感器与底盘联合标定方法,其特征在于,所述步骤二中以矩形区域较长的一边的一个端点为原点,此点坐标为U0;移动机器人沿矩形区域较长的一边移动一段大于等于5m距离,记录为第一个目标点,此点坐标为U1;将移动机器人手动移动到步骤二所述的较长的一边的另一个端点,记录为第二个目标点,此点坐标为U2。
8.根据权利要求4所述的一种移动机器人的传感器与底盘联合标定方法,其特征在于,所述步骤二中U1(x1,y1,θ1)、U2(x2,y2,θ2)及U3(x3,y3,θ3)可以选取一个瞬时的点坐标,也可以选取一组连续的点集,求得其均值获得的坐标点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111579789.7A CN114442054A (zh) | 2021-12-22 | 2021-12-22 | 一种移动机器人的传感器与底盘联合标定系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111579789.7A CN114442054A (zh) | 2021-12-22 | 2021-12-22 | 一种移动机器人的传感器与底盘联合标定系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114442054A true CN114442054A (zh) | 2022-05-06 |
Family
ID=81363394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111579789.7A Pending CN114442054A (zh) | 2021-12-22 | 2021-12-22 | 一种移动机器人的传感器与底盘联合标定系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114442054A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116026368A (zh) * | 2023-03-29 | 2023-04-28 | 上海仙工智能科技有限公司 | 移动机器人的参数联合标定方法及系统、设备、存储介质 |
CN117109638A (zh) * | 2023-10-24 | 2023-11-24 | 山东大学 | 一种在线单舵轮agv参数标定方法、系统、设备及介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101096101A (zh) * | 2006-06-26 | 2008-01-02 | 北京航空航天大学 | 机器人足目标定方法和标定装置 |
US20190195653A1 (en) * | 2017-12-27 | 2019-06-27 | Ubtech Robotics Corp | Omni wheel mileage calibration method, apparatus and robot using the same |
CN110207722A (zh) * | 2019-06-11 | 2019-09-06 | 远形时空科技(北京)有限公司 | 一种自动化标定相机里程计系统及方法 |
CN111610523A (zh) * | 2020-05-15 | 2020-09-01 | 浙江工业大学 | 一种轮式移动机器人的参数校正方法 |
CN112882053A (zh) * | 2021-01-21 | 2021-06-01 | 清华大学深圳国际研究生院 | 一种主动标定激光雷达和编码器外参的方法 |
CN113345009A (zh) * | 2021-05-31 | 2021-09-03 | 湖南大学 | 一种基于激光里程计的无人机动态障碍物检测方法 |
-
2021
- 2021-12-22 CN CN202111579789.7A patent/CN114442054A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101096101A (zh) * | 2006-06-26 | 2008-01-02 | 北京航空航天大学 | 机器人足目标定方法和标定装置 |
US20190195653A1 (en) * | 2017-12-27 | 2019-06-27 | Ubtech Robotics Corp | Omni wheel mileage calibration method, apparatus and robot using the same |
CN110207722A (zh) * | 2019-06-11 | 2019-09-06 | 远形时空科技(北京)有限公司 | 一种自动化标定相机里程计系统及方法 |
CN111610523A (zh) * | 2020-05-15 | 2020-09-01 | 浙江工业大学 | 一种轮式移动机器人的参数校正方法 |
CN112882053A (zh) * | 2021-01-21 | 2021-06-01 | 清华大学深圳国际研究生院 | 一种主动标定激光雷达和编码器外参的方法 |
CN113345009A (zh) * | 2021-05-31 | 2021-09-03 | 湖南大学 | 一种基于激光里程计的无人机动态障碍物检测方法 |
Non-Patent Citations (3)
Title |
---|
A.CENSI: "Simultaneous maximum-likelihood calibration of odometry and sensor parameters", 2008 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND AUTOMATION, 13 June 2008 (2008-06-13), pages 2098 - 2103 * |
彭湃 等: "基于传感器融合里程计的相机与激光雷达自动重标定方法", 机械工程学报, vol. 57, no. 20, 20 October 2021 (2021-10-20), pages 206 - 214 * |
杨超 等: "基于非线性优化的激光雷达在线标定算法", 计算机工程与设计, vol. 42, no. 7, 31 July 2021 (2021-07-31), pages 1919 - 1925 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116026368A (zh) * | 2023-03-29 | 2023-04-28 | 上海仙工智能科技有限公司 | 移动机器人的参数联合标定方法及系统、设备、存储介质 |
CN116026368B (zh) * | 2023-03-29 | 2023-07-04 | 上海仙工智能科技有限公司 | 移动机器人的参数联合标定方法及系统、设备、存储介质 |
CN117109638A (zh) * | 2023-10-24 | 2023-11-24 | 山东大学 | 一种在线单舵轮agv参数标定方法、系统、设备及介质 |
CN117109638B (zh) * | 2023-10-24 | 2024-03-15 | 山东大学 | 一种在线单舵轮agv参数标定方法、系统、设备及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108955688B (zh) | 双轮差速移动机器人定位方法及系统 | |
CN106643805B (zh) | 激光定位传感器在agv小车中位置标定方法 | |
CN110243380B (zh) | 一种基于多传感器数据与角度特征识别的地图匹配方法 | |
CN114442054A (zh) | 一种移动机器人的传感器与底盘联合标定系统及方法 | |
US20120072075A1 (en) | Steering control device of autonomous vehicle, autonomous vehicle having the same and steering control method of autonomous vehicle | |
CN111123925A (zh) | 一种移动机器人导航系统以及方法 | |
CN107065873B (zh) | 一种基于磁带导引agv的多曲率圆周路径循迹控制方法 | |
CN109813305B (zh) | 基于激光slam的无人叉车 | |
CN111610523A (zh) | 一种轮式移动机器人的参数校正方法 | |
CN116026368B (zh) | 移动机器人的参数联合标定方法及系统、设备、存储介质 | |
CN110146866A (zh) | 一种麦克纳姆轮全向平台精确定位方法 | |
CN112097792A (zh) | 一种阿克曼模型移动机器人里程计标定方法 | |
Yin et al. | Combinatorial inertial guidance system for an automated guided vehicle | |
CN115752507A (zh) | 基于二维码导航的在线单舵轮agv参数标定方法及系统 | |
Aref et al. | Position-based visual servoing for pallet picking by an articulated-frame-steering hydraulic mobile machine | |
CN114137975A (zh) | 一种超声波辅助融合定位的无人车导航纠偏方法 | |
CN114474003A (zh) | 一种基于参数辨识的车载建筑机器人误差补偿方法 | |
CN111251303B (zh) | 一种周期性姿态调整的机器人运动控制方法 | |
CN115993089B (zh) | 基于pl-icp的在线四舵轮agv内外参标定方法 | |
Aref et al. | A multistage controller with smooth switching for autonomous pallet picking | |
Wang et al. | Visual regulation of a nonholonomic wheeled mobile robot with two points using Lyapunov functions | |
CN110027018B (zh) | 全向探测系统及方法 | |
Liikanen et al. | M-Estimator application in real-time sensor fusion for smooth position feedback of heavy-duty field robots | |
Chuwei et al. | Localization and navigation method for omni-directional mobile robot based on odometry | |
CN114637302B (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 |