单线激光雷达(SICK)驱动安装及时空标定
创始人
2024-05-29 21:18:08
0

一、引言

1、AGV需要同时具备定位、避障与导航的功能,其中避障对于雷达本身的分辨率、精度要求并不是很高,只需要能够根据预设定的雷达扫描范围准确避开障碍物即可,故本文以TIM240(SICK激光类雷达)为例介绍实现多雷达时空标定的问题。
2、多个避障雷达可能会被安装在车体各个位置,并且不一定有重叠区域,所以通过提取特征点再进行ICP或NDT配准的方法获取相对位姿变换关系的方式不可行,由于机械结构本身已经按照设计图纸预先设置好雷达的安装位置,所以雷达之间的相对位置关系相对准确,故可以直接利用已有参数可以进行雷达空间标定,将两个雷达数据统一到同一个坐标系下进行,需要用到PCL库。
3、坐标变换实际使用过程当中确实可以用tf进行静态坐标变换,但是相比较直接手动写代码进行转换延迟较高,故采用手动根据相对位置关系进行坐标变换的方式。
4、进行时空标定步骤主要分为:(1)驱动安装及雷达参数配置(2)雷达时间同步(3)雷达空间同步(Rp+T,这里的旋转矩阵和平移矩阵的定义后文会给出)

二、整体思路与流程

1、SICK激光雷达驱动安装
新买的SICK雷达不仅需要安装驱动,还需要进配置文件修改参数才能正常工作
(1)安装驱动

mkdir -p ./sick_scan_ws
cd ./sick_scan_wsmkdir ./src
pushd ./src
git clone https://ghproxy.com/https://github.com/SICKAG/libsick_ldmrs.git
git clone https://ghproxy.com/https://github.com/SICKAG/msgpack11.git
git clone https://ghproxy.com/https://github.com/SICKAG/sick_scan_xd.git
popdmkdir -p ./build/msgpack11
pushd ./build/msgpack11
cmake -G "Unix Makefiles" -D CMAKE_CXX_FLAGS=-fPIC -D CMAKE_BUILD_TYPE=Release -D MSGPACK11_BUILD_TESTS=0 ../../src/msgpack11
make
sudo make install
popdsource /opt/ros/melodic/setup.bash # replace noetic by your ros distro
catkin_make_isolated --install --cmake-args -DROS_VERSION=1 -Wno-dev
source ./devel_isolated/setup.bash

