matlab 分析激光雷达ROS bag.

matlab 内置丰富的函数用于提取分析激光雷达数据,提取步如下

%%
% 定义rosbag所在位置
filePath = fullfile(‘D:\lidar_data\’,‘lidar_data.bag’);

%提取bag中消息格式信息
bag = rosbag(filePath);

数据格式如下图:
在这里插入图片matlab 描述

%% bag文件数据选择,选择LaserScan
bagtopic = select(bag,‘MessageType’,{‘sensor_msgs/LaserScan’});

%% 点云数据读取
topicdata = readMessages(bagtopic);

N = length(topicdata);
M = length(topicdata{i, 1}.Ranges);

timeall = zeros(N,1);
distall = zeros(N,M);
reflectall = zeros(N,M);

for i = 1:length(topicdata)
distall(i,:) = topicdata{i, 1}.Ranges;
reflectall(i,:) = topicdata{i, 1}.Intensities;
timeall(i,:) = (topicdata{i, 1}.Header.Stamp.Sec*10^9+topicdata{i, 1}.Header.Stamp.Nsec)/(10^6);
end

timedelta = diff(timeall);
%%
tar_index = 1660;

% 角度
angle_range = (topicdata{1, 1}.AngleMin * 57.2958) :(topi

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值