Skip to content

changes on how to handle gps AT commands #24

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
bledogit wants to merge 1 commit into
base: master
Choose a base branch
from
Open

changes on how to handle gps AT commands #24

Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
1 commit
Select commit
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
152 changes: 141 additions & 11 deletions DFRobot_sim808.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -57,7 +57,7 @@ DFRobot_SIM808::DFRobot_SIM808(SoftwareSerial *mySerial)
sim808_init(mySerial, 0);
}

bool DFRobot_SIM808::init(void)
bool DFRobot_SIM808::init(boolean simcheck)
{
//閿熸枻鎷烽敓绱窽鎸囬敓鏂ゆ嫹閿熻鍑ゆ嫹閿熸枻鎷锋晥
if(!sim808_check_with_cmd("AT\r\n","OK\r\n",CMD)){
Expand All @@ -72,7 +72,7 @@ bool DFRobot_SIM808::init(void)
}

//閿熸枻鎷烽敓绲奍M閿熸枻鎷风姸鎬�
if(!checkSIMStatus()) {
if(simcheck && !checkSIMStatus()) {
return false;
}
return true;
Expand Down Expand Up @@ -894,14 +894,26 @@ bool DFRobot_SIM808::getLocation(const __FlashStringHelper *apn, float *longitud
return false;
}

bool DFRobot_SIM808::setTestGPS(bool test) {

if (test) {
if(!sim808_check_with_cmd("AT+CGNSTST=1\r\n", "OK\r\n", CMD)) {
return false;
}
} else {
if(!sim808_check_with_cmd("AT+CGNSTST=0\r\n", "OK\r\n", CMD)) {
return false;
}
}
return true;
}

bool DFRobot_SIM808::attachGPS()
{
if(!sim808_check_with_cmd("AT+CGNSPWR=1\r\n", "OK\r\n", CMD)) {
return false;
}
if(!sim808_check_with_cmd("AT+CGNSTST=1\r\n", "OK\r\n", CMD)) {
return false;
}

return true;
}

Expand Down Expand Up @@ -1012,9 +1024,122 @@ int32_t DFRobot_SIM808::parseDecimal(const char *term)
GPSdata.month = (date / 100) % 100;
GPSdata.day = date / 10000;
}

char *DFRobot_SIM808::strtok_new(char * string, char const * delimiter){
static char *source = NULL;
char *p, *riturn = 0;
if(string != NULL) source = string;
if(source == NULL) return NULL;

if((p = strpbrk (source, delimiter)) != NULL) {
*p = 0;
riturn = source;
source = ++p;
}
return riturn;
}

bool DFRobot_SIM808::getGPS() {


// +CGNSINF: <GNSS run status>,<Fix status>, <UTC date & Time>,<Latitude>,<Longitude>,
// <MSL Altitude>,<Speed Over Ground>, <Course Over Ground>, <Fix Mode>,<Reserved1>,
// <HDOP>,<PDOP>, <VDOP>,<Reserved2>,<GNSS Satellites in View>, <GNSS Satellites Used>,
// <GLONASS Satellites Used>,<Reserved3>,<C/N0 max>,<HPA>,<VPA>
char temp[sizeof(cgnsinf)];

sim808_send_cmd("AT+CGNSINF\r\n");
sim808_read_buffer(temp, sizeof(cgnsinf)-1);
temp[sizeof(temp)-1] = '\0';

strncpy(cgnsinf, temp, sizeof(temp));

char *tok;

if((tok=strstr(temp,"+CGNSINF:")) == NULL)
return false; // not expected response

strncpy(cgnsinf, tok, sizeof(temp));

tok = strtok_new(tok, ",");
if (! tok) return false;

char *status = strtok_new(NULL, ",");
if (! status) return false;



char *datetime = strtok_new(NULL, ",");
if (! datetime) return false;
char date[5];
memset(date,0,strlen(date));
strncpy(date, datetime, 4);
GPSdata. year = atoi(date);
memset(date,0,strlen(date));
strncpy(date, datetime+4, 2);
GPSdata.month = atoi(date);
memset(date,0,strlen(date));
strncpy(date, datetime+6, 2);
GPSdata.day = atoi(date);

uint32_t newTime = (uint32_t)parseDecimal(datetime + 8);
getTime(newTime);

char *lat = strtok_new(NULL, ",");
if (! lat) return false;
GPSdata.lat = atof(lat);

char *lon = strtok_new(NULL, ",");
if (! lon) return false;
GPSdata.lon = atof(lon);

char *alt = strtok_new(NULL, ",");
if (! alt) return false;
GPSdata.altitude = atof(alt);

char *speed = strtok_new(NULL, ",");
if (! speed) return false;
GPSdata.speed_kph = atof(speed)* 1.852;

char *heading = strtok_new(NULL, ",");
if (! heading) return false;
GPSdata.heading = atof(heading);

// skip
strtok_new(NULL, ","); strtok_new(NULL, ",");

char *hdop = strtok_new(NULL, ",");
if (! hdop) return false;
GPSStatus.horizontal_pres = atof(hdop);

char *pdop = strtok_new(NULL, ",");
if (! pdop) return false;
GPSStatus.position_pres = atof(pdop);

char *vdop = strtok_new(NULL, ",");
if (! vdop) return false;
GPSStatus.vertical_pres = atof(vdop);

// skip
strtok_new(NULL, ",");

char *sat_in_view = strtok_new(NULL, ",");
if (! sat_in_view) return false;
GPSStatus.sat_in_view = atoi(sat_in_view);

char *sat_used = strtok_new(NULL, ",");
if (! sat_used) return false;
GPSStatus.sat_used = atoi(sat_used);

char *sat_glonass = strtok_new(NULL, ",");
if (! sat_glonass) return false;
GPSStatus.sat_glonass = atof(sat_glonass);


return true;
}


bool DFRobot_SIM808::getGPS()
bool DFRobot_SIM808::getGPSTestData()
{
if(!getGPRMC()) //没有得到$GPRMC字符串开头的GPS信息
return false;
Expand Down Expand Up @@ -1056,10 +1181,10 @@ bool DFRobot_SIM808::getGPS()
float latitude = atof(latp);
float longitude = atof(longp);

GPSdata.lat = latitude/100;
GPSdata.lat = latitude;

// convert longitude from minutes to decimal
GPSdata.lon= longitude/100;
GPSdata.lon= longitude;

// only grab speed if needed //<7> 地面速率(000.0~999.9节，前面的0也将被传输)
// if (speed_kph != NULL) {
Expand Down Expand Up @@ -1104,7 +1229,10 @@ void DFRobot_SIM808::latitudeConverToDMS()
latDMS.degrees = (int)GPSdata.lat;
temp = (GPSdata.lat - latDMS.degrees)*60;
latDMS.minutes = (int)temp;
latDMS.seconeds = (temp - latDMS.minutes)*60;
latDMS.seconds = (temp - latDMS.minutes)*60;
if (latDMS.minutes < 0) latDMS.minutes = -latDMS.minutes;
if (latDMS.seconds < 0) latDMS.seconds = -latDMS.seconds;

}

void DFRobot_SIM808::LongitudeConverToDMS()
Expand All @@ -1113,6 +1241,8 @@ void DFRobot_SIM808::LongitudeConverToDMS()
longDMS.degrees = (int)GPSdata.lon;
temp = (GPSdata.lon - longDMS.degrees)*60;
longDMS.minutes = (int)temp;
longDMS.seconeds = (temp - longDMS.minutes)*60;
longDMS.seconds = (temp - longDMS.minutes)*60;
if (longDMS.minutes < 0) longDMS.minutes = -longDMS.minutes;
if (longDMS.seconds < 0) longDMS.seconds = -longDMS.seconds;
}

