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

raycast

Calcular índices de celdas a lo largo de un rayo.

Sintaxis

[endpoints,midpoints] = raycast(map,pose,range,angle)

[endpoints,midpoints] = raycast(map,p1,p2)

Descripción

[endpoints,midpoints] = raycast(map,pose,range,angle) devuelve los índices de celda del map especificado para todas las celdas atravesadas por un rayo que se origina en el pose especificado en los valores angle y range especificados. endpoints contiene todos los índices tocados por el final del rayo, con todos los demás puntos incluidos en midpoints.

[endpoints,midpoints] = raycast(map,p1,p2) devuelve los índices de celda del segmento de línea entre los dos puntos especificados.

Ejemplos

Obtener celdas de cuadrícula a lo largo de un rayo

Utilice el método raycast para generar índices de celda para todas las celdas atravesadas por un rayo.

Crea un mapa vacío. Se utiliza un mapa de baja resolución para ilustrar las ubicaciones de la cuadrícula afectadas.

map = occupancyMap(10,10,1);
show(map)

Obtenga los índices de cuadrícula de los puntos medios y finales de un rayo desde [2 3] hasta [8.5 8]. Establezca valores de ocupación para estos índices de cuadrícula. Los puntos medios se tratan como espacios abiertos. Actualice los puntos finales con una observación ocupada.

p1 = [2 3];
p2 = [8.5 8];
[endPts,midPts] = raycast(map,p1,p2);
setOccupancy(map,midPts,zeros(length(midPts),1),'grid');
setOccupancy(map,endPts,ones(length(endPts),1),'grid');

Traza el rayo original sobre el mapa. Cada celda de la cuadrícula tocada por la línea se actualiza. El punto de partida se superpone a varias celdas y la línea toca el borde de ciertas celdas, pero todas las celdas aún están actualizadas.

show(map)
hold on
plot([p1(1) p2(1)],[p1(2) p2(2)],'-b','LineWidth',2)
plot(p2(1),p2(2),'or')
grid on

Argumentos de entrada

map — Representación de mapa

objeto occupancyMap

Representación de mapa, especificada como un objeto occupancyMap. Este objeto representa el entorno del sensor. El objeto contiene una cuadrícula matricial con valores que representan la probabilidad de ocupación de esa celda. Los valores cercanos a 1 representan una alta probabilidad de que la celda contenga un obstáculo. Valores cercanos a 0 representan una alta probabilidad de que la celda no esté ocupada y libre de obstáculos.

pose — Posición y orientación del sensor.

vector de tres elementos

Posición y orientación del sensor, especificada como un vector [x y theta]. La posición del sensor es una posición x y y con orientación angular theta (en radianes) medida desde el eje x.

range — rango de rayo

escalar

Rango del rayo, especificado como escalar en metros.

angle — ángulo del rayo

escalar

Ángulo del rayo, especificado como escalar en radianes. El valor del ángulo es para el range correspondiente.

p1 — Punto de partida del rayo

vector de dos elementos

Punto de inicio del rayo, especificado como un vector de dos elementos [x y]. El punto está definido en el marco mundial.

p2 — Punto final del rayo

vector de dos elementos

Punto final del rayo, especificado como un vector de dos elementos [x y]. El punto está definido en el marco mundial.

Argumentos de salida

endpoints — Índices de cuadrícula de puntos finales

matriz de n por 2

Índices de puntos finales, devueltos como una matriz n por 2 de pares [i j], donde n es el número de índices de cuadrícula. Los puntos finales son donde el valor range llega al angle especificado. Se devuelven varios índices cuando el punto final se encuentra en el límite de varias celdas.

midpoints — Índices de cuadrícula de punto medio

matriz de n por 2

Índices de punto medio, devueltos como una matriz n por 2 de pares [i j], donde n es el número de índices de la cuadrícula. Este argumento incluye todos los índices de cuadrícula que cruza el rayo, excluyendo el punto final.

Capacidades ampliadas

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

Historial de versiones

Introducido en R2019b

Consulte también

occupancyMap

Temas

• Cuadrículas de ocupación