[发明专利]一种应用于两轮移动机器人的激光雷达除畸变方法有效
申请号: | 202010704463.1 | 申请日: | 2020-07-21 |
公开(公告)号: | CN112083433B | 公开(公告)日: | 2023-06-13 |
发明(设计)人: | 董辉;袁登鹏;董浩;吴祥;吴宇航;童涛;夏启剑;周俊阳 | 申请(专利权)人: | 浙江工业大学 |
主分类号: | G01S17/02 | 分类号: | G01S17/02;G01S17/93;G01C21/16;G01C22/00 |
代理公司: | 杭州君度专利代理事务所(特殊普通合伙) 33240 | 代理人: | 杨天娇 |
地址: | 310014 浙*** | 国省代码: | 浙江;33 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 应用于 移动 机器人 激光雷达 畸变 方法 | ||
1.一种应用于两轮移动机器人的激光雷达除畸变方法,所述两轮移动机器人安装有激光雷达、里程计和IMU,其特征在于,所述应用于两轮移动机器人的激光雷达除畸变方法,包括:
获取一帧激光雷达中每一个激光点的原始位姿数据,该帧激光雷达中起始激光点的时间为ts、末尾激光点的时间为te;
获取第一时间段内里程计的第一位姿数据,所述第一时间段的起始时间为ta、结束时间为tb,并且ta<ts<te<tb;
获取第二时间段内IMU的加速度数据以及IMU的Z轴的角速度数据,所述第二时间段的起始时间为tm、结束时间为tn,并且tm<ta<tb<tn;
利用IMU的Z轴的角速度数据对原始位姿数据进行第一次除畸变;
利用IMU的加速度数据对里程计的第一位姿数据进行补偿得到补偿数据;
利用补偿数据对第一次除畸变后的数据进行第二次除畸变,得到激光雷达最终的除畸变数据;
其中,所述原始位姿数据按照时间顺序存放在队列Lidarlist1中,ts时刻获取的原始位姿数据存放在队列Lidarlist1的队首,记作te时刻获取的原始位姿数据存放在队列Lidarlist1的队尾,记作一帧激光雷达中每一个激光点的时间间隔为Δtr,因此队列Lidarlist1的长度为lrl;
其中,所述第一时间段内获取的里程计的第一位姿数据按照时间顺序存放在队列Odomlist1中,ta时刻采集的第一位姿数据存放在队列Odomlist1的队首,记作tb时刻采集的第一位姿数据存放在队列Odomlist1的队尾,记作相邻两个第一位姿数据的时间间隔为Δto,因此队列Odomlist1的长度为lol;
其中,所述第二时间段内获取的IMU的加速度数据按照时间顺序存放在数组Accarray1中,数组Accarray1的第一个数据存放tm时刻采集的加速度数据,数组Accarray1的最后一个数据存放tn时刻采集的加速度数据,相邻两个加速度数据的时间间隔为Δtu,数组Accarray1的长度为lal;
所述第二时间段内获取的IMU的Z轴的角速度数据按照时间顺序存放在数组Warray1中,数组Warray1的第一个数据存放tm时刻采集的角速度数据,数组Warray1的最后一个数据存放tn时刻采集的角速度数据,相邻两个角速度数据的时间间隔为Δtu,数组Warray1的长度为lal,并且存在lol>lal>lrl的关系;
其中,所述利用IMU的Z轴的角速度数据对原始位姿数据进行第一次除畸变,包括:
取数组Warray1,将数组Warray1中的每个角速度数据乘以时间间隔Δtu,得到存放在数组Warray2中,表示数组Warray1中的第K+1个角速度数据,0≤k≤(lal-1);
利用数组Warray2更新队列Lidarlist1中的原始位姿数据:取队列Lidarlist1中第K+1个原始位姿数据Lidarlist1[K]中的方位角σk,更新为
将更新σk后的队列Lidarlist1中的每一个数据以x轴坐标,y轴坐标和方位角组成的列向量左乘以一个R矩阵,记为队列Lidarlist2,完成第一次除畸变,其中R矩阵为已知的激光雷达的安装位置与IMU的安装位置之间的坐标转换矩阵。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于浙江工业大学,未经浙江工业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010704463.1/1.html,转载请声明来源钻瓜专利网。