Main Content

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

fusegps

Corregir estados usando datos de GPS para insfilterErrorState

Descripción

ejemplo

[res,resCov] = fusegps(FUSE,position,positionCovariance) fusiona datos de posición GPS para corregir la estimación del estado.

[res,resCov] = fusegps(FUSE,position,positionCovariance,velocity,velocityCovariance) fusiona los datos de posición y velocidad del GPS para corregir la estimación del estado.

Ejemplos

contraer todo

Create un objeto insfilterErrorState y muestra su estado.

filter = insfilterErrorState;
disp(filter.State')
     1     0     0     0     0     0     0     0     0     0     0     0     0     0     0     0     1

Fusionar una medición de posición GPS con su covarianza.

position = [5 3 2] % in deg deg meters;
position = 1×3

     5     3     2

positionCovariance = diag([1 1 1]);
[res,resCovariance] = fusegps(filter,position,positionCovariance)
res = 1×3
105 ×

    5.5218    3.3254    0.3282

resCovariance = 3×3

     2     1     1
     1     2     1
     1     1     2

Muestra el estado después de la fusión.

disp(filter.State')
   1.0e+05 *

    0.0000   -0.0000   -0.0000   -0.0000    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939    2.2939

Argumentos de entrada

contraer todo

insfilterErrorState, especificado como objeto.

Posición del receptor GPS en latitud, longitud y altitud geodésica (LLA) especificada como un vector fila finito real de 3 elementos. La latitud y la longitud están en grados, siendo el norte y el este positivos. La altitud está en metros.

Tipos de datos: single | double

Covarianza de medición de posición del receptor GPS en m2, especificada como una matriz de 3 por 3.

Tipos de datos: single | double

Velocidad del receptor GPS en el sistema de coordenadas NED local en m/s, especificada como un vector fila de 3 elementos.

Tipos de datos: single | double

Covarianza de medición de velocidad del receptor GPS en el sistema de coordenadas NED local en (m/s) 2, especificado como una matriz de 3 por 3.

Tipos de datos: single | double

Argumentos de salida

contraer todo

Residual de posición y velocidad, devueltos como un vector de 1 por 6 de valores reales en m y m/s, respectivamente.

Residuo de innovación, devuelto como una matriz de valores reales de 6 por 6.

Capacidades ampliadas

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

Historial de versiones

Introducido en R2019a

Consulte también

|