Задайте данные лидара как векторы областей значений и углов. Эти значения включают показания за пределами области значений датчиков.

x = linspace(-2,2);
ranges = abs((1.5).*x.^2 + 5);
ranges(45:55) = 3.5;
angles = linspace(-pi/2,pi/2,numel(ranges));

Создать скан лидара можно путем определения областей значений и углов. Постройте график всех точек скана лидара.

scan = lidarScan(ranges,angles);
plot(scan)

Удалите недопустимые точки на основе заданной минимальной и максимальной области значений.

minRange = 0.1;
maxRange = 7;
scan2 = removeInvalidData(scan,'RangeLimits',[minRange maxRange]);
hold on
plot(scan2)
legend('All Points','Valid Points')

Создайте lidarScan объект. Задайте области значений и углы как векторы.

refRanges = 5*ones(1,300);
refAngles = linspace(-pi/2,pi/2,300);
refScan = lidarScan(refRanges,refAngles);

Переведите лазерный скан на [x y] смещение (0.5,0.2).

transformedScan = transformScan(refScan,[0.5 0.2 0]);

Поверните лазерный скан на 20 степени.

rotateScan = transformScan(refScan,[0,0,deg2rad(20)]);

Создайте ссылку на скан лидара с помощью lidarScan (Robotics System Toolbox). Задайте области значений и углы как векторы.

refRanges = 5*ones(1,300);
refAngles = linspace(-pi/2,pi/2,300); 
refScan = lidarScan(refRanges,refAngles);

Использование transformScan (Robotics System Toolbox), сгенерируйте второй скан лидара в x,y смещение (0.5,0.2).

currScan = transformScan(refScan,[0.5 0.2 0]);

Совпадайте с ссылкой скана и вторым сканом, чтобы оценить различие положения между ними.

pose = matchScans(currScan,refScan);

Используйте transformScan функция для выравнивания сканов путем преобразования второго скана в систему координат первого скана с помощью относительного различия положения. Постройте график как исходных сканов, так и выровненных сканов.

currScan2 = transformScan(currScan,pose);

subplot(2,1,1);
hold on
plot(currScan)
plot(refScan)
title('Original Scans')
hold off

subplot(2,1,2);
hold on
plot(currScan2)
plot(refScan)
title('Aligned Scans')
xlim([0 5])
hold off