GPS-Tracking-Velo

Dependencies:   MODSERIAL SDBlockDevice GPS

Forschungsstand und Theoretische Grundlage

Die Bestandteile der Hardware, die das Projekt gebraucht wird, bestehen aus drei Komponente ein Mikrocontroller Board, eine GPS Antenne und ein SIM Modul. GPS basiert auf Satelliten, die mit codierten Radiosignalen ständig ihre aktuelle Position und genaue Uhrzeit ausstrahlen. Aus den Signallaufzeiten können eine GPS Antenne ihre eigene Position und Geschwindigkeit berechnen. Diese GPS Antenne sollte die Daten der Objektposition aus Satelliten auf dem Board gespeichert werden. Diese Daten wurden noch weiter durch eine SIM Module nach GMS Turm und dann per SMS Nachrichten an Handy gesendet. Möglicherweise können diese Daten auch an Webanwendung nach der Sendung an GMS Turm geschickt werden.

https://os.mbed.com/media/uploads/QuangAnhLe/picture1.png

mbed-os-example-fat-filesystem-master/main.cpp

Committer:
QuangAnhLe
Date:
2019-04-18
Revision:
3:eb739df911ef
Parent:
2:3d3d272d2df2
Child:
4:793221f865f6

File content as of revision 3:eb739df911ef:

#include "mbed.h"
#include "GPS.h"
#include <iostream>
#include <sstream>
#include <bitset>
#include <string>
#include "FATFileSystem.h"
//#include "HeapBlockDevice.h"
#include "SDBlockDevice.h"
#include <stdio.h>
#include <errno.h>

//HeapBlockDevice bd(128 * 512, 512);
//SDBlockDevice bd(PinName mosi, PinName miso, PinName sclk, PinName cs);
SDBlockDevice bd(D11, D12, D13, D10);
Serial pc(PA_2,PA_3);
Serial SIM900(PA_9,PA_10);                // (TX,RX)                                                   
GPS gps (PA_11,PA_12);

const string GoogleChunk  = "https://maps.google.com.au/maps?q=";   // URL constant
const string GoogleExtras = "&z=20";                                // Zoom Level
char  GPRSbuffer[512];
char  NUMBER[14];
string MESSAGE;
int index;
int i=0;

FATFileSystem fs("fs");
string result;
char x;

void return_error(int ret_val){
  if (ret_val)
    printf("Failure. %d\r\n", ret_val);
  else
    printf("done.\r\n");
}
 
void errno_error(void* ret_val){
  if (ret_val == NULL)
    printf(" Failure. %d \r\n", errno);
  else
    printf(" done.\r\n");
}

void clearString()
 {
  result.clear();
  }
 
void callback_rx() {
 
    while (SIM900.readable()) {
      x = SIM900.getc();
      result += x;
    pc.putc(x); // print the answer from SIM900
 
       }
}
void sendSMS()
{
clearString();
SIM900.printf("AT+CMGF=1\r"); //at command for send sms
wait_ms(1000);
clearString();
wait_ms(1000);
SIM900.printf("AT+CMGS=");
SIM900.putc('"');
SIM900.printf("+4917645651571");
SIM900.putc('"');
SIM900.printf("\r");
wait_ms(1000);
//SIM900.printf("Latitude: %0.6f, Longitude: %0.6f,Altitude: %0.3f",gps.latitude,gps.longitude,gps.altitude);
SIM900.printf("Find me at....\n %s%f,%f%s", GoogleChunk, gps.latitude, gps.longitude, GoogleExtras);
wait_ms(1000);
SIM900.putc(0x1A);
wait_ms(30000);
    //clearString();
    // Set message mode to ASCII
    /*SIM900.printf("AT+CMGF=1\r\n");
    wait(1);
    //clearString();
    // Set the phone number
    SIM900.printf("AT+CMGS=\"%s\"\r\n", +4917645651571);
    wait(1);
    // Write out the GPS data in a message
    SIM900.printf("Latitude: %0.6f, Longitude: %0.6f,Altitude: %0.3f",gps.latitude,gps.longitude,gps.altitude);
    wait(1);
    // Send it...
    SIM900.putc(0x1A);
    wait(4);
    SIM900.printf("AT+CMGF=1\r\n");
    wait(1);
    SIM900.printf("AT+CMGS=\"%s\"\r\n", +4917645651571);
    wait(1);
    SIM900.printf("Find me at....\n %s%f,%f%s", GoogleChunk, gps.latitude, gps.longitude, GoogleExtras);
    wait(1);
    SIM900.putc(0x1A);
    wait(1);*/
}

