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

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);

Используя функцию transformScan, сгенерируйте второе сканирование лазерного дальномера при смещении 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