mirror of https://github.com/meshcore-dev/MeshCore
Scott Powell
9 months ago
24 changed files with 512 additions and 19 deletions
@ -0,0 +1,38 @@ |
|||||
|
/* Linker script to configure memory regions. */ |
||||
|
|
||||
|
SEARCH_DIR(.) |
||||
|
GROUP(-lgcc -lc -lnosys) |
||||
|
|
||||
|
MEMORY |
||||
|
{ |
||||
|
FLASH (rx) : ORIGIN = 0x26000, LENGTH = 0xD4000 - 0x26000 |
||||
|
|
||||
|
/* SRAM required by Softdevice depend on |
||||
|
* - Attribute Table Size (Number of Services and Characteristics) |
||||
|
* - Vendor UUID count |
||||
|
* - Max ATT MTU |
||||
|
* - Concurrent connection peripheral + central + secure links |
||||
|
* - Event Len, HVN queue, Write CMD queue |
||||
|
*/ |
||||
|
RAM (rwx) : ORIGIN = 0x20006000, LENGTH = 0x20040000 - 0x20006000 |
||||
|
} |
||||
|
|
||||
|
SECTIONS |
||||
|
{ |
||||
|
. = ALIGN(4); |
||||
|
.svc_data : |
||||
|
{ |
||||
|
PROVIDE(__start_svc_data = .); |
||||
|
KEEP(*(.svc_data)) |
||||
|
PROVIDE(__stop_svc_data = .); |
||||
|
} > RAM |
||||
|
|
||||
|
.fs_data : |
||||
|
{ |
||||
|
PROVIDE(__start_fs_data = .); |
||||
|
KEEP(*(.fs_data)) |
||||
|
PROVIDE(__stop_fs_data = .); |
||||
|
} > RAM |
||||
|
} INSERT AFTER .data; |
||||
|
|
||||
|
INCLUDE "nrf52_common.ld" |
||||
@ -0,0 +1,38 @@ |
|||||
|
/* Linker script to configure memory regions. */ |
||||
|
|
||||
|
SEARCH_DIR(.) |
||||
|
GROUP(-lgcc -lc -lnosys) |
||||
|
|
||||
|
MEMORY |
||||
|
{ |
||||
|
FLASH (rx) : ORIGIN = 0x27000, LENGTH = 0xD4000 - 0x27000 |
||||
|
|
||||
|
/* SRAM required by Softdevice depend on |
||||
|
* - Attribute Table Size (Number of Services and Characteristics) |
||||
|
* - Vendor UUID count |
||||
|
* - Max ATT MTU |
||||
|
* - Concurrent connection peripheral + central + secure links |
||||
|
* - Event Len, HVN queue, Write CMD queue |
||||
|
*/ |
||||
|
RAM (rwx) : ORIGIN = 0x20006000, LENGTH = 0x20040000 - 0x20006000 |
||||
|
} |
||||
|
|
||||
|
SECTIONS |
||||
|
{ |
||||
|
. = ALIGN(4); |
||||
|
.svc_data : |
||||
|
{ |
||||
|
PROVIDE(__start_svc_data = .); |
||||
|
KEEP(*(.svc_data)) |
||||
|
PROVIDE(__stop_svc_data = .); |
||||
|
} > RAM |
||||
|
|
||||
|
.fs_data : |
||||
|
{ |
||||
|
PROVIDE(__start_fs_data = .); |
||||
|
KEEP(*(.fs_data)) |
||||
|
PROVIDE(__stop_fs_data = .); |
||||
|
} > RAM |
||||
|
} INSERT AFTER .data; |
||||
|
|
||||
|
INCLUDE "nrf52_common.ld" |
||||
@ -0,0 +1,223 @@ |
|||||
|
#pragma once |
||||
|
|
||||
|
#include <stdint.h> |
||||
|
|
||||
|
#define LPP_DIGITAL_INPUT 0 // 1 byte
|
||||
|
#define LPP_DIGITAL_OUTPUT 1 // 1 byte
|
||||
|
#define LPP_ANALOG_INPUT 2 // 2 bytes, 0.01 signed
|
||||
|
#define LPP_ANALOG_OUTPUT 3 // 2 bytes, 0.01 signed
|
||||
|
#define LPP_GENERIC_SENSOR 100 // 4 bytes, unsigned
|
||||
|
#define LPP_LUMINOSITY 101 // 2 bytes, 1 lux unsigned
|
||||
|
#define LPP_PRESENCE 102 // 1 byte, bool
|
||||
|
#define LPP_TEMPERATURE 103 // 2 bytes, 0.1°C signed
|
||||
|
#define LPP_RELATIVE_HUMIDITY 104 // 1 byte, 0.5% unsigned
|
||||
|
#define LPP_ACCELEROMETER 113 // 2 bytes per axis, 0.001G
|
||||
|
#define LPP_BAROMETRIC_PRESSURE 115 // 2 bytes 0.1hPa unsigned
|
||||
|
#define LPP_VOLTAGE 116 // 2 bytes 0.01V unsigned
|
||||
|
#define LPP_CURRENT 117 // 2 bytes 0.001A unsigned
|
||||
|
#define LPP_FREQUENCY 118 // 4 bytes 1Hz unsigned
|
||||
|
#define LPP_PERCENTAGE 120 // 1 byte 1-100% unsigned
|
||||
|
#define LPP_ALTITUDE 121 // 2 byte 1m signed
|
||||
|
#define LPP_CONCENTRATION 125 // 2 bytes, 1 ppm unsigned
|
||||
|
#define LPP_POWER 128 // 2 byte, 1W, unsigned
|
||||
|
#define LPP_DISTANCE 130 // 4 byte, 0.001m, unsigned
|
||||
|
#define LPP_ENERGY 131 // 4 byte, 0.001kWh, unsigned
|
||||
|
#define LPP_DIRECTION 132 // 2 bytes, 1deg, unsigned
|
||||
|
#define LPP_UNIXTIME 133 // 4 bytes, unsigned
|
||||
|
#define LPP_GYROMETER 134 // 2 bytes per axis, 0.01 °/s
|
||||
|
#define LPP_COLOUR 135 // 1 byte per RGB Color
|
||||
|
#define LPP_GPS 136 // 3 byte lon/lat 0.0001 °, 3 bytes alt 0.01 meter
|
||||
|
#define LPP_SWITCH 142 // 1 byte, 0/1
|
||||
|
#define LPP_POLYLINE 240 // 1 byte size, 1 byte delta factor, 3 byte lon/lat 0.0001° * factor, n (size-8) bytes deltas
|
||||
|
|
||||
|
// Multipliers
|
||||
|
#define LPP_DIGITAL_INPUT_MULT 1 |
||||
|
#define LPP_DIGITAL_OUTPUT_MULT 1 |
||||
|
#define LPP_ANALOG_INPUT_MULT 100 |
||||
|
#define LPP_ANALOG_OUTPUT_MULT 100 |
||||
|
#define LPP_GENERIC_SENSOR_MULT 1 |
||||
|
#define LPP_LUMINOSITY_MULT 1 |
||||
|
#define LPP_PRESENCE_MULT 1 |
||||
|
#define LPP_TEMPERATURE_MULT 10 |
||||
|
#define LPP_RELATIVE_HUMIDITY_MULT 2 |
||||
|
#define LPP_ACCELEROMETER_MULT 1000 |
||||
|
#define LPP_BAROMETRIC_PRESSURE_MULT 10 |
||||
|
#define LPP_VOLTAGE_MULT 100 |
||||
|
#define LPP_CURRENT_MULT 1000 |
||||
|
#define LPP_FREQUENCY_MULT 1 |
||||
|
#define LPP_PERCENTAGE_MULT 1 |
||||
|
#define LPP_ALTITUDE_MULT 1 |
||||
|
#define LPP_POWER_MULT 1 |
||||
|
#define LPP_DISTANCE_MULT 1000 |
||||
|
#define LPP_ENERGY_MULT 1000 |
||||
|
#define LPP_DIRECTION_MULT 1 |
||||
|
#define LPP_UNIXTIME_MULT 1 |
||||
|
#define LPP_GYROMETER_MULT 100 |
||||
|
#define LPP_GPS_LAT_LON_MULT 10000 |
||||
|
#define LPP_GPS_ALT_MULT 100 |
||||
|
#define LPP_SWITCH_MULT 1 |
||||
|
#define LPP_CONCENTRATION_MULT 1 |
||||
|
#define LPP_COLOUR_MULT 1 |
||||
|
|
||||
|
#define LPP_ERROR_OK 0 |
||||
|
#define LPP_ERROR_OVERFLOW 1 |
||||
|
#define LPP_ERROR_UNKOWN_TYPE 2 |
||||
|
|
||||
|
class LPPReader { |
||||
|
const uint8_t* _buf; |
||||
|
uint8_t _len; |
||||
|
uint8_t _pos; |
||||
|
|
||||
|
float getFloat(const uint8_t * buffer, uint8_t size, uint32_t multiplier, bool is_signed) { |
||||
|
uint32_t value = 0; |
||||
|
for (uint8_t i = 0; i < size; i++) { |
||||
|
value = (value << 8) + buffer[i]; |
||||
|
} |
||||
|
|
||||
|
int sign = 1; |
||||
|
if (is_signed) { |
||||
|
uint32_t bit = 1ul << ((size * 8) - 1); |
||||
|
if ((value & bit) == bit) { |
||||
|
value = (bit << 1) - value; |
||||
|
sign = -1; |
||||
|
} |
||||
|
} |
||||
|
return sign * ((float) value / multiplier); |
||||
|
} |
||||
|
|
||||
|
public: |
||||
|
LPPReader(const uint8_t buf[], uint8_t len) : _buf(buf), _len(len), _pos(0) { } |
||||
|
|
||||
|
void reset() { |
||||
|
_pos = 0; |
||||
|
} |
||||
|
|
||||
|
bool readHeader(uint8_t& channel, uint8_t& type) { |
||||
|
if (_pos + 2 < _len) { |
||||
|
channel = _buf[_pos++]; |
||||
|
type = _buf[_pos++]; |
||||
|
|
||||
|
return channel != 0; // channel 0 is End-of-data
|
||||
|
} |
||||
|
return false; // end-of-buffer
|
||||
|
} |
||||
|
|
||||
|
bool readGPS(float& lat, float& lon, float& alt) { |
||||
|
lat = getFloat(&_buf[_pos], 3, 10000, true); _pos += 3; |
||||
|
lon = getFloat(&_buf[_pos], 3, 10000, true); _pos += 3; |
||||
|
alt = getFloat(&_buf[_pos], 3, 100, true); _pos += 3; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readVoltage(float& voltage) { |
||||
|
voltage = getFloat(&_buf[_pos], 2, 100, false); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readCurrent(float& amps) { |
||||
|
amps = getFloat(&_buf[_pos], 2, 1000, false); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readPower(float& watts) { |
||||
|
watts = getFloat(&_buf[_pos], 2, 1, false); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readTemperature(float& degrees_c) { |
||||
|
degrees_c = getFloat(&_buf[_pos], 2, 10, true); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readPressure(float& pa) { |
||||
|
pa = getFloat(&_buf[_pos], 2, 10, false); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readRelativeHumidity(float& pct) { |
||||
|
pct = getFloat(&_buf[_pos], 1, 2, false); _pos += 1; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
bool readAltitude(float& m) { |
||||
|
m = getFloat(&_buf[_pos], 2, 1, true); _pos += 2; |
||||
|
return _pos <= _len; |
||||
|
} |
||||
|
|
||||
|
void skipData(uint8_t type) { |
||||
|
switch (type) { |
||||
|
case LPP_GPS: |
||||
|
_pos += 9; break; |
||||
|
case LPP_POLYLINE: |
||||
|
_pos += 8; break; // TODO: this is MINIMIUM
|
||||
|
case LPP_GYROMETER: |
||||
|
case LPP_ACCELEROMETER: |
||||
|
_pos += 6; break; |
||||
|
case LPP_GENERIC_SENSOR: |
||||
|
case LPP_FREQUENCY: |
||||
|
case LPP_DISTANCE: |
||||
|
case LPP_ENERGY: |
||||
|
case LPP_UNIXTIME: |
||||
|
_pos += 4; break; |
||||
|
case LPP_COLOUR: |
||||
|
_pos += 3; break; |
||||
|
case LPP_ANALOG_INPUT: |
||||
|
case LPP_ANALOG_OUTPUT: |
||||
|
case LPP_LUMINOSITY: |
||||
|
case LPP_TEMPERATURE: |
||||
|
case LPP_CONCENTRATION: |
||||
|
case LPP_BAROMETRIC_PRESSURE: |
||||
|
case LPP_ALTITUDE: |
||||
|
case LPP_VOLTAGE: |
||||
|
case LPP_CURRENT: |
||||
|
case LPP_DIRECTION: |
||||
|
case LPP_POWER: |
||||
|
_pos += 2; break; |
||||
|
default: |
||||
|
_pos++; |
||||
|
} |
||||
|
} |
||||
|
}; |
||||
|
|
||||
|
class LPPWriter { |
||||
|
uint8_t* _buf; |
||||
|
uint8_t _max_len; |
||||
|
uint8_t _len; |
||||
|
|
||||
|
void write(uint16_t value) { |
||||
|
_buf[_len++] = (value >> 8) & 0xFF; // MSB
|
||||
|
_buf[_len++] = value & 0xFF; // LSB
|
||||
|
} |
||||
|
|
||||
|
public: |
||||
|
LPPWriter(uint8_t buf[], uint8_t max_len): _buf(buf), _max_len(max_len), _len(0) { } |
||||
|
|
||||
|
bool writeVoltage(uint8_t channel, float voltage) { |
||||
|
if (_len + 4 <= _max_len) { |
||||
|
_buf[_len++] = channel; |
||||
|
_buf[_len++] = LPP_VOLTAGE; |
||||
|
uint16_t value = voltage * 100; |
||||
|
write(value); |
||||
|
return true; |
||||
|
} |
||||
|
return false; |
||||
|
} |
||||
|
|
||||
|
bool writeGPS(uint8_t channel, float lat, float lon, float alt) { |
||||
|
if (_len + 11 <= _max_len) { |
||||
|
_buf[_len++] = channel; |
||||
|
_buf[_len++] = LPP_GPS; |
||||
|
|
||||
|
int32_t lati = lat * 10000; // we lose some precision :-(
|
||||
|
int32_t loni = lon * 10000; |
||||
|
int32_t alti = alt * 100; |
||||
|
|
||||
|
_buf[_len++] = lati >> 16; |
||||
|
_buf[_len++] = lati >> 8; |
||||
|
_buf[_len++] = lati; |
||||
|
_buf[_len++] = loni >> 16; |
||||
|
_buf[_len++] = loni >> 8; |
||||
|
_buf[_len++] = loni; |
||||
|
_buf[_len++] = alti >> 16; |
||||
|
_buf[_len++] = alti >> 8; |
||||
|
_buf[_len++] = alti; |
||||
|
return true; |
||||
|
} |
||||
|
return false; |
||||
|
} |
||||
|
|
||||
|
uint8_t length() { return _len; } |
||||
|
}; |
||||
Loading…
Reference in new issue