Published February 6, 2019 © Apache-2.0

Sony Spresense GPS + Compass

If you're hiking, going on a family trip in the car or just plain curious about where you are, the Spresense is just the device you need.

BeginnerProtip1 hour1,672

Things used in this project

Hardware components

Sony Spresense boards (main & extension)

Adafruit Standard LCD - 16x2 White on Blue

Software apps and online services

Arduino IDE

Story

Hi everyone! Ever been on a trip away from the city and realized that your phone doesn't have a signal so you can't use its GPS? Ever gone hiking and the traditional compass and gps doesn't really do it for you, well I've got just what you need an all in one GPS and compass IoT-enabled device that will never leave hanging or lost for that matter. The device I'm talking about is the Sony Spresense, small, compact with a powerful processor. The following will project demonstrate to you how to use the GPS onboard the microcontroller and with a few calculations will be able to find our heading. Before I begin I'd like to thank the good folks at Sony for providing us with the code for the GPS and the audio because if you look at Arduino code I've provided it's a mixture of these two code for geofencing purposes plus the LCD I2C code for the screen and the code to calculate the heading. Just a heads up in the code I've removed all coordinates so you can place your own coordinates and for personal reasons also. Before we begin a few words about geofencing. Geo-fencing (geofencing) is a feature in a software program that uses the global positioning system (GPS) or radio frequency identification (RFID) to define geographical boundaries.

Geo-fencing allow an administrator to set up triggers so when a device enters (or exits) the boundaries defined by the administrator, an alert is issued. Many geo-fencing applications incorporate Google Earth, allowing administrators to define boundaries on top of a satelliteview of a specific geographical area. Other applications define boundaries by longitude and latitude or through user-created and Web-based maps.

Geofence virtual barriers can be active or passive. Active geofences require an end user to opt-in to location services and a mobile app to be open. Passive geofences are always on; they rely on Wi-Fi and cellular data instead of GPS or RFID and work in the background.

Step 1: (Setup)

To setup your spresense board for use with arduino follow these instructions https://developer.sony.com/develop/spresense/developer-tools/get-started-using-arduino-ide/set-up-the-arduino-ide

Step 2: (Hardware Connections)

For this project in regards for hardware were going to use only an LCD I2C although depending on the project you can add on any other sensor you'd like. As for connecting your LCD I2C the wiring connections are the following:

LCD VCC => SPRESENCE 5vdc

LCD GND => SPRESENCE GND

LCD SDA => D14

LCD SCL => D15

You'll also have to download the following library for the LCD I2C https://playground.arduino.cc/Code/LCDi2c

Step 3: (Upload The Code)

Our final step will be to upload the code onto the board. Now within the code you'll also find the math formula to calculate your bearing.

A few pictures depicting what you'll see in the Serial Monitor and a video showing it in action.

An interesting piece of code we can add onto the one I've already provided can be Morse Code. Say your lost or stranded on and island in the middle of the ocean you can

hit a panic button on the Sony Spresence and once it picks up your GPS coordinates it can convert them to led pulses. In the code I've provided you input your longitude manually

and it translates it to Morse Code. Ofcourse you can work with the code as you please and translate the coordinates that you recieve into Morse Code directly.

#include <Audio.h>
#include <GNSS.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

#define STRING_BUFFER_SIZE  128       /**< %Buffer size */

#define RESTART_CYCLE       (60 * 5)  /**< positioning test term */

float currentLatitude = 11.11111;  /*Your current Latitude here*/
float currentLongitude = 11.11111; /*Your current Longitude here*/

AudioClass *theAudio;

static SpGnss Gnss;                   /**< SpGnss object */

int led = 13;

int getheading(float targetlatitude, float targetlongitude)
{
  float heading = atan2(targetlatitude - currentLatitude, targetlongitude - currentLongitude);

  heading *= (180 / 3.14159);
  heading = (450 - (int)heading) % 360;

  return heading;
}

class Score
{
  public:

    typedef struct {
      int fs;
      int time;
    } Note;

    void init() {
      pos = 0;
    }

    Note get() {
      return data[pos++];
    }

  private:

    int pos;

    Note data[17] =
    {
      {262, 500},
      {294, 500},
      {330, 500},
      {349, 500},
      {392, 500},
      {440, 500},
      {494, 500},
      {523, 1000},

      {523, 500},
      {494, 500},
      {440, 500},
      {392, 500},
      {349, 500},
      {330, 500},
      {294, 500},
      {262, 1000},

      {0, 0}
    };
};

Score theScore;
static void Led_isActive(void)
{
  static int state = 1;
  if (state == 1)
  {
    ledOn(PIN_LED0);
    state = 0;
  }
  else
  {
    ledOff(PIN_LED0);
    state = 1;
  }
}

/**
   @brief Turn on / off the LED1 for positioning state notification.

   @param [in] state Positioning state
*/
static void Led_isPosfix(bool state)
{
  if (state)
  {
    ledOn(PIN_LED1);
  }
  else
  {
    ledOff(PIN_LED1);
  }
}

