Estoy tratando de obtener la posición y la incertidumbre de mi sensor LIDAR dentro de una caja. Para posición: valores x, y en mm y ángulo en grados, para incertidumbre: valores σx, σy en mm y σθ en grados. Estoy usando RaspberryPi con RPLIDAR A2 y programando con C++. Quiero obtener la posición del LIDAR dentro del cuadro principal.
Actualización 1: estoy obteniendo datos (distancia y ángulo) del LIDAR y trazando en Matlab. Pero necesito encontrar la posición del LIDAR en la caja. No necesito códigos exactamente, solo los pasos pueden ayudarme.
Actualización 2: aquí está la trama de Matlab (aunque esta lectura no es del interior de una caja). Actualmente el sensor siempre está en el centro si lo muevo. Quiero obtener la posición del sensor ya que la caja está en una posición fija, lo que se mueve es el sensor mismo.
En última instancia, se trata de matemáticas, no de ingeniería eléctrica.
En lo que respecta al LIDAR, está en el centro del universo y define un eje de cero grados. Todas las coordenadas que devuelve son relativas a ese centro y ese eje.
Probablemente devuelve coordenadas polares (r, θ), donde r es el rango y θ es el ángulo relativo al eje. Debería ser un simple poco de trigonometría si prefiere que se conviertan a (x, y).
Tu tarea es realizar una rotación y traslación en esas coordenadas para alinearlas con lo que has elegido para que sea el centro del universo: la caja. Lo complicado es averiguar qué es esa traslación y rotación.
Si estás en una caja, deberías encontrar que los puntos caen perfectamente en líneas rectas. Necesitará encontrar alguna manera de determinar qué puntos están en qué líneas. Tal vez use una transformación de Hough. O simplemente elija un grupo de puntos secuenciales del LIDAR y determine si están lo suficientemente cerca para formar una línea recta.
Una vez que sepa dónde están las líneas, en relación con el LIDAR, puede calcular la rotación para girar las líneas hacia donde las quiere, luego la traslación para mover todo en relación con el centro de la caja.
Tenga en cuenta que si el cuadro es un simple rectángulo o cuadrado, siempre habrá cierta ambigüedad. Si alguna persona astuta apaga el LIDAR por un momento, lo gira todo 180° y lo vuelve a encender, no tendrá forma de saberlo.
Si tiene un mapa de la habitación, puede usar algo como un filtro de partículas para estimar su ubicación. Esto se llama localización . Hay muchos documentos, recursos y tutoriales sobre el tema.
También lo utilizan los algoritmos de automóviles sin conductor para estimar la ubicación de un automóvil.
Fuente: Hacia la ciencia de datos
phil c
AKM Tariqul Islam
Selvek
phil c
AKM Tariqul Islam
dpdt
AKM Tariqul Islam
analogsystemsrf