28 changes: 23 additions & 5 deletions DFRobot_sim808.h
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -64,10 +64,11 @@ class DFRobot_SIM808
* @return true if connected, false otherwise
*/

bool init(void);
bool init(boolean simcheck = true);


/** check if DFRobot_SIM808 module is powered on or not
* @param simcheck checks if SIM is OK, (GPS works without SIM)
* @returns
* true on success
* false on error
Expand Down Expand Up @@ -326,7 +327,10 @@ class DFRobot_SIM808
//Open or Close GPS
bool attachGPS();
bool detachGPS();

bool getGPS();

// set GPS test node
bool setTestGPS(bool test);
// Parse a (potentially negative) number with up to 2 decimal digits -xxxx.yy

void getTime(uint32_t time);
Expand All @@ -340,7 +344,7 @@ class DFRobot_SIM808
bool getGPRMC();

//get GPS signal
bool getGPS();
bool getGPSTestData();


SoftwareSerial *gprsSerial;
Expand All @@ -361,20 +365,34 @@ class DFRobot_SIM808
float speed_kph;
float heading;
float altitude;
}GPSdata;
} GPSdata;

struct gspstatus {
uint8_t status;
uint8_t sat_in_view;
uint8_t sat_used;
uint8_t sat_glonass;
//<HDOP>,<PDOP>, <VDOP>
float horizontal_pres;
float position_pres;
float vertical_pres;
} GPSStatus;

struct DMSData{
int degrees;
int minutes;
float seconeds;
float seconds;
}latDMS,longDMS;
char cgnsinf[128];

private:

byte serialFlag;
bool checkSIMStatus(void);
uint32_t str_to_ip(const char* str);
static DFRobot_SIM808* inst;
uint32_t _ip;
char ip_string[16]; //XXX.YYY.ZZZ.WWW + \0
char *strtok_new(char * string, char const * delimiter);
};
#endif
115 changes: 115 additions & 0 deletions SIM808_QueryGPS/SIM808_QueryGPS.ino
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -0,0 +1,115 @@
/*
### Get GPS data
1. This example is used to test SIM808 GPS/GPRS/GSM Shield's reading GPS data.
2. Open the SIM808_GetGPS example or copy these code to your project
3. Download and dial the function switch to Arduino
4. open serial helper
4. Place it outside, waiting for a few minutes and then it will send GPS data to serial

create on 2016/09/23, version: 1.0
by jason

*/
#include <DFRobot_sim808.h>
#include <SoftwareSerial.h>