/**
   @brief Turn on / off the LED3 for error notification.

   @param [in] state Error state
*/
static void Led_isError(bool state)
{
  if (state)
  {
    ledOn(PIN_LED3);
  }
  else
  {
    ledOff(PIN_LED3);
  }
}

/**
   @brief Activate GNSS device and start positioning.
*/
void setup() {
  /* put your setup code here, to run once: */
  theAudio = AudioClass::getInstance();
  theAudio->begin();
  puts("initialization Audio Library");

  theAudio->setPlayerMode(AS_SETPLAYER_OUTPUTDEVICE_SPHP);

  theScore.init();

  pinMode(led, OUTPUT);

  int error_flag = 0;

  /* Set serial baudrate. */
  Serial.begin(115200);

  /* Wait HW initialization done. */
  sleep(3);

  /* Turn on all LED:Setup start. */
  ledOn(PIN_LED0);
  ledOn(PIN_LED1);
  ledOn(PIN_LED2);
  ledOn(PIN_LED3);

  /* Set Debug mode to Info */
  Gnss.setDebugMode(PrintInfo);

  int result;

  /* Activate GNSS device */
  result = Gnss.begin();

  if (result != 0)
  {
    Serial.println("Gnss begin error!!");
    error_flag = 1;
  }
  else
  {
    /* Setup GNSS */
    Gnss.select(QZ_L1CA);  // Michibiki complement
    Gnss.select(QZ_L1S);   // Michibiki augmentation(Valid only in Japan)

    /* Start positioning */
    result = Gnss.start(COLD_START);
    if (result != 0)
    {
      Serial.println("Gnss start error!!");
      error_flag = 1;
    }
    else
    {
      Serial.println("Gnss setup OK");
    }
  }

  /* Turn off all LED:Setup done. */
  ledOff(PIN_LED0);
  ledOff(PIN_LED1);
  ledOff(PIN_LED2);
  ledOff(PIN_LED3);

  /* Set error LED. */
  if (error_flag == 1)
  {
    Led_isError(true);
    exit(0);
  }
}

/**
   @brief %Print position information.
*/
static void print_pos(SpNavData *pNavData)
{
  char StringBuffer[STRING_BUFFER_SIZE];

  /* print time */
  snprintf(StringBuffer, STRING_BUFFER_SIZE, "%04d/%02d/%02d ", pNavData->time.year, pNavData->time.month, pNavData->time.day);
  Serial.print(StringBuffer);

  snprintf(StringBuffer, STRING_BUFFER_SIZE, "%02d:%02d:%02d.%06d, ", pNavData->time.hour, pNavData->time.minute, pNavData->time.sec, pNavData->time.usec);
  Serial.print(StringBuffer);

  /* print satellites count */
  snprintf(StringBuffer, STRING_BUFFER_SIZE, "numSat:%2d, ", pNavData->numSatellites);
  Serial.print(StringBuffer);

  /* print position data */
  if (pNavData->posFixMode == FixInvalid)
  {
    Serial.print("No-Fix, ");
  }
  else
  {
    Serial.print("Fix, ");
  }
  if (pNavData->posDataExist == 0)
  {
    Serial.print("No Position");
    lcd.print("No Position");

  }
  else
  {
    lcd.setCursor(0,0);
    Serial.print("Lat=");
    lcd.print("Lat=");
    Serial.print(pNavData->latitude, 6);
    lcd.print(pNavData->latitude, 6);
    Serial.print(", Lon=");
    Serial.print(pNavData->longitude, 6);

    if ((pNavData->latitude >= 11.111111) && (pNavData->latitude < 11.111111)) //Here you enter your first Geofencing coordinates
    {
      lcd.setCursor(0,1);
      lcd.print("North: ");
      lcd.println(getheading(pNavData->latitude, pNavData->longitude));

      while (1);
    }

    if ((pNavData->latitude >= 11.111111) && (pNavData->latitude < 11.111111)) //Here you enter your second Geofencing coordinates
    {
      puts("loop!!");

      Score::Note theNote = theScore.get();
      if (theNote.fs == 0) {
        puts("End,");
        exit(1);
      }

      theAudio->setBeep(1, -40, theNote.fs);
      usleep(theNote.time * 1000);
      theAudio->setBeep(0, 0, 0);
      usleep(100000);
      /*Morse Code*/
    }
  }

  Serial.println("");
}



