restructure for msCode
This commit is contained in:
@@ -0,0 +1,65 @@
|
||||
#include <SoftwareSerial.h>
|
||||
|
||||
#include <TinyGPS.h>
|
||||
|
||||
/* This sample code demonstrates the normal use of a TinyGPS object.
|
||||
It requires the use of SoftwareSerial, and assumes that you have a
|
||||
4800-baud serial GPS device hooked up on pins 4(rx) and 3(tx).
|
||||
*/
|
||||
|
||||
TinyGPS gps;
|
||||
SoftwareSerial ss(4, 3);
|
||||
|
||||
void setup()
|
||||
{
|
||||
Serial.begin(115200);
|
||||
ss.begin(4800);
|
||||
|
||||
Serial.print("Simple TinyGPS library v. "); Serial.println(TinyGPS::library_version());
|
||||
Serial.println("by Mikal Hart");
|
||||
Serial.println();
|
||||
}
|
||||
|
||||
void loop()
|
||||
{
|
||||
bool newData = false;
|
||||
unsigned long chars;
|
||||
unsigned short sentences, failed;
|
||||
|
||||
// For one second we parse GPS data and report some key values
|
||||
for (unsigned long start = millis(); millis() - start < 1000;)
|
||||
{
|
||||
while (ss.available())
|
||||
{
|
||||
char c = ss.read();
|
||||
// Serial.write(c); // uncomment this line if you want to see the GPS data flowing
|
||||
if (gps.encode(c)) // Did a new valid sentence come in?
|
||||
newData = true;
|
||||
}
|
||||
}
|
||||
|
||||
if (newData)
|
||||
{
|
||||
float flat, flon;
|
||||
unsigned long age;
|
||||
gps.f_get_position(&flat, &flon, &age);
|
||||
Serial.print("LAT=");
|
||||
Serial.print(flat == TinyGPS::GPS_INVALID_F_ANGLE ? 0.0 : flat, 6);
|
||||
Serial.print(" LON=");
|
||||
Serial.print(flon == TinyGPS::GPS_INVALID_F_ANGLE ? 0.0 : flon, 6);
|
||||
Serial.print(" SAT=");
|
||||
Serial.print(gps.satellites() == TinyGPS::GPS_INVALID_SATELLITES ? 0 : gps.satellites());
|
||||
Serial.print(" PREC=");
|
||||
Serial.print(gps.hdop() == TinyGPS::GPS_INVALID_HDOP ? 0 : gps.hdop());
|
||||
}
|
||||
|
||||
gps.stats(&chars, &sentences, &failed);
|
||||
Serial.print(" CHARS=");
|
||||
Serial.print(chars);
|
||||
Serial.print(" SENTENCES=");
|
||||
Serial.print(sentences);
|
||||
Serial.print(" CSUM ERR=");
|
||||
Serial.println(failed);
|
||||
if (chars == 0)
|
||||
Serial.println("** No characters received from GPS: check wiring **");
|
||||
}
|
||||
@@ -0,0 +1,152 @@
|
||||
#include <TinyGPS.h>
|
||||
#include <avr\pgmspace.h>
|
||||
|
||||
/* This sample code demonstrates the basic use of a TinyGPS object.
|
||||
Typically, you would feed it characters from a serial GPS device, but
|
||||
this example uses static strings for simplicity.
|
||||
*/
|
||||
prog_char str1[] PROGMEM = "$GPRMC,201547.000,A,3014.5527,N,09749.5808,W,0.24,163.05,040109,,*1A";
|
||||
prog_char str2[] PROGMEM = "$GPGGA,201548.000,3014.5529,N,09749.5808,W,1,07,1.5,225.6,M,-22.5,M,18.8,0000*78";
|
||||
prog_char str3[] PROGMEM = "$GPRMC,201548.000,A,3014.5529,N,09749.5808,W,0.17,53.25,040109,,*2B";
|
||||
prog_char str4[] PROGMEM = "$GPGGA,201549.000,3014.5533,N,09749.5812,W,1,07,1.5,223.5,M,-22.5,M,18.8,0000*7C";
|
||||
prog_char *teststrs[4] = {str1, str2, str3, str4};
|
||||
|
||||
static void sendstring(TinyGPS &gps, const PROGMEM char *str);
|
||||
static void gpsdump(TinyGPS &gps);
|
||||
static void print_float(float val, float invalid, int len, int prec);
|
||||
static void print_int(unsigned long val, unsigned long invalid, int len);
|
||||
static void print_date(TinyGPS &gps);
|
||||
static void print_str(const char *str, int len);
|
||||
|
||||
void setup()
|
||||
{
|
||||
TinyGPS test_gps;
|
||||
Serial.begin(115200);
|
||||
|
||||
Serial.print("Testing TinyGPS library v. "); Serial.println(TinyGPS::library_version());
|
||||
Serial.println("by Mikal Hart");
|
||||
Serial.println();
|
||||
Serial.print("Sizeof(gpsobject) = "); Serial.println(sizeof(TinyGPS));
|
||||
Serial.println();
|
||||
|
||||
Serial.println("Sats HDOP Latitude Longitude Fix Date Time Date Alt Course Speed Card Distance Course Card Chars Sentences Checksum");
|
||||
Serial.println(" (deg) (deg) Age Age (m) --- from GPS ---- ---- to London ---- RX RX Fail");
|
||||
Serial.println("--------------------------------------------------------------------------------------------------------------------------------------");
|
||||
gpsdump(test_gps);
|
||||
for (int i=0; i<4; ++i)
|
||||
{
|
||||
sendstring(test_gps, teststrs[i]);
|
||||
gpsdump(test_gps);
|
||||
}
|
||||
}
|
||||
|
||||
void loop()
|
||||
{
|
||||
}
|
||||
|
||||
static void sendstring(TinyGPS &gps, const PROGMEM char *str)
|
||||
{
|
||||
while (true)
|
||||
{
|
||||
char c = pgm_read_byte_near(str++);
|
||||
if (!c) break;
|
||||
gps.encode(c);
|
||||
}
|
||||
gps.encode('\r');
|
||||
gps.encode('\n');
|
||||
}
|
||||
|
||||
static void gpsdump(TinyGPS &gps)
|
||||
{
|
||||
float flat, flon;
|
||||
unsigned long age, date, time, chars = 0;
|
||||
unsigned short sentences = 0, failed = 0;
|
||||
static const float LONDON_LAT = 51.508131, LONDON_LON = -0.128002;
|
||||
|
||||
print_int(gps.satellites(), TinyGPS::GPS_INVALID_SATELLITES, 5);
|
||||
print_int(gps.hdop(), TinyGPS::GPS_INVALID_HDOP, 5);
|
||||
gps.f_get_position(&flat, &flon, &age);
|
||||
print_float(flat, TinyGPS::GPS_INVALID_F_ANGLE, 9, 5);
|
||||
print_float(flon, TinyGPS::GPS_INVALID_F_ANGLE, 10, 5);
|
||||
print_int(age, TinyGPS::GPS_INVALID_AGE, 5);
|
||||
|
||||
print_date(gps);
|
||||
|
||||
print_float(gps.f_altitude(), TinyGPS::GPS_INVALID_F_ALTITUDE, 8, 2);
|
||||
print_float(gps.f_course(), TinyGPS::GPS_INVALID_F_ANGLE, 7, 2);
|
||||
print_float(gps.f_speed_kmph(), TinyGPS::GPS_INVALID_F_SPEED, 6, 2);
|
||||
print_str(gps.f_course() == TinyGPS::GPS_INVALID_F_ANGLE ? "*** " : TinyGPS::cardinal(gps.f_course()), 6);
|
||||
print_int(flat == TinyGPS::GPS_INVALID_F_ANGLE ? 0UL : (unsigned long)TinyGPS::distance_between(flat, flon, LONDON_LAT, LONDON_LON) / 1000, 0xFFFFFFFF, 9);
|
||||
print_float(flat == TinyGPS::GPS_INVALID_F_ANGLE ? 0.0 : TinyGPS::course_to(flat, flon, 51.508131, -0.128002), TinyGPS::GPS_INVALID_F_ANGLE, 7, 2);
|
||||
print_str(flat == TinyGPS::GPS_INVALID_F_ANGLE ? "*** " : TinyGPS::cardinal(TinyGPS::course_to(flat, flon, LONDON_LAT, LONDON_LON)), 6);
|
||||
|
||||
gps.stats(&chars, &sentences, &failed);
|
||||
print_int(chars, 0xFFFFFFFF, 6);
|
||||
print_int(sentences, 0xFFFFFFFF, 10);
|
||||
print_int(failed, 0xFFFFFFFF, 9);
|
||||
Serial.println();
|
||||
}
|
||||
|
||||
static void print_int(unsigned long val, unsigned long invalid, int len)
|
||||
{
|
||||
char sz[32];
|
||||
if (val == invalid)
|
||||
strcpy(sz, "*******");
|
||||
else
|
||||
sprintf(sz, "%ld", val);
|
||||
sz[len] = 0;
|
||||
for (int i=strlen(sz); i<len; ++i)
|
||||
sz[i] = ' ';
|
||||
if (len > 0)
|
||||
sz[len-1] = ' ';
|
||||
Serial.print(sz);
|
||||
}
|
||||
|
||||
static void print_float(float val, float invalid, int len, int prec)
|
||||
{
|
||||
char sz[32];
|
||||
if (val == invalid)
|
||||
{
|
||||
strcpy(sz, "*******");
|
||||
sz[len] = 0;
|
||||
if (len > 0)
|
||||
sz[len-1] = ' ';
|
||||
for (int i=7; i<len; ++i)
|
||||
sz[i] = ' ';
|
||||
Serial.print(sz);
|
||||
}
|
||||
else
|
||||
{
|
||||
Serial.print(val, prec);
|
||||
int vi = abs((int)val);
|
||||
int flen = prec + (val < 0.0 ? 2 : 1);
|
||||
flen += vi >= 1000 ? 4 : vi >= 100 ? 3 : vi >= 10 ? 2 : 1;
|
||||
for (int i=flen; i<len; ++i)
|
||||
Serial.print(" ");
|
||||
}
|
||||
}
|
||||
|
||||
static void print_date(TinyGPS &gps)
|
||||
{
|
||||
int year;
|
||||
byte month, day, hour, minute, second, hundredths;
|
||||
unsigned long age;
|
||||
gps.crack_datetime(&year, &month, &day, &hour, &minute, &second, &hundredths, &age);
|
||||
if (age == TinyGPS::GPS_INVALID_AGE)
|
||||
Serial.print("******* ******* ");
|
||||
else
|
||||
{
|
||||
char sz[32];
|
||||
sprintf(sz, "%02d/%02d/%02d %02d:%02d:%02d ",
|
||||
month, day, year, hour, minute, second);
|
||||
Serial.print(sz);
|
||||
}
|
||||
print_int(age, TinyGPS::GPS_INVALID_AGE, 5);
|
||||
}
|
||||
|
||||
static void print_str(const char *str, int len)
|
||||
{
|
||||
int slen = strlen(str);
|
||||
for (int i=0; i<len; ++i)
|
||||
Serial.print(i<slen ? str[i] : ' ');
|
||||
}
|
||||
@@ -0,0 +1,135 @@
|
||||
#include <SoftwareSerial.h>
|
||||
|
||||
#include <TinyGPS.h>
|
||||
|
||||
/* This sample code demonstrates the normal use of a TinyGPS object.
|
||||
It requires the use of SoftwareSerial, and assumes that you have a
|
||||
4800-baud serial GPS device hooked up on pins 4(rx) and 3(tx).
|
||||
*/
|
||||
|
||||
TinyGPS gps;
|
||||
SoftwareSerial ss(4, 3);
|
||||
|
||||
static void smartdelay(unsigned long ms);
|
||||
static void print_float(float val, float invalid, int len, int prec);
|
||||
static void print_int(unsigned long val, unsigned long invalid, int len);
|
||||
static void print_date(TinyGPS &gps);
|
||||
static void print_str(const char *str, int len);
|
||||
|
||||
void setup()
|
||||
{
|
||||
Serial.begin(115200);
|
||||
|
||||
Serial.print("Testing TinyGPS library v. "); Serial.println(TinyGPS::library_version());
|
||||
Serial.println("by Mikal Hart");
|
||||
Serial.println();
|
||||
Serial.println("Sats HDOP Latitude Longitude Fix Date Time Date Alt Course Speed Card Distance Course Card Chars Sentences Checksum");
|
||||
Serial.println(" (deg) (deg) Age Age (m) --- from GPS ---- ---- to London ---- RX RX Fail");
|
||||
Serial.println("-------------------------------------------------------------------------------------------------------------------------------------");
|
||||
|
||||
ss.begin(4800);
|
||||
}
|
||||
|
||||
void loop()
|
||||
{
|
||||
float flat, flon;
|
||||
unsigned long age, date, time, chars = 0;
|
||||
unsigned short sentences = 0, failed = 0;
|
||||
static const double LONDON_LAT = 51.508131, LONDON_LON = -0.128002;
|
||||
|
||||
print_int(gps.satellites(), TinyGPS::GPS_INVALID_SATELLITES, 5);
|
||||
print_int(gps.hdop(), TinyGPS::GPS_INVALID_HDOP, 5);
|
||||
gps.f_get_position(&flat, &flon, &age);
|
||||
print_float(flat, TinyGPS::GPS_INVALID_F_ANGLE, 10, 6);
|
||||
print_float(flon, TinyGPS::GPS_INVALID_F_ANGLE, 11, 6);
|
||||
print_int(age, TinyGPS::GPS_INVALID_AGE, 5);
|
||||
print_date(gps);
|
||||
print_float(gps.f_altitude(), TinyGPS::GPS_INVALID_F_ALTITUDE, 7, 2);
|
||||
print_float(gps.f_course(), TinyGPS::GPS_INVALID_F_ANGLE, 7, 2);
|
||||
print_float(gps.f_speed_kmph(), TinyGPS::GPS_INVALID_F_SPEED, 6, 2);
|
||||
print_str(gps.f_course() == TinyGPS::GPS_INVALID_F_ANGLE ? "*** " : TinyGPS::cardinal(gps.f_course()), 6);
|
||||
print_int(flat == TinyGPS::GPS_INVALID_F_ANGLE ? 0xFFFFFFFF : (unsigned long)TinyGPS::distance_between(flat, flon, LONDON_LAT, LONDON_LON) / 1000, 0xFFFFFFFF, 9);
|
||||
print_float(flat == TinyGPS::GPS_INVALID_F_ANGLE ? TinyGPS::GPS_INVALID_F_ANGLE : TinyGPS::course_to(flat, flon, LONDON_LAT, LONDON_LON), TinyGPS::GPS_INVALID_F_ANGLE, 7, 2);
|
||||
print_str(flat == TinyGPS::GPS_INVALID_F_ANGLE ? "*** " : TinyGPS::cardinal(TinyGPS::course_to(flat, flon, LONDON_LAT, LONDON_LON)), 6);
|
||||
|
||||
gps.stats(&chars, &sentences, &failed);
|
||||
print_int(chars, 0xFFFFFFFF, 6);
|
||||
print_int(sentences, 0xFFFFFFFF, 10);
|
||||
print_int(failed, 0xFFFFFFFF, 9);
|
||||
Serial.println();
|
||||
|
||||
smartdelay(1000);
|
||||
}
|
||||
|
||||
static void smartdelay(unsigned long ms)
|
||||
{
|
||||
unsigned long start = millis();
|
||||
do
|
||||
{
|
||||
while (ss.available())
|
||||
gps.encode(ss.read());
|
||||
} while (millis() - start < ms);
|
||||
}
|
||||
|
||||
static void print_float(float val, float invalid, int len, int prec)
|
||||
{
|
||||
if (val == invalid)
|
||||
{
|
||||
while (len-- > 1)
|
||||
Serial.print('*');
|
||||
Serial.print(' ');
|
||||
}
|
||||
else
|
||||
{
|
||||
Serial.print(val, prec);
|
||||
int vi = abs((int)val);
|
||||
int flen = prec + (val < 0.0 ? 2 : 1); // . and -
|
||||
flen += vi >= 1000 ? 4 : vi >= 100 ? 3 : vi >= 10 ? 2 : 1;
|
||||
for (int i=flen; i<len; ++i)
|
||||
Serial.print(' ');
|
||||
}
|
||||
smartdelay(0);
|
||||
}
|
||||
|
||||
static void print_int(unsigned long val, unsigned long invalid, int len)
|
||||
{
|
||||
char sz[32];
|
||||
if (val == invalid)
|
||||
strcpy(sz, "*******");
|
||||
else
|
||||
sprintf(sz, "%ld", val);
|
||||
sz[len] = 0;
|
||||
for (int i=strlen(sz); i<len; ++i)
|
||||
sz[i] = ' ';
|
||||
if (len > 0)
|
||||
sz[len-1] = ' ';
|
||||
Serial.print(sz);
|
||||
smartdelay(0);
|
||||
}
|
||||
|
||||
static void print_date(TinyGPS &gps)
|
||||
{
|
||||
int year;
|
||||
byte month, day, hour, minute, second, hundredths;
|
||||
unsigned long age;
|
||||
gps.crack_datetime(&year, &month, &day, &hour, &minute, &second, &hundredths, &age);
|
||||
if (age == TinyGPS::GPS_INVALID_AGE)
|
||||
Serial.print("********** ******** ");
|
||||
else
|
||||
{
|
||||
char sz[32];
|
||||
sprintf(sz, "%02d/%02d/%02d %02d:%02d:%02d ",
|
||||
month, day, year, hour, minute, second);
|
||||
Serial.print(sz);
|
||||
}
|
||||
print_int(age, TinyGPS::GPS_INVALID_AGE, 5);
|
||||
smartdelay(0);
|
||||
}
|
||||
|
||||
static void print_str(const char *str, int len)
|
||||
{
|
||||
int slen = strlen(str);
|
||||
for (int i=0; i<len; ++i)
|
||||
Serial.print(i<slen ? str[i] : ' ');
|
||||
smartdelay(0);
|
||||
}
|
||||
Reference in New Issue
Block a user