00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022 #ifndef WIN32
00023 #include <avr/io.h>
00024 #include <avr/signal.h>
00025 #include <avr/interrupt.h>
00026 #include <avr/pgmspace.h>
00027 #include <math.h>
00028 #include <stdlib.h>
00029 #endif
00030
00031 #include "global.h"
00032 #include "rprintf.h"
00033 #include "gps.h"
00034
00035
00036 GpsInfoType GpsInfo;
00037
00038
00039 void gpsInit(void)
00040 {
00041
00042 }
00043
00044 GpsInfoType* gpsGetInfo(void)
00045 {
00046 return &GpsInfo;
00047 }
00048
00049 void gpsInfoPrint(void)
00050 {
00051
00052 rprintfProgStrM("TOW: "); rprintfFloat(8, GpsInfo.TimeOfWeek.f); rprintfCRLF();
00053 rprintfProgStrM("WkNum: "); rprintfNum(10,4,0,' ',GpsInfo.WeekNum); rprintfCRLF();
00054 rprintfProgStrM("UTCoffset:"); rprintfFloat(8, GpsInfo.UtcOffset.f); rprintfCRLF();
00055
00056 rprintfProgStrM("X_ECEF: "); rprintfFloat(8, GpsInfo.PosX_ECEF.f); rprintfCRLF();
00057 rprintfProgStrM("Y_ECEF: "); rprintfFloat(8, GpsInfo.PosY_ECEF.f); rprintfCRLF();
00058 rprintfProgStrM("Z_ECEF: "); rprintfFloat(8, GpsInfo.PosZ_ECEF.f); rprintfCRLF();
00059 rprintfProgStrM("TOF: "); rprintfFloat(8, GpsInfo.TimeOfFix_PosXYZ.f); rprintfCRLF();
00060 rprintfProgStrM("Updates: "); rprintfNum(10,6,0,' ',GpsInfo.PosXYZupdates);rprintfCRLF();
00061
00062
00063
00064 rprintfProgStrM("PosLat: "); rprintfFloat(8, 180*(GpsInfo.PosLat.f/PI)); rprintfCRLF();
00065 rprintfProgStrM("PosLon: "); rprintfFloat(8, 180*(GpsInfo.PosLon.f/PI)); rprintfCRLF();
00066 rprintfProgStrM("PosAlt: "); rprintfFloat(8, GpsInfo.PosAlt.f); rprintfCRLF();
00067 rprintfProgStrM("TOF: "); rprintfFloat(8, GpsInfo.TimeOfFix_PosLLA.f); rprintfCRLF();
00068 rprintfProgStrM("Updates: "); rprintfNum(10,6,0,' ',GpsInfo.PosLLAupdates); rprintfCRLF();
00069
00070 rprintfProgStrM("Vel East: "); rprintfFloat(8, GpsInfo.VelEast.f); rprintfCRLF();
00071 rprintfProgStrM("Vel North:"); rprintfFloat(8, GpsInfo.VelNorth.f); rprintfCRLF();
00072 rprintfProgStrM("Vel Up: "); rprintfFloat(8, GpsInfo.VelUp.f); rprintfCRLF();
00073 rprintfProgStrM("TOF: "); rprintfFloat(8, GpsInfo.TimeOfFix_VelENU.f); rprintfCRLF();
00074 rprintfProgStrM("Updates: "); rprintfNum(10,6,0,' ',GpsInfo.VelENUupdates); rprintfCRLF();
00075 }
00076