File content as of revision 91:423177e8a401:

#include "AccelerationMeasurement.h"
#include "ComposedRecord.h"
#include "CharValue.h"
#include "IntegerValue.h"
#include "FloatValue.h"
#include "MbedClient.h"
#include "logging.h"

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

AccelerationMeasurement::AccelerationMeasurement(AbstractSmartRest& client, SmartRestTemplate& tpl, long& deviceId, 
    DeviceIO& io, DeviceInfo& deviceInfo, DisplayInfo& displayInfo) :
    _client(client),
    _tpl(tpl),
    _deviceId(deviceId),
    _sensor(SDA,SCL),
    _io(io),
    _deviceInfo(deviceInfo),
    _displayInfo(displayInfo)
{
    _init = false;
    oldValues[0] = 0;
    oldValues[1] = 0;
    oldValues[2] = 0;
    sendingTimer.start();
}

bool AccelerationMeasurement::init()
{
    if (_init)
        return false;
    
    // Insert measurement
    // USAGE: 106,<DEVICE/ID>,<X>,<Y>,<Z>
    if (!_tpl.add("10,106,POST,/measurement/measurements,application/vnd.com.nsn.cumulocity.measurement+json,application/vnd.com.nsn.cumulocity.measurement+json,%%,NOW UNSIGNED NUMBER NUMBER NUMBER,\"{\"\"time\"\":\"\"%%\"\",\"\"source\"\":{\"\"id\"\":\"\"%%\"\"},\"\"type\"\":\"\"c8y_MotionMeasurement\"\",\"\"c8y_MotionMeasurement\"\":{\"\"x\"\":{\"\"value\"\":%%,\"\"unit\"\":\"\"m/s^2\"\"},\"\"y\"\":{\"\"value\"\":%%,\"\"unit\"\":\"\"m/s^2\"\"},\"\"z\"\":{\"\"value\"\":%%,\"\"unit\"\":\"\"m/s^2\"\"}}}\"\r\n"))
        return false;

    _test = _sensor.testConnection();
    _init = true;
    return true;
}

bool AccelerationMeasurement::run()
{
    extern bool lastSensorReadingSent;
    if (!_test)
        return false;
    
    float data[3] = { 0.0, 0.0, 0.0 };
    _sensor.readData(data);

//    if (abs(oldValues[0]-data[0]) <= abs(oldValues[0])*THRESHOLD_PERCENT_ACCE &&
//        abs(oldValues[1]-data[1]) <= abs(oldValues[1])*THRESHOLD_PERCENT_ACCE &&
//        abs(oldValues[2]-data[2]) <= abs(oldValues[2])*THRESHOLD_PERCENT_ACCE) {
    if (((0.15>abs(data[0])) || (abs(oldValues[0]-data[0]) <= abs(oldValues[0])*THRESHOLD_PERCENT_ACCE)) &&
        ((0.1> abs(data[1])) || (abs(oldValues[1]-data[1]) <= abs(oldValues[1])*THRESHOLD_PERCENT_ACCE))) {
        if (sendingTimer.read() < TIME_LIMIT_ACCE) {
//            printf("[N] Acc %f, %f, %f\r\n", data[0], data[1], data[2]);
            if (lastSensorReadingSent) {
                _io.lcdPrint(_displayInfo.getFirstLine(), _displayInfo.getSecondLine());
                lastSensorReadingSent=false;
            }
            aDebug("Similar acceleration readings found, no sending!\r\n");
            return true;
        } else {
            aDebug("Acceleration sensor timed out at %f s, a sending is forced.\r\n", sendingTimer.read());
        }
    }
//    printf("[Y] Acc %f, %f, %f\r\n", data[0], data[1], data[2]);
    char status[27] = {0};
    snprintf(status, 27, "Sending Acc %.1f,%.1f,%.1f", data[0], data[1], data[2]);
    _io.lcdPrint(_displayInfo.getFirstLine(), _displayInfo.getSecondLine(), status);

    ComposedRecord record;
    IntegerValue msgId(106);
    IntegerValue devId(_deviceId);
    FloatValue xValue(data[0], 2);
    FloatValue yValue(data[1], 2);
    FloatValue zValue(data[2], 2);
    if ((!record.add(msgId)) || (!record.add(devId)) || (!record.add(xValue)) || (!record.add(yValue)) || (!record.add(zValue)))
        return false;

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