// Arduino Uno Wifi Rev2
#define PIN_TX 1
#define PIN_RX 0
SoftwareSerial simSerial(PIN_TX,PIN_RX);
DFRobot_SIM808 sim808(&simSerial);//Connect RX,TX,PWR,

//DFRobot_SIM808 sim808(&Serial);

void setup() {
// Arduino Uno Wifi Rev2 has a hardware Serial
// and talks to the dfrobot board using digital pins 0,1
simSerial.begin(9600);
Serial.begin(9600);

//******** Initialize sim808 module *************
while(!sim808.init(false)) {
delay(1000);
Serial.print("Sim808 init error\r\n");
}

//************* Turn on the GPS power************
if( sim808.attachGPS())
Serial.println("Open the GPS power success");
else
Serial.println("Open the GPS power failure");

}

void loop() {
Serial.println("\n\n");
//************** Get GPS data *******************

if (sim808.getGPS()) {
Serial.print(sim808.GPSdata.year);
Serial.print("/");
Serial.print(sim808.GPSdata.month);
Serial.print("/");
Serial.print(sim808.GPSdata.day);
Serial.print(" ");
Serial.print(sim808.GPSdata.hour);
Serial.print(":");
Serial.print(sim808.GPSdata.minute);
Serial.print(":");
Serial.print(sim808.GPSdata.second);
Serial.print(":");
Serial.println(sim808.GPSdata.centisecond);

Serial.print("latitude :");
Serial.println(sim808.GPSdata.lat,6);

sim808.latitudeConverToDMS();
Serial.print("latitude :");
Serial.print(sim808.latDMS.degrees);
Serial.print(167);
Serial.print(sim808.latDMS.minutes);
Serial.print("\'");
Serial.print(sim808.latDMS.seconds,6);
Serial.println("\"");
Serial.print("longitude :");
Serial.println(sim808.GPSdata.lon,6);
sim808.LongitudeConverToDMS();
Serial.print("longitude :");
Serial.print(sim808.longDMS.degrees);
Serial.print(167);
Serial.print(sim808.longDMS.minutes);
Serial.print("\'");
Serial.print(sim808.longDMS.seconds,6);
Serial.println("\"");

Serial.print("speed_kph :");
Serial.println(sim808.GPSdata.speed_kph);
Serial.print("heading :");
Serial.println(sim808.GPSdata.heading);

Serial.print("pressions (h,v,p):");
Serial.print(sim808.GPSStatus.horizontal_pres);
Serial.print(",");
Serial.print(sim808.GPSStatus.vertical_pres);
Serial.print(",");
Serial.println(sim808.GPSStatus.position_pres);

Serial.print("satellites (inview, used, Glonass):");
Serial.print(sim808.GPSStatus.sat_in_view);
Serial.print(",");
Serial.print(sim808.GPSStatus.sat_used);
Serial.print(",");
Serial.println(sim808.GPSStatus.sat_glonass);

Serial.print("CGNSINF:");
for (int i=0; i < sizeof(sim808.cgnsinf)-1; i++) {
if (sim808.cgnsinf[i]<32) sim808.cgnsinf[i] = ' ';
}
Serial.println(sim808.cgnsinf);

} else {
Serial.println("getGPS failed");
delay(1000);
}

}