void parseSMS()
{
    while(SIM900.readable())
    {
        // Assign it to 'c'
        char c = SIM900.getc();
        // Replace all returns and or line endings with money
        if(c == '\r' || c == '\n') c= '$';
        // Put it in the array
        GPRSbuffer[i] =c;
        // Repeat if possible
        i++;
        
    }
    // Uncomment the following to debug
    // pc.printf("\nbuffer = %s", GPRSbuffer);
    
    // If we get an SMS notification
    if (sscanf(GPRSbuffer,"$$+CMTI: \"SM\",%d", &index)>0)
    {
        pc.printf("\nSMS recieved @ index [%d]", index);
        memset(GPRSbuffer, '0', 511);
        i=0;
        pc.printf("\nOpening message...");
        // ask GPRS to read the message
        SIM900.printf("AT+CMGR=%d\r\n", index);
    }
    if (strncmp(GPRSbuffer, "$$+CMGR",7) == 0 ) // compared return value = 0 then it indicates str1 is equal to str2 
    {
        // Get the number out
        char *n = strstr(GPRSbuffer,"+49");     // finds the first occurrence of the substring "+49" in the string GPRSbuffer +4917645651571 
        strncpy(NUMBER, n, 14);                 // this funtion returns the final copy of the copied string
        char * pch;             
        pch = strtok (GPRSbuffer, "$$");        // return a pointer to the first token found in the string. A null pointer is returned if there are no tokens left to retrieve
        pch = strtok (NULL, "$$");
        MESSAGE = pch;
        pc.printf("\nDone! ");
        // Send the location
        sendSMS();
        // Reset the GPRS buffer
        memset(GPRSbuffer, '0', 511);
        // Reset the char counter
        i = 0;    
    }
     if (strncmp(GPRSbuffer, "$$+CMGS",7) == 0) {
        // Reset the GPRS buffer
        memset(GPRSbuffer, '0', 511);
        // Reset the char counter
        i = 0;
    }
    if (strncmp(GPRSbuffer, "$$RING",6) == 0) {
        SIM900.printf("ATH0\r\n");
        pc.printf("\nCall bounced!...");
        // Do the send SMS routine...
        sendSMS();
        // Reset the GPRS buffer
        memset(GPRSbuffer, '0', 511);
        // Reset the char counter
        i = 0;
    }
    pc.printf("\n\n\nWaiting for SMS or call...\n");
    pc.printf("\nThe last number was : %s", NUMBER);
    pc.printf("\nThe last message was : %s", MESSAGE);
    // Reset the GPRS buffer
    memset(GPRSbuffer, '0', 511);
    // Reset the char counter
    i = 0;
}
 
