File content as of revision 15:10c06c3edfc7:

/* Copyright C2013 Doug Anson, MIT License
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
 * and associated documentation files the "Software", to deal in the Software without restriction,
 * including without limitation the rights to use, copy, modify, merge, publish, distribute,
 * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in all copies or
 * substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
 */
 
 // class support
 #include "MBEDUbloxGPS.h"
 
 // MBEDEndpoint support
 #include "MBEDEndpoint.h"
 
 // our instance
 MBEDUbloxGPS *_ublox_gps_instance = NULL;
 bool _ublox_gps_loop = true;
  
 // threaded task
 static void read_gps(void const *args) {
    while (_ublox_gps_loop == true && _ublox_gps_instance != NULL) {
        _ublox_gps_instance->update();
        wait_ms(UBLOX_GPS_POLL_MS);
    }
    if (_ublox_gps_instance != NULL) _ublox_gps_instance->logger()->log("GPS update thread stopping...");
 }
 
 // default constructor
 MBEDUbloxGPS::MBEDUbloxGPS(ErrorHandler *error_handler, void *endpoint,C027 *c027) : BaseClass(error_handler,endpoint) {
     this->m_gps_poll_thread = NULL;
     this->m_c027 = c027;
     //this->m_gps = new I2C(GPSSDA, GPSSCL);
     //this->m_gps->frequency(UBLOX_GPS_FREQ);
     this->m_latitude = 0;
     this->m_longitude = 0;
     _ublox_gps_instance = this;
 }
 
 // default destructor
 MBEDUbloxGPS::~MBEDUbloxGPS() {
     if (this->m_gps_poll_thread != NULL) { this->m_gps_poll_thread->terminate(); delete this->m_gps_poll_thread; }
     if (this->m_c027 != NULL) delete this->m_c027;
     if (this->m_gps != NULL) delete this->m_gps;
 }
 
 // update our GPS info
 void MBEDUbloxGPS::update() {
     int s = 0;
     int i = 0;
     int o = 1; 
     char in[1024];
     char out[1024] = { 0xFF/*STREAM_REG*/, 0x00 /* ... */ };
     
     memset(in,0,1024);
     memset(out,0,1024);
     
     // read the GPS input
     const char r = 0xFD /*LENGTH_REG*/; 
     unsigned char sz[2];
     if (0 == this->m_gps->write(GPSADR,&r,sizeof(r), true))
     {
        if (0 == this->m_gps->read(GPSADR,(char*)sz,sizeof(sz),true))
        {
            int b  = (int)sz[0];
            b *= 256;
            b += sz[1];
            if (i == s)
                i = s = 0;
            if (b > sizeof(in)-s) 
                b = sizeof(in)-s;
            if (b > 0) 
            {
                if (0 == this->m_gps->read(GPSADR,&in[s],b,true))
                    s += b;
            }
        }
     }
     this->m_gps->stop();
     if (o > 1)
     {
        if (0 == this->m_gps->write(GPSADR,out,o))
            o = 0;
     }
     
     // convert the input to latitude/longitude decimal values
     this->logger()->log("GPS: Output: %s",out);
 }
 
 // start the update thread and connect
 bool MBEDUbloxGPS::connect() {
     if (this->m_gps_poll_thread == NULL) {
          //this->logger()->log("starting GPS update thread...");
          //this->m_gps_poll_thread = new Thread(read_gps);
     }
     return true;
 }
 
 // halt the update thread and disconnect
 bool MBEDUbloxGPS::disconnect() { _ublox_gps_loop = false; return true; }
 
 // get latitude
 float MBEDUbloxGPS::getLatitude() { return this->m_latitude; }
 
 // get longitude
 float MBEDUbloxGPS::getLongitude() { return this->m_longitude; }