Diff: XadowGPS.cpp

Revision:

1:97f0865ea131

Parent:

0:0cbe7e15999a

Child:

2:cf4d22190de4

--- a/XadowGPS.cpp	Wed Nov 04 09:50:28 2015 +0000
+++ b/XadowGPS.cpp	Wed Nov 04 10:01:05 2015 +0000
@@ -1,14 +1,16 @@
 
-
+#include <stdlib.h>
 #include "mbed.h"
 #include "XadowGPS.h"
+#include "USBSerial.h"
 
 
 
 unsigned char gps_utc_date_time[GPS_UTC_DATE_TIME_SIZE] = {0};
-char cmd[2];
+static char cmd[2];
 
 extern I2C i2c;
+extern USBSerial dbg_serial;
 
 
 unsigned char gps_check_online(void)
@@ -17,37 +19,38 @@
     unsigned char i;
 
     //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
-
     //dlc_i2c_send_byte(GPS_SCAN_ID);
     cmd[0] = GPS_SCAN_ID;
     i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
     for(i=0;i<(GPS_SCAN_SIZE+2);i++)
     {
-        //data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
-    i2c.read(GPS_DEVICE_ADDR, (char *)data, GPS_SCAN_SIZE+2);
 
-    if(data[5] == GPS_DEVICE_ADDR)return 1;
+    if(data[5] == (GPS_DEVICE_ADDR>>1))return 1;
     else return 0;
 }
-/*
+
 unsigned char* gps_get_utc_date_time(void)
 {
     unsigned char data[GPS_UTC_DATE_TIME_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
-
-    dlc_i2c_send_byte(GPS_UTC_DATE_TIME_ID);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_UTC_DATE_TIME_ID);
+    
+    cmd[0] = GPS_UTC_DATE_TIME_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
     for(i=0;i<(GPS_UTC_DATE_TIME_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        //data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
     for(i=0;i<GPS_UTC_DATE_TIME_SIZE;i++)
-    gps_utc_date_time[i] = data[i+2];
+        gps_utc_date_time[i] = data[i+2];
 
     return gps_utc_date_time;
 }
@@ -57,12 +60,16 @@
     unsigned char data[GPS_STATUS_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_STATUS_ID);
+    
+    cmd[0] = GPS_STATUS_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_STATUS_ID);
     for(i=0;i<(GPS_STATUS_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        //data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
     return data[2];
@@ -73,15 +80,17 @@
     unsigned char data[GPS_LATITUDE_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
-
-    dlc_i2c_send_byte(GPS_LATITUDE_ID);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_LATITUDE_ID);
+    cmd[0] = GPS_LATITUDE_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
+    
     for(i=0;i<(GPS_LATITUDE_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return atof(&data[2]);
+    return atof((const char *)&data[2]);
 }
 
 unsigned char gps_get_ns(void)
@@ -89,12 +98,14 @@
     unsigned char data[GPS_NS_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_NS_ID);
+    cmd[0] = GPS_NS_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_NS_ID);
     for(i=0;i<(GPS_NS_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
     if(data[2] == 'N' || data[2] == 'S')return data[2];
@@ -107,15 +118,17 @@
     unsigned char data[GPS_LONGITUDE_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_LONGITUDE_ID);
+    cmd[0] = GPS_LONGITUDE_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_LONGITUDE_ID);
     for(i=0;i<(GPS_LONGITUDE_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return atof(&data[2]);
+    return atof((const char *)&data[2]);
 }
 
 unsigned char gps_get_ew(void)
@@ -123,12 +136,14 @@
     unsigned char data[GPS_EW_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_EW_ID);
+    cmd[0] = GPS_EW_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_EW_ID);
     for(i=0;i<(GPS_EW_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
     if(data[2] == 'E' || data[2] == 'W')return data[2];
@@ -140,15 +155,17 @@
     unsigned char data[GPS_SPEED_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_SPEED_ID);
+    cmd[0] = GPS_SPEED_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_SPEED_ID);
     for(i=0;i<(GPS_SPEED_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return atof(&data[2]);
+    return atof((const char *)&data[2]);
 }
 
 float gps_get_course(void)
@@ -156,15 +173,17 @@
     unsigned char data[GPS_COURSE_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_COURSE_ID);
+    cmd[0] = GPS_COURSE_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_COURSE_ID);
     for(i=0;i<(GPS_COURSE_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return atof(&data[2]);
+    return atof((const char *)&data[2]);
 }
 
 unsigned char gps_get_position_fix(void)
@@ -172,15 +191,17 @@
     unsigned char data[GPS_POSITION_FIX_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_POSITION_FIX_ID);
+    cmd[0] = GPS_POSITION_FIX_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_POSITION_FIX_ID);
     for(i=0;i<(GPS_POSITION_FIX_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return data[2];
+    return data[2] - '0';
 }
 
 unsigned char gps_get_sate_used(void)
@@ -189,17 +210,19 @@
     unsigned char i;
     unsigned char value;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_SATE_USED_ID);
+    cmd[0] = GPS_SATE_USED_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_SATE_USED_ID);
     for(i=0;i<(GPS_SATE_USED_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
+        //dbg_serial.printf("data[%d]: %02x ", i, data[i]);
     }
-
-    if(data[3] >= '0')value = (data[3] - '0') * 10;
+    if(data[3] >= '0' && data[3] <= '9' )value = (data[3] - '0') * 10;
     else value = 0;
-    if(data[2] >= '0')value += (data[2] - '0');
+    if(data[2] >= '0' && data[2] <= '9' )value += (data[2] - '0');
     else value += 0;
 
     return value;
@@ -210,28 +233,32 @@
     unsigned char data[GPS_ALTITUDE_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
-
-    dlc_i2c_send_byte(GPS_ALTITUDE_ID);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_ALTITUDE_ID);
+    cmd[0] = GPS_ALTITUDE_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
+ 
     for(i=0;i<(GPS_ALTITUDE_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return atof(&data[2]);
+    return atof((const char *)&data[2]);
 }
 
-unsigned char gps_get_mode(void)
+char gps_get_mode(void)
 {
-    unsigned char data[GPS_MODE_SIZE+2];
+    char data[GPS_MODE_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_MODE_ID);
+    cmd[0] = GPS_MODE_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_MODE_ID);
     for(i=0;i<(GPS_MODE_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
     return data[2];
@@ -242,14 +269,15 @@
     unsigned char data[GPS_MODE2_SIZE+2];
     unsigned char i;
 
-    dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_configure(GPS_DEVICE_ADDR, 100);
+    //dlc_i2c_send_byte(GPS_MODE2_ID);
+    cmd[0] = GPS_MODE2_ID;
+    i2c.write(GPS_DEVICE_ADDR, cmd, 1);
 
-    dlc_i2c_send_byte(GPS_MODE2_ID);
     for(i=0;i<(GPS_MODE2_SIZE+2);i++)
     {
-        data[i] = dlc_i2c_receive_byte();
+        i2c.read(GPS_DEVICE_ADDR, (char *)&data[i], 1);  //the gps module's i2c supports only 1 byte read/write per burst
     }
 
-    return data[2];
+    return data[2] - '0';
 }
-*/
\ No newline at end of file