Establezca la semilla de número aleatorio para garantizar la repetibilidad.
Mapa de ocupación de carga
Cargue una cuadrícula de probabilidad de ocupación en el espacio de trabajo de MATLAB® .
Cree un mapa de ocupación a partir de la cuadrícula de ocupación de entrada.
Define los límites inferior y superior de las variables de espacio de estados x, y y theta del mapa de ocupación.
Mostrar el mapa de ocupación.
Especifique el estado inicial y el estado objetivo para la planificación de rutas.
Estados de inicio y objetivo de la trama
Utilice las funciones plannerLineSpec.start y plannerLineSpec.goal para trazar los estados inicial y objetivo, respectivamente.
Configurar el planificador de rutas PRM
Cree un objeto SE(2) de espacio de estados utilizando las variables de espacio de estados especificadas.
Verifique la validez de los estados en el espacio de estados de entrada utilizando un validador de estados. Establezca la distancia de validación en 0,01.
Configure el planificador de rutas del PRM.
Encuentre los estados genéricos (o nodos) en el gráfico de la red.
Encuentre el árbol de búsqueda en el gráfico de red.
Trazar árbol de búsqueda y estados genéricos
Utilice la función plannerLineSpec.tree para trazar el árbol de búsqueda.
Utilice la función plannerLineSpec.state para trazar los estados genéricos. Establezca el tamaño del marcador para trazar los estados genéricos en 3.
Encontrar ruta entre dos estados y ángulo de rumbo
Calcule la ruta entre el punto inicial y el punto objetivo.
Calcule el ángulo de rumbo desde los puntos XY hasta la ruta.
Trazar la ruta calculada y el ángulo de rumbo
Utilice las funciones plannerLineSpec.path y plannerLineSpec.heading para trazar la ruta calculada y el ángulo de rumbo, respectivamente. Modifique el color de la línea para trazar el ángulo de rumbo a cyan.