(2)雷达配置文件修改
1)首先需要设置PC机的以太网ip端口号如:192.168.0.2
2)SICK官网下载sopas软件,在Windows端使用(用Win10系统,Win11有问题)
3)进入软件,修改登录权限为授权的用户,密码是client
在这里插入图片描述
4)修改雷达ip(与PC机同一网段即可,192.168.0.1以及Cola dialect改为cola binary格式。此处修改雷达ip是为了保证两个雷达能同时使用
在这里插入图片描述
(3)硬件组装
需要交换机、电源模块、电源线(普通的家庭供电线就可以,火线为棕灰色、地线为黄绿双色、零线为蓝色,分别对应接到电源模块的L端、FG端、N端)、供电线、网线,如下图连接示意图
在这里插入图片描述
(4)修改雷达启动文件(launch),需要创建两个启动文件,分别对应不同ip的雷达,我这里设置一个ip为192.168.0.1,一个为192.168.0.3,因为PC的ip为192.168.0.2



                                            

2、SICK激光雷达时间同步
主要使用ros官方提供的软同步方式(message_filters
使用方式如下:

ros::Publisher pointcloud_pub;
typedef message_filters::sync_policies::ApproximateTime testSyncPolicy;void callback(const sensor_msgs::PointCloud2ConstPtr &point1, const sensor_msgs::PointCloud2ConstPtr &point2)  //回调中包含多个消息
{//需要处理的内容//
}int main (int argc, char **argv)
{ros::init (argc, argv, "lidar2base");ros::NodeHandle n;pointcloud_pub = n.advertise("/scan", 1000);//发布的话题message_filters::Subscriber pointcloud1_sub(n, "/cloud1", 1);// 需要同步的topic1message_filters::Subscriber pointcloud2_sub(n, "/cloud2", 1);// 需要同步的topic2 message_filters::Synchronizer sync(testSyncPolicy(10), pointcloud1_sub, pointcloud2_sub);// 同步sync.registerCallback(boost::bind(&callback, _1, _2));ros::spin();ros::shutdown();return 0;
}

3、SICK激光雷达空间同步
主要是通过雷达之间的旋转和平移参数将两个雷达数据统一到一个坐标系下再使用PCL库对雷达数据进行融合,这里编写了相关函数

//坐标变换将激光雷达坐标系下的点转换到小车坐标系下
void transPoint(pcl::PointCloud::Ptr lidarCloud,pcl::PointCloud::Ptr carCloud,double yaw,double pitch,double roll,double x,double y,double z)
{Eigen::Matrix4f transform=Eigen::Matrix4f::Identity();Eigen::Matrix4f transformYaw;Eigen::Matrix4f transformPitch;Eigen::Matrix4f transformRoll;//航向角transformYaw<

如下图:
需求是通过上述函数将P点从激光雷达坐标系变换到车体坐标系,函数的输入分别为偏航角yaw, pitch, roll,x,y,z
在这里插入图片描述
偏航角yaw的获取方式是:以车坐标系为右手基准坐标系,大拇指指向为z轴正方向,激光雷达系为目标坐标系,顺时针旋转z轴的角度分量为yaw的值,图中x1Oy1为车体坐标系。
同理俯仰角pictch为绕y轴旋转角度分量,横滚角roll为绕x轴的分量。
平移分量(x, y, z)是激光雷达相对于车体坐标原点的x,y,z的坐标。

在这里插入图片描述4、雷达数据融合
需要将ros的PointCloud2类型数据转换为PCL数据类型,而后将PCL数据类型转为ros的LaserScan数据类型。
1)数据融合主要在SICK激光雷达时间同步这一部分的回调函数中写:

    pcl::PointCloud::Ptr colorcloud1(new pcl::PointCloud);pcl::fromROSMsg(*point1, *colorcloud1);pcl::PointCloud::Ptr colorcloud2(new pcl::PointCloud);pcl::fromROSMsg(*point2, *colorcloud2);pcl::PointCloud::Ptr output_points1(new pcl::PointCloud);pcl::PointCloud::Ptr output_points2(new pcl::PointCloud);transPoint(colorcloud1, output_points1, yaw1, pitch1, roll1, x1, y11, z1);transPoint(colorcloud2, output_points2, yaw2, pitch2, roll2, x2, y2, z2);pcl::PointCloud output = *output_points1 + *output_points2;//pcl::toROSMsg((*output_points1 + *output_points2), output);//以实时发布的方式发布sensor_msgs::LaserScan output2 = PointCloudToLaserscan(output);output2.header.frame_id = "base_link";pointcloud_pub.publish(output2);

2)PCL转LaserScan单独写了一个函数

sensor_msgs::LaserScan PointCloudToLaserscan(pcl::PointCloud& _pointcloud)
{float angle_min, angle_max, range_min, range_max, angle_increment;//需要自行调整的参数angle_min = -2.094395102;angle_max =  2.094395102;range_min = 0.05;range_max = 10;//角度分辨率,分辨率越小,转换后的误差越小angle_increment = 0.0174444444;//计算扫描点个数unsigned int beam_size = ceil((angle_max - angle_min) / angle_increment);sensor_msgs::LaserScan output;output.header.stamp = ros::Time::now();output.header.frame_id = "base_link";output.angle_min = angle_min;output.angle_max = angle_max;output.range_min = range_min;output.range_max = range_max;output.angle_increment = angle_increment;output.time_increment = 0.0;output.scan_time = 0.0;//先将所有数据用nan填充output.ranges.assign(beam_size, std::numeric_limits::quiet_NaN());//output.intensities.assign(beam_size, std::numeric_limits::quiet_NaN());for (auto point : _pointcloud.points){float range = hypot(point.x, point.y);float angle = atan2(point.y, point.x);int index = (int)((angle - output.angle_min) / output.angle_increment);if (index >= 0 && index < beam_size){//如果当前内容为nan,则直接赋值if (isnan(output.ranges[index])){output.ranges[index] = range;}//否则,只有距离小于当前值时,才可以重新赋值else{if (range < output.ranges[index]){output.ranges[index] = range;}}//output.intensities[index] = point.intensity;}}return output;
}

5、创建启动脚本
首先启动两个雷达,其次启动坐标转换的脚本,即可实现两个雷达的时空同步

#!/bin/bash
gnome-terminal --tab -- bash -c "roslaunch sick_scan sick_tim_240_1.launch"
sleep 1s
gnome-terminal --tab -- bash -c "roslaunch sick_scan sick_tim_240_2.launch "
sleep 2s
gnome-terminal --tab -- bash -c "source /home/lixushi/catkin_ws/devel/setup.bash; roslaunch lidar2base lidar2base.launch"

如下图为雷达实际摆放位置
在这里插入图片描述

转换前的点云图
在这里插入图片描述
转换后的点云图
在这里插入图片描述

三、参考文献

[1] https://blog.csdn.net/m0_68312479/article/details/128266483
[2] https://blog.csdn.net/hltt3838/article/details/123067620
[3] https://blog.csdn.net/m0_68312479/article/details/128266483
[4] https://adamshan.blog.csdn.net/article/details/105930565?spm=1001.2014.3001.5502
[5] https://mp.weixin.qq.com/s?__biz=MzU1NjEwMTY0Mw==&mid=2247556040&idx=1&sn=fa1f7cc63f7aeeaed69242add86efd75&chksm=fbc862acccbfebba12fd29cef32b7a34ac296f54e8ef6f19485aff81ebddd794a3364419c90b&scene=27

相关内容

热门资讯

自动打开应用安卓系统,安卓系统... 你有没有想过,手机里的那些应用,有时候真是让人又爱又恨呢?有时候,我们急需某个应用,却得费老大力气去...
安卓系统防沉迷软件,守护青少年... 你有没有发现,现在手机上玩游戏的诱惑力简直让人无法抗拒?尤其是安卓系统,那丰富的游戏资源,简直让人停...
流量最快的安卓系统,揭秘流量最... 你有没有想过,为什么你的手机总是那么卡,而别人的手机却像开了挂一样流畅?是不是好奇,为什么有些安卓系...
小米5换换安卓系统,畅享极致性... 你有没有想过,你的小米5手机,那个陪伴你走过无数日夜的小家伙,是不是也该给它来个“换新装”了呢?没错...
国产的安卓系统手机,畅享智能生... 你有没有发现,最近国产的安卓系统手机越来越火了?没错,就是那种咱们自己研发的系统,那种让外国品牌都不...
安卓系统刷入停止,探究原因与解... 你有没有遇到过这种情况?手机刷机过程中突然停止了,安卓系统刷入停滞不前,心里那个急啊!别慌,今天就来...
汽车是安卓系统嘛,安卓系统在智... 你有没有想过,汽车里那个神奇的操作系统,是不是和安卓手机里的一样呢?没错,今天咱们就来聊聊这个话题—...
网易狼人杀 安卓系统,体验指尖... 亲爱的玩家们,你是否曾在深夜里,手机屏幕前,与一群好友展开一场惊心动魄的“狼人杀”对决?今天,就让我...
小米安卓系统小主机,探索小米安... 你有没有想过,家里的电视、电脑、平板,甚至手机,其实都可以变成一个超级智能的娱乐中心?没错,这就是小...
卡刷安卓系统大全,全面解析各类... 你有没有想过,你的安卓手机可以像变形金刚一样,随心所欲地变换模样?没错,今天就要给你揭秘一个神奇的世...
安卓系统测试流畅度,安卓系统流... 你有没有发现,现在手机更新换代的速度简直就像坐上了火箭呢!尤其是安卓系统,每次更新都让人眼前一亮。但...
安卓系统50怎么升级,轻松迈向... 亲爱的安卓用户们,你是否也像我一样,对安卓系统的更新充满了期待?没错,就是那个让我们的手机焕然一新的...
安卓5.1.1操作系统,系统特... 你知道吗?在手机世界里,操作系统就像是个大管家,它不仅决定了手机的脸面,还掌管着手机的所有“家务事”...
手机安卓系统如果升级,体验流畅... 亲爱的手机控们,你们有没有发现,你的安卓手机最近是不是总在提醒你更新系统呢?别急,别急,今天就来给你...
安卓系统怎么禁止待机,安卓系统... 手机待机时间短,是不是让你头疼不已?别急,今天就来教你一招,让你的安卓手机告别“短命”模式,延长待机...
亿联安卓苹果系统,跨平台沟通新... 你知道吗?在科技飞速发展的今天,手机操作系统可是咱们日常生活中不可或缺的一部分。说起手机系统,亿联安...
smoothx安卓系统安装ap... 你有没有想过,为什么你的手机里总是乱糟糟的,各种app堆在一起,找起来费劲得很?别急,今天就来教你怎...
安卓系统图库在哪里,图库应用位... 你有没有发现,手机里的照片越来越多,有时候想找一张特定的照片,却像大海捞针一样困难?别急,今天就来告...
安卓7.0系统自带彩蛋,隐藏彩... 你知道吗?安卓7.0系统里竟然藏着不少小秘密,就像一颗颗隐藏的彩蛋,等着我们去发现。今天,就让我带你...
安卓系统好用的电池,好用到飞起... 你有没有发现,用安卓手机的时候,电池续航能力简直让人爱不释手啊!没错,今天咱们就来聊聊这个话题——安...