File content as of revision 76:b07effe83fb8:

#include "LocationUpdate.h"
#include "Aggregator.h"
#include "ComposedRecord.h"
#include "CharValue.h"
#include "IntegerValue.h"
#include "FloatValue.h"
#include "logging.h"

#define THRESHOLD_PERCENT_LOC 0.05       // Percentage cut-off for avoiding sending similar acceleration sensor data.
// Time interval for forcing a sending even if analog sensor readings are constantly similar (in seconds).
#define TIME_LIMIT_LOC 900               

LocationUpdate::LocationUpdate(AbstractSmartRest& client, SmartRestTemplate& tpl, long& deviceId, GPSTracker& gpsTracker, 
    DeviceIO& io, DeviceInfo& deviceInfo, DeviceBootstrap& bootstrap) :
    _client(client),
    _tpl(tpl),
    _deviceId(deviceId),
    _gpsTracker(gpsTracker),
    _io(io),
    _deviceInfo(deviceInfo),
    _bootstrap(bootstrap)
{
    _init = false;
    oldValues[0] = 0;
    oldValues[1] = 0;
    oldValues[2] = 0;
    sendingTimer.start();
}

bool LocationUpdate::init()
{
    if (_init)
        return false;
    
    // Update device position
    // USAGE: 108,<DEVICE/ID>,<ALTITUDE>,<LATITUDE>,<LONGITUDE>
    if (!_tpl.add("10,108,PUT,/inventory/managedObjects/%%,application/vnd.com.nsn.cumulocity.managedObject+json,application/vnd.com.nsn.cumulocity.managedObject+json,%%,UNSIGNED NUMBER NUMBER NUMBER,\"{\"\"c8y_Position\"\":{\"\"alt\"\":%%,\"\"lat\"\":%%,\"\"lng\"\":%%},\"\"c8y_MotionTracking\"\":{\"\"active\"\":true}}\"\r\n"))
        return false;

    // Insert measurement
    // USAGE: 109,<DEVICE/ID>,<ALTITUDE>,<LATITUDE>,<LONGITUDE>
    if (!_tpl.add("10,109,POST,/event/events,application/vnd.com.nsn.cumulocity.event+json,application/vnd.com.nsn.cumulocity.event+json,%%,NOW UNSIGNED NUMBER NUMBER NUMBER,\"{\"\"time\"\":\"\"%%\"\",\"\"source\"\":{\"\"id\"\":\"\"%%\"\"},\"\"type\"\":\"\"c8y_LocationUpdate\"\",\"\"text\"\":\"\"Mbed location update\"\",\"\"c8y_Position\"\":{\"\"alt\"\":%%,\"\"lat\"\":%%,\"\"lng\"\":%%}}\"\r\n"))
        return false;

    _init = true;
    return true;
}

bool LocationUpdate::run()
{
    GPSTracker::Position position;
    
    if (!_gpsTracker.position(&position)) {
        aError("No GPS data available.\r\n");
        return false;
    }
    float data[3] = { 0.0, 0.0, 0.0 };
    data[0] = position.altitude;
    data[1] = position.latitude;
    data[2] = position.longitude;
    char tenant[25] = {0};
    const char* user= _bootstrap.username();
    int len = strchr(user, '/')-user+1+8;  // 8: length of "Tenant: ";
    len = len <= 25 ? len : 25;
    snprintf(tenant, len, "Tenant: %s", user);
    char signal[25] = {0};
    if (_deviceInfo.signalQuality())
        snprintf(signal, 25, "Network: %d dBm", _deviceInfo.signalQuality()->rssi);
    else
        strncpy(signal, "Network: ? dBm", 25);
    if (abs(oldValues[0]-data[0]) <= abs(oldValues[0])*THRESHOLD_PERCENT_LOC &&
        abs(oldValues[1]-data[1]) <= abs(oldValues[1])*THRESHOLD_PERCENT_LOC &&
        abs(oldValues[2]-data[2]) <= abs(oldValues[2])*THRESHOLD_PERCENT_LOC) {
        if (sendingTimer.read() < TIME_LIMIT_LOC) {
            _io.lcdPrint(tenant, signal);
            aDebug("Similar location readings found, no sending!\r\n");
            return true;
        } else {
            aDebug("Sending timer of location sensor timed out at %f s, a sending is forced.\r\n", sendingTimer.read());
        }
    }
    char status[27] = {0};
    snprintf(status, 27, "Sending GPS %.1f,%.1f,%.1f", data[0], data[1], data[2]);
    _io.lcdPrint(tenant, signal, status);
        
    Aggregator aggregator;
    ComposedRecord record1, record2;
    IntegerValue msgId1(108);
    IntegerValue msgId2(109);
    IntegerValue devId(_deviceId);
    FloatValue altitude(position.altitude, 2);
    FloatValue latitude(position.latitude, 6);
    FloatValue longitude(position.longitude, 6);
    if ((!record1.add(msgId1)) || (!record1.add(devId)) || (!record1.add(altitude)) || (!record1.add(latitude)) || (!record1.add(longitude)))
        return false;
    if ((!record2.add(msgId2)) || (!record2.add(devId)) || (!record2.add(altitude)) || (!record2.add(latitude)) || (!record2.add(longitude)))
        return false;
    if ((!aggregator.add(record1)) || (!aggregator.add(record2)))
        return false;

    float t_start = sendingTimer.read();
    if (_client.send(aggregator) != SMARTREST_SUCCESS) {
        aWarning("Sending GPS readings failed.\r\n");
        _client.stop();
        return false;
    }
    float t_end = sendingTimer.read();
    _client.stop();
    aInfo("GPS readings sent in %.1f.\r\n", t_end-t_start);
    oldValues[0] = data[0];
    oldValues[1] = data[1];
    oldValues[2] = data[2];
    sendingTimer.reset();
    return true;
}