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

getOccupancy

Obtener probabilidad de ocupación de ubicaciones

Sintaxis

occVal = getOccupancy(map,xy)

occVal = getOccupancy(map,xy,'local')

occVal = getOccupancy(map,ij,'grid')

[occVal,validPts] = getOccupancy(___)

occMatrix = getOccupancy(map)

occMatrix = getOccupancy(map,bottomLeft,matSize)

occMatrix = getOccupancy(map,bottomLeft,matSize,'local')

occMatrix = getOccupancy(map,topLeft,matSize,'grid')

Descripción

Esta función MATLAB^® devuelve los valores de probabilidad de ocupación de ubicaciones específicas en un mapa de ocupación.

occVal = getOccupancy(map,xy) devuelve una matriz de valores de ocupación de probabilidad en las ubicaciones xy en el marco mundial. 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. Las ubicaciones desconocidas, incluso fuera del mapa, devuelven map.DefaultValue.

occVal = getOccupancy(map,xy,'local') devuelve una matriz de valores de ocupación en las ubicaciones xy en el marco local.

occVal = getOccupancy(map,ij,'grid') especifica índices de celdas de cuadrícula ij en lugar de ubicaciones xy.

[occVal,validPts] = getOccupancy(___) también genera un vector de elementos n de valores lógicos que indica si las coordenadas de entrada están dentro de los límites del mapa.

occMatrix = getOccupancy(map) devuelve todos los valores de ocupación en el mapa como una matriz.

occMatrix = getOccupancy(map,bottomLeft,matSize) devuelve una matriz de valores de ocupación especificando la ubicación de la esquina inferior izquierda en coordenadas mundiales y el tamaño de la matriz en metros.

occMatrix = getOccupancy(map,bottomLeft,matSize,'local') devuelve una matriz de valores de ocupación especificando la ubicación de la esquina inferior izquierda en coordenadas locales y el tamaño de la matriz en metros.

occMatrix = getOccupancy(map,topLeft,matSize,'grid') devuelve una matriz de valores de ocupación especificando la ubicación de la esquina superior izquierda en los índices de la cuadrícula y el tamaño de la matriz.

Ejemplos

Insertar escaneos láser en el mapa de ocupación

Cree un mapa de cuadrícula de ocupación vacío.

map = occupancyMap(10,10,20);

Especifique la pose del vehículo, los alcances, los ángulos y el alcance máximo del escaneo láser.

pose = [5,5,0];
ranges = 3*ones(100,1);
angles = linspace(-pi/2,pi/2,100);
maxrange = 20;

Crea un objeto lidarScan con los rangos y ángulos especificados.

scan = lidarScan(ranges,angles);

Inserte los datos del escaneo láser en el mapa de ocupación.

insertRay(map,pose,scan,maxrange);

Muestre el mapa para ver los resultados de insertar el escaneo láser.

show(map)

Verifique la ocupación del lugar directamente frente al vehículo.

getOccupancy(map,[8 5])

ans = 
0.7000

Agregue una segunda lectura y vea la actualización de los valores de ocupación. La lectura adicional aumenta la confianza en las lecturas. Los valores libres y ocupados se vuelven más distintos.

insertRay(map,pose,scan,maxrange);
show(map)

getOccupancy(map,[8 5])

ans = 
0.8448

Obtenga valores de ocupación y verifique el estado de ocupación

Acceda a los valores de ocupación y verifique su estado de ocupación en función de los umbrales de ocupación y libertad del objeto occupancyMap.

Cree una matriz y rellénela con valores. Utilice esta matriz para crear un mapa de ocupación.

p = 0.5*ones(20,20);
p(11:20,11:20) = 0.75*ones(10,10);
map = occupancyMap(p,10);

Obtén la ocupación de diferentes ubicaciones y consulta sus estados de ocupación. El estado de ocupación devuelve 0 para espacio libre y 1 para espacio ocupado. Los valores desconocidos devuelven –1.

pocc = getOccupancy(map,[1.5 1])

pocc = 
0.7500

occupied = checkOccupancy(map,[1.5 1])

occupied = 
1

pocc2 = getOccupancy(map,[5 5],'grid')

pocc2 = 
0.5000

occupied2 = checkOccupancy(map,[5 5],'grid')

occupied2 = 
-1

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 vehículo. 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.

xy — Coordenadas del mundo real

matriz de n por 2

Coordenadas mundiales, especificadas como una matriz n por 2 de pares [x y], donde n es el número de coordenadas mundiales.

Tipos de datos: double

ij — Posiciones de cuadrícula

matriz de n por 2

Posiciones de la cuadrícula, especificadas como una matriz n por 2 de pares [i j] en formato [rows cols], donde n es el número de posiciones de la cuadrícula.

Tipos de datos: double

bottomLeft — Ubicación de la matriz de salida en el mundo o local.

vector de dos elementos | [xCoord yCoord]

Ubicación de la esquina inferior izquierda de la matriz de salida en coordenadas mundiales o locales, especificada como un vector de dos elementos, [xCoord yCoord]. La ubicación está en coordenadas mundiales o locales según la sintaxis.

Tipos de datos: double

matSize — Tamaño de la matriz de salida

vector de dos elementos | [xLength yLength] | [gridRow gridCol]

Tamaño de la matriz de salida, especificado como un vector de dos elementos, [xLength yLength] o [gridRow gridCol]. El tamaño está en coordenadas mundiales, locales o de cuadrícula según la sintaxis.

Tipos de datos: double

topLeft — Ubicación de la red

vector de dos elementos | [iCoord jCoord]

Ubicación de la esquina superior izquierda de la cuadrícula, especificada como un vector de dos elementos, [iCoord jCoord].

Tipos de datos: double

Argumentos de salida

occVal — Valores de probabilidad de ocupación

vector columna

Valores de ocupación de probabilidad, devueltos como un vector columna de la misma longitud que xy o ij.

Valores cercanos a 0 representan una alta probabilidad de que la celda no esté ocupada y libre de obstáculos.

validPts — Ubicaciones válidas del mapa

vector columna n por 1

Ubicaciones de mapas válidas, devueltas como un vector columna n por 1 con una longitud igual a xy o ij. Las ubicaciones dentro del mapa devuelven un valor de 1. Las ubicaciones fuera de los límites del mapa devuelven un valor de 0.

occMatrix — Matriz de valores de ocupación

matriz

Matriz de valores de ocupación, devuelta como matriz con tamaño igual a matSize o el tamaño de map.

Valores cercanos a 0 representan una alta probabilidad de que la celda no esté ocupada y libre de obstáculos.

Limitaciones

Los valores de ocupación tienen una resolución limitada de ±0,001. Los valores se almacenan como int16 utilizando una representación de probabilidades logarítmicas. Este tipo de datos limita la resolución, pero ahorra memoria al almacenar mapas grandes en MATLAB. Al llamar a setOccupancy y luego a getOccupancy, es posible que el valor devuelto no sea igual al valor establecido. Para obtener más información, consulte la sección de representaciones de probabilidades logarítmicas en Cuadrículas de ocupación.

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 | checkOccupancy

Temas

• Cuadrículas de ocupación (Robotics System Toolbox)