Esta página se ha traducido mediante traducción automática. Haga clic aquí para ver la última versión en inglés.

transformScan

Transformar el escaneo láser según la pose relativa

Sintaxis

transScan = transformScan(scan,relPose)

[transRanges,transAngles] = transformScan(ranges,angles,relPose)

Descripción

transScan = transformScan(scan,relPose) transforma el escaneo láser especificado en scan utilizando la pose relativa especificada, relPose.

[transRanges,transAngles] = transformScan(ranges,angles,relPose) transforma el escaneo láser especificado en ranges y angles utilizando la pose relativa especificada, relPose.

Ejemplos

Transformar los escaneos láser

Cree un objeto lidarScan. Especifique los alcances y los ángulos como vectores.

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

Traslade el escaneo láser con un desplazamiento de [x y] de (0.5,0.2).

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

Gire el escaneo láser 20 grados.

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

Utilice Scan Matching para transformar escaneos

Utilice la función matchScans para encontrar la transformación relativa entre dos escaneos LiDAR . Luego, transforme el segundo escaneo en el marco de coordenadas del primer escaneo.

Cargue un par de escaneos LiDAR como un par de objetos lidarScan. Son dos escaneos de la misma escena con un cambio de pose relativa.

load tb3_scanPair.mat
plot(s1)
hold on
plot(s2)
hold off

La pose relativa se estima a partir de un sensor de odometría y se proporciona como una variable, initGuess, como [x y theta].

disp(initGuess)

   -0.7000    0.1500   -0.3254

Utilice la coincidencia de escaneo para encontrar la pose relativa entre los dos escaneos láser y especifique la suposición inicial de la pose.

pose = matchScans(s2,s1,"InitialPose",initGuess);
disp(pose)

   -0.7213    0.1160   -0.2854

Transforme el segundo escaneo al marco de coordenadas del primer escaneo. Traza los dos escaneos para ver que ahora se superponen.

s2Transformed = transformScan(s2,pose);
plot(s1)
hold on
plot(s2Transformed)
hold off

Argumentos de entrada

scan — Lecturas de escaneo Lidar

objeto lidarScan

Lecturas de escaneo Lidar, especificadas como un objeto lidarScan.

ranges — Valores de rango de datos de escaneo

vector

Valores de rango de los datos de escaneo, especificados como un vector en metros. Estos valores de rango son distancias desde un sensor en angles especificado. El vector debe tener la misma longitud que el vector angles correspondiente.

angles — Valores de ángulo de datos de escaneo

vector

Valores de ángulo de datos de escaneo, especificados como un vector en radianes. Estos valores de ángulo son los ángulos específicos del ranges especificado. El vector debe tener la misma longitud que el vector ranges correspondiente.

relPose — Pose relativa del escaneo actual

[x y theta]

Pose relativa del escaneo actual, especificada como [x y theta], donde [x y] es la traslación en metros y theta es la rotación en radianes.

Argumentos de salida

transScan — Lecturas de escaneo lidar transformadas

objeto lidarScan

Lecturas de escaneo LiDAR transformadas, especificadas como un objeto lidarScan.

transRanges — Valores de rango de escaneo transformado

vector

Valores de rango del escaneo transformado, devueltos como un vector en metros. Estos valores de rango son distancias desde un sensor en transAngles especificado. El vector tiene la misma longitud que el vector transAngles correspondiente.

transAngles — Valores de ángulo de datos de escaneo

vector

Valores de ángulo del escaneo transformado, devueltos como un vector en radianes. Estos valores de ángulo son los ángulos específicos del transRanges especificado. El vector tiene la misma longitud que el vector ranges correspondiente.

Capacidades ampliadas

Generación de código C/C++
Genere código C y C++ mediante MATLAB® Coder™.

Historial de versiones

Introducido en R2017a

Consulte también

matchScans | controllerVFH | monteCarloLocalization

Temas

• Estimar la pose del robot con escaneo coincidente