/**
   @brief %Print satellite condition.
*/
static void print_condition(SpNavData *pNavData)
{
  char StringBuffer[STRING_BUFFER_SIZE];
  unsigned long cnt;

  /* Print satellite count. */
  snprintf(StringBuffer, STRING_BUFFER_SIZE, "numSatellites:%2d\n", pNavData->numSatellites);
  Serial.print(StringBuffer);

  for (cnt = 0; cnt < pNavData->numSatellites; cnt++)
  {
    const char *pType = "---";
    SpSatelliteType sattype = pNavData->getSatelliteType(cnt);

    /* Get satellite type. */
    /* Keep it to three letters. */
    switch (sattype)
    {
      case GPS:
        pType = "GPS";
        break;

      case GLONASS:
        pType = "GLN";
        break;

      case QZ_L1CA:
        pType = "QCA";
        break;

      case SBAS:
        pType = "SBA";
        break;

      case QZ_L1S:
        pType = "Q1S";
        break;

      default:
        pType = "UKN";
        break;
    }

    /* Get print conditions. */
    unsigned long Id  = pNavData->getSatelliteId(cnt);
    unsigned long Elv = pNavData->getSatelliteElevation(cnt);
    unsigned long Azm = pNavData->getSatelliteAzimuth(cnt);
    float sigLevel = pNavData->getSatelliteSignalLevel(cnt);

    /* Print satellite condition. */
    snprintf(StringBuffer, STRING_BUFFER_SIZE, "[%2d] Type:%s, Id:%2d, Elv:%2d, Azm:%3d, CN0:", cnt, pType, Id, Elv, Azm );
    Serial.print(StringBuffer);
    Serial.println(sigLevel, 6);
  }
}

/**
   @brief %Print position information and satellite condition.

   @details When the loop count reaches the RESTART_CYCLE value, GNSS device is
            restarted.
*/
void loop()
{
  /* put your main code here, to run repeatedly: */

  static int LoopCount = 0;
  static int LastPrintMin = 0;

  lcd.begin();

  // Turn on the blacklight and print a message.
  lcd.backlight();
  /* Blink LED. */
  Led_isActive();

  /* Check update. */
  if (Gnss.waitUpdate(-1))
  {
    /* Get NaviData. */
    SpNavData NavData;
    Gnss.getNavData(&NavData);

    /* Set posfix LED. */
    bool LedSet = (NavData.posDataExist && (NavData.posFixMode != FixInvalid));
    Led_isPosfix(LedSet);

    /* Print satellite information every minute. */
    if (NavData.time.minute != LastPrintMin)
    {
      print_condition(&NavData);
      LastPrintMin = NavData.time.minute;
    }

    /* Print position information. */
    print_pos(&NavData);
  }
  else
  {
    /* Not update. */
    Serial.println("data not update");
  }

  /* Check loop count. */
  LoopCount++;
  if (LoopCount >= RESTART_CYCLE)
  {
    int error_flag = 0;

    /* Turn off LED0 */
    ledOff(PIN_LED0);

    /* Set posfix LED. */
    Led_isPosfix(false);

    /* Restart GNSS. */
    if (Gnss.stop() != 0)
    {
      Serial.println("Gnss stop error!!");
      error_flag = 1;
    }
    else if (Gnss.end() != 0)
    {
      Serial.println("Gnss end error!!");
      error_flag = 1;
    }
    else
    {
      Serial.println("Gnss stop OK.");
    }

    if (Gnss.begin() != 0)
    {
      Serial.println("Gnss begin error!!");
      error_flag = 1;
    }
    else if (Gnss.start(HOT_START) != 0)
    {
      Serial.println("Gnss start error!!");
      error_flag = 1;
    }
    else
    {
      Serial.println("Gnss restart OK.");
    }

    LoopCount = 0;

    /* Set error LED. */
    if (error_flag == 1)
    {
      Led_isError(true);
      exit(0);
    }
  }
}

int dotDelay = 200;
int led = PIN_LED0;

char* numbers[] = {"-----", ".----", "..---", "...--", "....-", ".....", "-....", "--...", "----."};

void setup() {
  pinMode(led, OUTPUT);
  Serial.begin(115200);
}

void loop() {
  char longtitude;

  longtitude = 12345; /*Put your coordinates here*/ 
  
  if (longtitude >=  '0' && longtitude <= '9')
  {
    flashSequence(numbers[longtitude - '0']);
  }

}

void flashSequence(char* sequence)
{
  int i = 0;
  while (sequence[i] != '\0')
  {
    flashDotOrDash(sequence[i]);
    i++;
  }
  delay (dotDelay * 3);
}

void flashDotOrDash(char dotOrDash)
{
  digitalWrite(led, HIGH);
  if (dotOrDash == '.')
  {
    delay(dotDelay);
  }
  else
  {
    delay(dotDelay * 3);
  }
  digitalWrite(led, LOW);
  delay(dotDelay);
}

Credits

George Kartsonas

19 projects • 46 followers

Sony Spresense GPS + Compass

Things used in this project

Hardware components

Software apps and online services

Story

Code

Arduino GPS+LCD+COMPASS Code

Morse Code

Credits

George Kartsonas

Comments

Embed the widget on your own site

Sony Spresense GPS + Compass

Sony Spresense GPS + Compass

Things used in this project

Hardware components

Software apps and online services

Story

Code

Arduino GPS+LCD+COMPASS Code

Morse Code

Credits

George Kartsonas

Comments

Related channels and tags