int main() {
  /**/
  memset(GPRSbuffer, '0', 511);
  pc.printf("\r\n GSM 900 Test\n");
  //SIM900.attach(&callback_rx);
  SIM900.baud(9600);
  wait_ms(100);
  SIM900.printf("ATE0\r\n");
  pc.printf("\nGPRS echo [OFF]\n");
    wait(1);
    // Delete all messages on the sim card
  SIM900.printf("AT+CMGDA=\"DEL ALL\"\r\n");
    wait(1);
    pc.printf("\nMessages Cleared...\n");
    wait(1);
  //sendSMS();
  wait_ms(100);
  /**/
  int error = 0;
  printf("Welcome to the filesystem example.\r\n"
         "Formatting a FAT, RAM-backed filesystem. ");
  error = FATFileSystem::format(&bd);
  return_error(error);
 
  printf("Mounting the filesystem on \"/fs\". ");
  error = fs.mount(&bd);
  return_error(error);
 
  printf("Opening a new file, numbers.txt.");
  FILE* fd = fopen("/fs/numbers.txt", "a+");
  errno_error(fd);
 
  //for (int i = 0; i < 20; i++){
  // printf("Writing decimal numbers to a file (%d/20)\r", i);
  //fprintf(fd, "%d\r\n", i);
  //}
   fprintf(fd,"Latitude, Longitude,Altitude,Speed in knots, Date, Time,Number of satellites being tracked, IDs of satellites ins use, Fix, Fix mode\r\n");
  //printf("Writing decimal numbers to a file (20/20) done.\r\n");
 
  printf("Closing file.");
  fclose(fd);
  printf(" done.\r\n");
 
  printf("Re-opening file read-only.");
  fd = fopen("/fs/numbers.txt", "r");
  errno_error(fd);
 
  printf("Dumping file to screen.\r\n");
  char buff[16] = {0};
  while (!feof(fd)){
    int size = fread(&buff[0], 1, 15, fd);
    fwrite(&buff[0], 1, size, stdout);
  }
  printf("EOF.\r\n");
 
  printf("Closing file.");
  fclose(fd);
  printf(" done.\r\n");
 
  printf("Opening root directory.");
  DIR* dir = opendir("/fs/");
  errno_error(fd);
 
  struct dirent* de;
  printf("Printing all filenames:\r\n");
  while((de = readdir(dir)) != NULL){
    printf("  %s\r\n", &(de->d_name)[0]);
  }
 
  printf("Closing root directory. ");
  error = closedir(dir);
  return_error(error);
  printf("Filesystem Demo complete.\r\n");
  wait(2);
  while (true) {
    pc.printf("\n");
     wait(1); 
          if(gps.sample()){
          float latitude    = gps.latitude;
          float longitude   = gps.longitude;
          float altitude    = gps.altitude;
          //float direction   =0.0;
          float utc = gps.utc+20000;
          //int sek=gps.sek;
          //int min=gps.min;
          //int hour=gps.hour;
          int sat_tracked=gps. sat_tracked;
          int fix=gps.fix;
          int fix_3d=gps.fix_3d;
          int id1=gps.id1;
          int id2=gps.id2;
          int id3=gps.id3;
          int id4=gps.id4;
          int id5=gps.id5;
          int id6=gps.id6;
          int id7=gps.id7;
          int id8=gps.id8;
          int id9=gps.id9;
          int id10=gps.id10;
          int id11=gps.id11;
          int id12=gps.id12;
          //double hdop=gps.hdop;
          //double pdop=gps.pdop;
          float speed=gps.speed;
          int   date=gps.date;
          //char aut=gps.aut;
          //float vdop=gps.vdop;
          //int chek_data=gps.check_data;
          //pc.printf("Latitude, Longitude,Altitude, Direction, Speed in knots, Date, Time, Satellites in use, Satellites in view, IDs of satellites ins use, Fix, Fix mode, PDOP, HDOP\r\n");
          //pc.printf("%0.6f,%0.6f,%0.3f,%0.2f,%0.2f,%d,%0.0f,%d,",latitude,longitude,altitude,direction,speed,date,utc, sat_tracked);
          //pc.printf("%d;%d;%d;%d;%d;%d;%d;%d;%d;%d;%d;%d,",id1,id2,id3,id4,id5,id6,id7,id8,id9,id10,id11,id12);
          //pc.printf("%d,%d,%.2f,%.2f\r\n",fix,fix_3d,pdop,hdop);
          //pc.printf("%d",date);
          
          
          
          /*pc.printf("Latitude: %0.6f\r\n",latitude);
          pc.printf("Longitude:%0.6f\r\n",longitude);
          pc.printf("Altitude: %0.3f\r\n",altitude);
          pc.printf("Speed in knots: %0.2f\r\n",speed);
          pc.printf("Date: %d\r\n",date);
          pc.printf("Time UTC: %0.0f\r\n",utc);
          pc.printf("Number of satellites being tracked: %d\r\n", sat_tracked);
          pc.printf("PRNs of satellites used for fix:\r\n");
          pc.printf("ID1:%d,ID2:%d,ID3:%d,ID4:%d,ID5:%d,ID6:%d\r\n",id1,id2,id3,id4,id5,id6);
          pc.printf("ID7:%d,ID8:%d,ID9:%d,ID10:%d,ID11:%d,ID12:%d\r\n",id7,id8,id9,id10,id11,id12);
          pc.printf("Fix quality: %d - value include 0=invalid; 1=GPS fix\r\n",fix);
          pc.printf("3D fix: %d - value include: 1 = no fix, 2 = 2D fix, 3 = 3D fix\r\n\n", fix_3d); 
          pc.printf("****************************************************************\r\n");*/ 
          
          
          FILE* fd = fopen("/fs/numbers.txt", "a+");
          //errno_error(fd);
         if(fd != NULL)
         {
              printf("write file.\r\n");
              fprintf(fd,"%0.6f,%0.6f,%0.3f,%0.2f,%d,%0.0f,%d,%d;%d;%d;%d;%d;%d;%d;%d;%d;%d;%d;%d,%d,%d\r\n",latitude, longitude, altitude, speed, date, utc, sat_tracked, id1,id2,id3,id4,id5,id6,id7,id8,id9,id10,id11,id12, fix,fix_3d);
              //fclose(fd);
              printf("Closing file.\r\n");
              fclose(fd);
              printf(" done.\r\n");
         }
 
              //printf("Re-opening file read-only.");
              //fd = fopen("/fs/numbers.txt", "r");
             //errno_error(fd);
          
          wait(1);
          //parseSMS();
          sendSMS();
          wait(1);
        //for (int i = 0; i < 20; i++){
        // printf("Writing decimal numbers to a file (%d/20)\r", i);
        //fprintf(fd, "%d\r\n", i);
  //}
   //fprintf(fd,"Latitude, Longitude,Altitude,Speed in knots, Date, Time,Number of satellites being tracked, IDs of satellites ins use, Fix, Fix mode,\r\n");
  //fprintf(fd,"%0.6f,%0.6f,%0.3f,%0.2f,%d,%0.0f,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d,%d",latitude, longitude, altitude, speed, date, utc, sat_tracked, id1,id2,id3,id4,id5,id6,id7,id8,id9,id10,id11,id12, fix,fix_3d);
      }
    }
}