diff options
| author | Gary E. Miller <gem@rellim.com> | 2018-06-17 21:53:05 -0700 |
|---|---|---|
| committer | Gary E. Miller <gem@rellim.com> | 2018-06-17 21:53:05 -0700 |
| commit | fd34e846039cf97a142bc0d500d4095606f282c7 (patch) | |
| tree | dab482b92c35339355afa59f69e23bae28e6ba16 /driver_proto.c | |
| parent | a40408ec2be69806a7d876396dddaca728e6f6dd (diff) | |
| download | gpsd-fd34e846039cf97a142bc0d500d4095606f282c7.tar.gz | |
driver_proto.c Add ECEF to TPV
Diffstat (limited to 'driver_proto.c')
| -rw-r--r-- | driver_proto.c | 14 |
1 files changed, 11 insertions, 3 deletions
diff --git a/driver_proto.c b/driver_proto.c index df136e86..f3b03e85 100644 --- a/driver_proto.c +++ b/driver_proto.c @@ -83,10 +83,18 @@ _proto__msg_navsol(struct gps_device_t *session, unsigned char *buf, size_t data /* extract ECEF navigation solution here */ /* or extract the local tangential plane (ENU) solution */ - [Px, Py, Pz, Vx, Vy, Vz] = GET_ECEF_FIX(); + [session->newdata.ecef.x, + session->newdata.ecef.y, + session->newdata.ecef.z, + session->newdata.ecef.vx, + session->newdata.ecef.vy, + session->newdata.ecef.vz] = GET_ECEF_FIX(); ecef_to_wgs84fix(&session->newdata, &session->gpsdata.separation, - Px, Py, Pz, Vx, Vy, Vz); - mask |= LATLON_SET | ALTITUDE_SET | SPEED_SET | TRACK_SET | CLIMB_SET ; + session->newdata.ecef.x, session->newdata.ecef.y, + session->newdata.ecef.z, session->newdata.ecef.vx, + session->newdata.ecef.vy, session->newdata.ecef.vz); + mask |= LATLON_SET | ALTITUDE_SET | SPEED_SET | TRACK_SET | CLIMB_SET + | ECEF_SET | VECEF_SET ; session->newdata.epx = GET_LONGITUDE_ERROR(); session->newdata.epy = GET_LATITUDE_ERROR(); |