Factory firmware for the MultiTech Dotbox (MTDOT-BOX) and EVB (MTDOT-EVB) products.
Dependencies: NCP5623B GpsParser ISL29011 libmDot-mbed5 MTS-Serial MMA845x DOGS102 MPL3115A2
MTDOT-BOX/EVB Firmware Description
This Firmware is what ships on DotBox and EVB devices. It is intended to be used as a proof of concept and site survey tool for planning LoRa deployments. The firmware provides a number of different modes of operation:
- Configuration - Use AT commands to configure network credentials, TX power, TX data rate, view the survey data file, etc.
- Survey Single - Test network connectivity at current location at a specific TX power and TX data rate. Uplink information, downlink information, and GPS information are saved to the survey data file and can also be sent to the gateway.
- Survey Sweep - Test network connectivity at current location across a range of TX powers and TX data rates. Uplink information, downlink information, and GPS information for each survey in the sweep are saved to the survey data file and can also be sent to the gateway.
- LoRa Demo - Gather data from onboard sensors and display it on the screen in real time. Send packets containing sensor data to the gateway either on an interval or when triggered by the user. GPS data is not transmitted.
- Survey GPS - Gather sensor and GPS data and transmit it to the gateway either on an interval or when triggered by the user. Add padding to packets, switch frequency sub bands, TX power, TX data rate, and more all without exiting Survey GPS Mode.
- View Data - View the survey data file on the screen one survey at a time.
Additional documentation and information for the MTDOT-BOX/EVB Factory Firmware can be found here.
Dot Libraries
Dot Library Limitations
The commit messages in libmDot-mbed5 and libmDot-dev-mbed5 specify the version of the Dot library the commit contains and the version of mbed-os it was compiled against. We recommend building your application with the version of mbed-os specified in the commit message of the version of the Dot library you're using. This will ensure that you don't run into any runtime issues caused by differences in the mbed-os versions.
Development library for mDot.
[Repository '/teams/MultiTech/code/libmDot-dev-mbed5/' not found]
Stable library for mDot.
Import librarylibmDot-mbed5
Stable version of the mDot library for mbed 5. This version of the library is suitable for deployment scenarios. See lastest commit message for version of mbed-os library that has been tested against.
Mode/Mode.cpp@7:a31236c2e75c, 2016-11-04 (annotated)
- Committer:
- Mike Fiore
- Date:
- Fri Nov 04 17:27:05 2016 -0500
- Revision:
- 7:a31236c2e75c
- Parent:
- 1:71125aa00e33
- Child:
- 12:05435282f899
update from git revision 2.1.2
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Mike Fiore |
1:71125aa00e33 | 1 | /* Copyright (c) <2016> <MultiTech Systems>, MIT License |
Mike Fiore |
1:71125aa00e33 | 2 | * |
Mike Fiore |
1:71125aa00e33 | 3 | * Permission is hereby granted, free of charge, to any person obtaining a copy of this software |
Mike Fiore |
1:71125aa00e33 | 4 | * and associated documentation files (the "Software"), to deal in the Software without restriction, |
Mike Fiore |
1:71125aa00e33 | 5 | * including without limitation the rights to use, copy, modify, merge, publish, distribute, |
Mike Fiore |
1:71125aa00e33 | 6 | * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is |
Mike Fiore |
1:71125aa00e33 | 7 | * furnished to do so, subject to the following conditions: |
Mike Fiore |
1:71125aa00e33 | 8 | * |
Mike Fiore |
1:71125aa00e33 | 9 | * The above copyright notice and this permission notice shall be included in all copies or |
Mike Fiore |
1:71125aa00e33 | 10 | * substantial portions of the Software. |
Mike Fiore |
1:71125aa00e33 | 11 | * |
Mike Fiore |
1:71125aa00e33 | 12 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING |
Mike Fiore |
1:71125aa00e33 | 13 | * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
Mike Fiore |
1:71125aa00e33 | 14 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, |
Mike Fiore |
1:71125aa00e33 | 15 | * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
Mike Fiore |
1:71125aa00e33 | 16 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
Mike Fiore |
1:71125aa00e33 | 17 | */ |
Mike Fiore |
1:71125aa00e33 | 18 | |
Mike Fiore |
1:71125aa00e33 | 19 | #include "Mode.h" |
Mike Fiore |
1:71125aa00e33 | 20 | #include "MTSLog.h" |
Mike Fiore |
1:71125aa00e33 | 21 | |
Mike Fiore |
1:71125aa00e33 | 22 | /* |
Mike Fiore |
1:71125aa00e33 | 23 | * union for converting from 32-bit to 4 8-bit values |
Mike Fiore |
1:71125aa00e33 | 24 | */ |
Mike Fiore |
1:71125aa00e33 | 25 | union convert32 { |
Mike Fiore |
1:71125aa00e33 | 26 | int32_t f_s; // convert from signed 32 bit int |
Mike Fiore |
1:71125aa00e33 | 27 | uint32_t f_u; // convert from unsigned 32 bit int |
Mike Fiore |
1:71125aa00e33 | 28 | uint8_t t_u[4]; // convert to 8 bit unsigned array |
Mike Fiore |
1:71125aa00e33 | 29 | }convertL; |
Mike Fiore |
1:71125aa00e33 | 30 | |
Mike Fiore |
1:71125aa00e33 | 31 | /* |
Mike Fiore |
1:71125aa00e33 | 32 | * union for converting from 16- bit to 2 8-bit values |
Mike Fiore |
1:71125aa00e33 | 33 | */ |
Mike Fiore |
1:71125aa00e33 | 34 | union convert16 { |
Mike Fiore |
1:71125aa00e33 | 35 | int16_t f_s; // convert from signed 16 bit int |
Mike Fiore |
1:71125aa00e33 | 36 | uint16_t f_u; // convert from unsigned 16 bit int |
Mike Fiore |
1:71125aa00e33 | 37 | uint8_t t_u[2]; // convert to 8 bit unsigned array |
Mike Fiore |
1:71125aa00e33 | 38 | } convertS; |
Mike Fiore |
1:71125aa00e33 | 39 | |
Mike Fiore |
1:71125aa00e33 | 40 | |
Mike Fiore |
1:71125aa00e33 | 41 | Mode::Mode(DOGS102* lcd, ButtonHandler* buttons, mDot* dot, LoRaHandler* lora, GPSPARSER* gps, SensorHandler* sensors) |
Mike Fiore |
1:71125aa00e33 | 42 | : _lcd(lcd), |
Mike Fiore |
1:71125aa00e33 | 43 | _buttons(buttons), |
Mike Fiore |
1:71125aa00e33 | 44 | _dot(dot), |
Mike Fiore |
1:71125aa00e33 | 45 | _lora(lora), |
Mike Fiore |
1:71125aa00e33 | 46 | _gps(gps), |
Mike Fiore |
1:71125aa00e33 | 47 | _sensors(sensors), |
Mike Fiore |
1:71125aa00e33 | 48 | _main_id(Thread::gettid()), |
Mike Fiore |
1:71125aa00e33 | 49 | _index(0), |
Mike Fiore |
1:71125aa00e33 | 50 | _band(_dot->getFrequencyBand()), |
Mike Fiore |
1:71125aa00e33 | 51 | _sub_band(_dot->getFrequencySubBand()), |
Mike Fiore |
7:a31236c2e75c | 52 | _data_rate(mDot::DR0), |
Mike Fiore |
1:71125aa00e33 | 53 | _power(2), |
Mike Fiore |
1:71125aa00e33 | 54 | _next_tx(0), |
Mike Fiore |
1:71125aa00e33 | 55 | _send_data(false), |
Mike Fiore |
1:71125aa00e33 | 56 | _gps_available(_gps->gpsDetected()) |
Mike Fiore |
1:71125aa00e33 | 57 | {} |
Mike Fiore |
1:71125aa00e33 | 58 | |
Mike Fiore |
1:71125aa00e33 | 59 | Mode::~Mode() {} |
Mike Fiore |
1:71125aa00e33 | 60 | |
Mike Fiore |
1:71125aa00e33 | 61 | bool Mode::deleteDataFile() { |
Mike Fiore |
1:71125aa00e33 | 62 | bool ret = true; |
Mike Fiore |
1:71125aa00e33 | 63 | |
Mike Fiore |
1:71125aa00e33 | 64 | // if survey data file exists, attempt to delete it |
Mike Fiore |
1:71125aa00e33 | 65 | std::vector<mDot::mdot_file> files = _dot->listUserFiles(); |
Mike Fiore |
1:71125aa00e33 | 66 | for (std::vector<mDot::mdot_file>::iterator it = files.begin(); it != files.end(); it++) |
Mike Fiore |
1:71125aa00e33 | 67 | if (it->name == file_name) { |
Mike Fiore |
1:71125aa00e33 | 68 | if (! _dot->deleteUserFile(file_name)) |
Mike Fiore |
1:71125aa00e33 | 69 | ret = false; |
Mike Fiore |
1:71125aa00e33 | 70 | break; |
Mike Fiore |
1:71125aa00e33 | 71 | } |
Mike Fiore |
1:71125aa00e33 | 72 | |
Mike Fiore |
1:71125aa00e33 | 73 | return ret; |
Mike Fiore |
1:71125aa00e33 | 74 | } |
Mike Fiore |
1:71125aa00e33 | 75 | |
Mike Fiore |
1:71125aa00e33 | 76 | // ID, Status, Lock, Lat, Long, Alt, Time, RSSIup, SNRup, RSSIdown, SNRdown, DataRate, Power |
Mike Fiore |
1:71125aa00e33 | 77 | bool Mode::appendDataFile(const DataItem& data) { |
Mike Fiore |
1:71125aa00e33 | 78 | char main_buf[256]; |
Mike Fiore |
1:71125aa00e33 | 79 | char id_buf[16]; |
Mike Fiore |
1:71125aa00e33 | 80 | char lat_buf[32]; |
Mike Fiore |
1:71125aa00e33 | 81 | char lon_buf[32]; |
Mike Fiore |
1:71125aa00e33 | 82 | char alt_buf[16]; |
Mike Fiore |
1:71125aa00e33 | 83 | char time_buf[32]; |
Mike Fiore |
1:71125aa00e33 | 84 | char stats_buf[32]; |
Mike Fiore |
1:71125aa00e33 | 85 | size_t size; |
Mike Fiore |
1:71125aa00e33 | 86 | |
Mike Fiore |
1:71125aa00e33 | 87 | snprintf(id_buf, sizeof(id_buf), "%c%ld", (data.type == single) ? 'L' : 'S', data.index); |
Mike Fiore |
1:71125aa00e33 | 88 | |
Mike Fiore |
1:71125aa00e33 | 89 | // if we had GPS lock, format GPS data |
Mike Fiore |
1:71125aa00e33 | 90 | if (data.gps_lock) { |
Mike Fiore |
1:71125aa00e33 | 91 | snprintf(lat_buf, sizeof(lat_buf), "%d %d %d.%03d %c", |
Mike Fiore |
1:71125aa00e33 | 92 | abs(data.gps_latitude.degrees), |
Mike Fiore |
1:71125aa00e33 | 93 | data.gps_latitude.minutes, |
Mike Fiore |
1:71125aa00e33 | 94 | (data.gps_latitude.seconds * 6) / 1000, |
Mike Fiore |
1:71125aa00e33 | 95 | (data.gps_latitude.seconds * 6) % 1000, |
Mike Fiore |
1:71125aa00e33 | 96 | (data.gps_latitude.degrees > 0) ? 'N' : 'S'); |
Mike Fiore |
1:71125aa00e33 | 97 | snprintf(lon_buf, sizeof(lon_buf), "%d %d %d.%03d %c", |
Mike Fiore |
1:71125aa00e33 | 98 | abs(data.gps_longitude.degrees), |
Mike Fiore |
1:71125aa00e33 | 99 | data.gps_longitude.minutes, |
Mike Fiore |
1:71125aa00e33 | 100 | (data.gps_longitude.seconds * 6) / 1000, |
Mike Fiore |
1:71125aa00e33 | 101 | (data.gps_longitude.seconds * 6) % 1000, |
Mike Fiore |
1:71125aa00e33 | 102 | (data.gps_longitude.degrees > 0) ? 'E' : 'W'); |
Mike Fiore |
1:71125aa00e33 | 103 | snprintf(alt_buf, sizeof(alt_buf), "%d", |
Mike Fiore |
1:71125aa00e33 | 104 | data.gps_altitude); |
Mike Fiore |
1:71125aa00e33 | 105 | snprintf(time_buf, sizeof(time_buf), "%02d:%02d:%02d %02d/%02d/%04d", |
Mike Fiore |
1:71125aa00e33 | 106 | data.gps_time.tm_hour, |
Mike Fiore |
1:71125aa00e33 | 107 | data.gps_time.tm_min, |
Mike Fiore |
1:71125aa00e33 | 108 | data.gps_time.tm_sec, |
Mike Fiore |
1:71125aa00e33 | 109 | data.gps_time.tm_mon + 1, |
Mike Fiore |
1:71125aa00e33 | 110 | data.gps_time.tm_mday, |
Mike Fiore |
1:71125aa00e33 | 111 | data.gps_time.tm_year + 1900); |
Mike Fiore |
1:71125aa00e33 | 112 | } |
Mike Fiore |
1:71125aa00e33 | 113 | |
Mike Fiore |
1:71125aa00e33 | 114 | if (data.status) { |
Mike Fiore |
1:71125aa00e33 | 115 | float down_snr = (float)data.link.down.snr / 10.0; |
Mike Fiore |
1:71125aa00e33 | 116 | snprintf(stats_buf, sizeof(stats_buf), "%lu,%ld,%d,%2.1f", |
Mike Fiore |
1:71125aa00e33 | 117 | data.link.up.gateways, |
Mike Fiore |
1:71125aa00e33 | 118 | data.link.up.dBm, |
Mike Fiore |
1:71125aa00e33 | 119 | abs(data.link.down.rssi), |
Mike Fiore |
1:71125aa00e33 | 120 | down_snr); |
Mike Fiore |
1:71125aa00e33 | 121 | } |
Mike Fiore |
1:71125aa00e33 | 122 | |
Mike Fiore |
1:71125aa00e33 | 123 | size = snprintf(main_buf, sizeof(main_buf), "%s,%c,%ld,%s,%s,%s,%s,%s,%s,%lu\n", |
Mike Fiore |
1:71125aa00e33 | 124 | id_buf, |
Mike Fiore |
1:71125aa00e33 | 125 | data.status ? 'S' : 'F', |
Mike Fiore |
1:71125aa00e33 | 126 | data.gps_lock ? data.gps_sats : 0, |
Mike Fiore |
1:71125aa00e33 | 127 | (data.gps_lock) ? lat_buf : "", |
Mike Fiore |
1:71125aa00e33 | 128 | (data.gps_lock) ? lon_buf : "", |
Mike Fiore |
1:71125aa00e33 | 129 | (data.gps_lock) ? alt_buf : "", |
Mike Fiore |
1:71125aa00e33 | 130 | (data.gps_lock) ? time_buf : "", |
Mike Fiore |
1:71125aa00e33 | 131 | data.status ? stats_buf : ",,,", |
Mike Fiore |
7:a31236c2e75c | 132 | _dot->DataRateStr(data.data_rate).substr(2).c_str(), |
Mike Fiore |
1:71125aa00e33 | 133 | data.power); |
Mike Fiore |
1:71125aa00e33 | 134 | |
Mike Fiore |
1:71125aa00e33 | 135 | if (size < 0) { |
Mike Fiore |
1:71125aa00e33 | 136 | logError("failed to format survey data"); |
Mike Fiore |
1:71125aa00e33 | 137 | return false; |
Mike Fiore |
1:71125aa00e33 | 138 | } |
Mike Fiore |
1:71125aa00e33 | 139 | |
Mike Fiore |
1:71125aa00e33 | 140 | if (! _dot->appendUserFile(file_name, (void*)main_buf, size)) { |
Mike Fiore |
1:71125aa00e33 | 141 | logError("failed to write survey data to file"); |
Mike Fiore |
1:71125aa00e33 | 142 | return false; |
Mike Fiore |
1:71125aa00e33 | 143 | } else { |
Mike Fiore |
1:71125aa00e33 | 144 | logInfo("successfully wrote survey data to file\r\n\t%s", main_buf); |
Mike Fiore |
1:71125aa00e33 | 145 | } |
Mike Fiore |
1:71125aa00e33 | 146 | |
Mike Fiore |
1:71125aa00e33 | 147 | return true; |
Mike Fiore |
1:71125aa00e33 | 148 | } |
Mike Fiore |
1:71125aa00e33 | 149 | |
Mike Fiore |
1:71125aa00e33 | 150 | void Mode::updateData(DataItem& data, DataType type, bool status) { |
Mike Fiore |
1:71125aa00e33 | 151 | data.type = type; |
Mike Fiore |
1:71125aa00e33 | 152 | data.index = _index; |
Mike Fiore |
1:71125aa00e33 | 153 | data.status = status; |
Mike Fiore |
1:71125aa00e33 | 154 | data.gps_lock = _gps->getLockStatus(); |
Mike Fiore |
1:71125aa00e33 | 155 | data.gps_sats = _gps->getNumSatellites(); |
Mike Fiore |
1:71125aa00e33 | 156 | data.gps_longitude = _gps->getLongitude(); |
Mike Fiore |
1:71125aa00e33 | 157 | data.gps_latitude = _gps->getLatitude(); |
Mike Fiore |
1:71125aa00e33 | 158 | data.gps_altitude = _gps->getAltitude(); |
Mike Fiore |
1:71125aa00e33 | 159 | data.gps_time = _gps->getTimestamp(); |
Mike Fiore |
1:71125aa00e33 | 160 | data.link = _link_check_result; |
Mike Fiore |
1:71125aa00e33 | 161 | data.data_rate = _data_rate; |
Mike Fiore |
1:71125aa00e33 | 162 | data.power = _power; |
Mike Fiore |
1:71125aa00e33 | 163 | } |
Mike Fiore |
1:71125aa00e33 | 164 | |
Mike Fiore |
1:71125aa00e33 | 165 | void Mode::updateSensorData(SensorItem& data) { |
Mike Fiore |
1:71125aa00e33 | 166 | data.accel_data = _sensors->getAcceleration(); |
Mike Fiore |
1:71125aa00e33 | 167 | data.baro_data = _sensors->getBarometer(); |
Mike Fiore |
1:71125aa00e33 | 168 | data.lux_data_raw = _sensors->getLightRaw(); |
Mike Fiore |
1:71125aa00e33 | 169 | data.pressure_raw = _sensors->getPressureRaw(); |
Mike Fiore |
1:71125aa00e33 | 170 | data.light = _sensors->getLight(); |
Mike Fiore |
1:71125aa00e33 | 171 | data.pressure = _sensors->getPressure(); |
Mike Fiore |
1:71125aa00e33 | 172 | data.altitude = _sensors->getAltitude(); |
Mike Fiore |
1:71125aa00e33 | 173 | data.temperature = _sensors->getTemp(SensorHandler::CELSIUS); |
Mike Fiore |
1:71125aa00e33 | 174 | } |
Mike Fiore |
1:71125aa00e33 | 175 | |
Mike Fiore |
1:71125aa00e33 | 176 | uint32_t Mode::getIndex(DataType type) { |
Mike Fiore |
1:71125aa00e33 | 177 | uint32_t index = 0; |
Mike Fiore |
1:71125aa00e33 | 178 | mDot::mdot_file file; |
Mike Fiore |
1:71125aa00e33 | 179 | size_t buf_size = 128; |
Mike Fiore |
1:71125aa00e33 | 180 | char buf[buf_size]; |
Mike Fiore |
1:71125aa00e33 | 181 | bool done = false; |
Mike Fiore |
1:71125aa00e33 | 182 | char search; |
Mike Fiore |
1:71125aa00e33 | 183 | |
Mike Fiore |
1:71125aa00e33 | 184 | int read_offset; |
Mike Fiore |
1:71125aa00e33 | 185 | int read_size; |
Mike Fiore |
1:71125aa00e33 | 186 | int reduce = buf_size - 32; |
Mike Fiore |
1:71125aa00e33 | 187 | int bytes_read; |
Mike Fiore |
1:71125aa00e33 | 188 | int ret; |
Mike Fiore |
1:71125aa00e33 | 189 | int current; |
Mike Fiore |
1:71125aa00e33 | 190 | |
Mike Fiore |
1:71125aa00e33 | 191 | if (type == single) |
Mike Fiore |
1:71125aa00e33 | 192 | search = 'L'; |
Mike Fiore |
1:71125aa00e33 | 193 | else |
Mike Fiore |
1:71125aa00e33 | 194 | search = 'S'; |
Mike Fiore |
1:71125aa00e33 | 195 | |
Mike Fiore |
1:71125aa00e33 | 196 | file = _dot->openUserFile(file_name, mDot::FM_RDONLY); |
Mike Fiore |
1:71125aa00e33 | 197 | if (file.fd < 0) { |
Mike Fiore |
1:71125aa00e33 | 198 | logError("failed to open survey data file"); |
Mike Fiore |
1:71125aa00e33 | 199 | } else { |
Mike Fiore |
1:71125aa00e33 | 200 | //logInfo("file size %d", file.size); |
Mike Fiore |
1:71125aa00e33 | 201 | if (file.size > buf_size) { |
Mike Fiore |
1:71125aa00e33 | 202 | read_offset = file.size - buf_size - 1; |
Mike Fiore |
1:71125aa00e33 | 203 | read_size = buf_size; |
Mike Fiore |
1:71125aa00e33 | 204 | } else { |
Mike Fiore |
1:71125aa00e33 | 205 | read_offset = 0; |
Mike Fiore |
1:71125aa00e33 | 206 | read_size = file.size; |
Mike Fiore |
1:71125aa00e33 | 207 | } |
Mike Fiore |
1:71125aa00e33 | 208 | |
Mike Fiore |
1:71125aa00e33 | 209 | while (! done) { |
Mike Fiore |
1:71125aa00e33 | 210 | if (read_offset == 0) |
Mike Fiore |
1:71125aa00e33 | 211 | done = true; |
Mike Fiore |
1:71125aa00e33 | 212 | |
Mike Fiore |
1:71125aa00e33 | 213 | //logInfo("reading from index %d, %d bytes", read_offset, read_size); |
Mike Fiore |
1:71125aa00e33 | 214 | |
Mike Fiore |
1:71125aa00e33 | 215 | if (! _dot->seekUserFile(file, read_offset, SEEK_SET)) { |
Mike Fiore |
1:71125aa00e33 | 216 | logError("failed to seek %d/%d", read_offset, file.size); |
Mike Fiore |
1:71125aa00e33 | 217 | return 0; |
Mike Fiore |
1:71125aa00e33 | 218 | } |
Mike Fiore |
1:71125aa00e33 | 219 | memset(buf, 0, buf_size); |
Mike Fiore |
1:71125aa00e33 | 220 | ret = _dot->readUserFile(file, (void*)buf, read_size); |
Mike Fiore |
1:71125aa00e33 | 221 | if (ret != read_size) { |
Mike Fiore |
1:71125aa00e33 | 222 | logError("failed to read"); |
Mike Fiore |
1:71125aa00e33 | 223 | return 0; |
Mike Fiore |
1:71125aa00e33 | 224 | } |
Mike Fiore |
1:71125aa00e33 | 225 | //logInfo("read %d bytes [%s]", ret, buf); |
Mike Fiore |
1:71125aa00e33 | 226 | bytes_read = file.size - read_offset; |
Mike Fiore |
1:71125aa00e33 | 227 | //logInfo("read %d total bytes", bytes_read); |
Mike Fiore |
1:71125aa00e33 | 228 | |
Mike Fiore |
1:71125aa00e33 | 229 | // read_size - 1 is the last byte in the buffer |
Mike Fiore |
1:71125aa00e33 | 230 | for (current = read_size - 1; current >= 0; current--) { |
Mike Fiore |
1:71125aa00e33 | 231 | // generic case where a preceding newline exists |
Mike Fiore |
1:71125aa00e33 | 232 | if (buf[current] == '\n' && current != read_size - 1) { |
Mike Fiore |
1:71125aa00e33 | 233 | int test = current; |
Mike Fiore |
1:71125aa00e33 | 234 | //logInfo("found potential %d, %c", read_offset + current, buf[test + 1]); |
Mike Fiore |
1:71125aa00e33 | 235 | if (buf[test + 1] == search) { |
Mike Fiore |
1:71125aa00e33 | 236 | sscanf(&buf[test + 2], "%ld", &index); |
Mike Fiore |
1:71125aa00e33 | 237 | done = true; |
Mike Fiore |
1:71125aa00e33 | 238 | break; |
Mike Fiore |
1:71125aa00e33 | 239 | } |
Mike Fiore |
1:71125aa00e33 | 240 | // special case where the index we're looking for is in the first entry - no newline |
Mike Fiore |
1:71125aa00e33 | 241 | } else if (current == 0 && bytes_read >= file.size) { |
Mike Fiore |
1:71125aa00e33 | 242 | int test = current; |
Mike Fiore |
1:71125aa00e33 | 243 | //logInfo("found potential %d, %c", read_offset + current, buf[test + 1]); |
Mike Fiore |
1:71125aa00e33 | 244 | if (buf[test] == search) { |
Mike Fiore |
1:71125aa00e33 | 245 | sscanf(&buf[test + 1], "%ld", &index); |
Mike Fiore |
1:71125aa00e33 | 246 | done = true; |
Mike Fiore |
1:71125aa00e33 | 247 | break; |
Mike Fiore |
1:71125aa00e33 | 248 | } |
Mike Fiore |
1:71125aa00e33 | 249 | } |
Mike Fiore |
1:71125aa00e33 | 250 | } |
Mike Fiore |
1:71125aa00e33 | 251 | |
Mike Fiore |
1:71125aa00e33 | 252 | read_offset = (read_offset - reduce > 0) ? read_offset - reduce : 0; |
Mike Fiore |
1:71125aa00e33 | 253 | } |
Mike Fiore |
1:71125aa00e33 | 254 | _dot->closeUserFile(file); |
Mike Fiore |
1:71125aa00e33 | 255 | } |
Mike Fiore |
1:71125aa00e33 | 256 | |
Mike Fiore |
1:71125aa00e33 | 257 | logInfo("returning index %d", index); |
Mike Fiore |
1:71125aa00e33 | 258 | |
Mike Fiore |
1:71125aa00e33 | 259 | return index; |
Mike Fiore |
1:71125aa00e33 | 260 | } |
Mike Fiore |
1:71125aa00e33 | 261 | |
Mike Fiore |
1:71125aa00e33 | 262 | std::vector<uint8_t> Mode::formatSurveyData(DataItem& data) { |
Mike Fiore |
1:71125aa00e33 | 263 | std::vector<uint8_t> send_data; |
Mike Fiore |
1:71125aa00e33 | 264 | uint8_t satfix; |
Mike Fiore |
1:71125aa00e33 | 265 | |
Mike Fiore |
1:71125aa00e33 | 266 | send_data.clear(); |
Mike Fiore |
1:71125aa00e33 | 267 | send_data.push_back(0x1D); // key for start of data structure |
Mike Fiore |
1:71125aa00e33 | 268 | send_data.push_back(0x1A); // key for uplink QOS + RF Pwr |
Mike Fiore |
1:71125aa00e33 | 269 | convertS.f_s = data.link.up.gateways; |
Mike Fiore |
1:71125aa00e33 | 270 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 271 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 272 | send_data.push_back((data.link.up.dBm) & 0xFF); |
Mike Fiore |
1:71125aa00e33 | 273 | send_data.push_back(data.power); |
Mike Fiore |
1:71125aa00e33 | 274 | |
Mike Fiore |
1:71125aa00e33 | 275 | send_data.push_back(0x1B); // key for downlink QOS |
Mike Fiore |
1:71125aa00e33 | 276 | convertS.f_s=data.link.down.rssi; |
Mike Fiore |
1:71125aa00e33 | 277 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 278 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 279 | send_data.push_back((data.link.down.snr/10) & 0xFF); |
Mike Fiore |
1:71125aa00e33 | 280 | |
Mike Fiore |
1:71125aa00e33 | 281 | // collect GPS data if GPS device detected |
Mike Fiore |
7:a31236c2e75c | 282 | if (_gps->gpsDetected() && ((_data_rate != mDot::SF_10) || (_band == mDot::FB_EU868))){ |
Mike Fiore |
1:71125aa00e33 | 283 | send_data.push_back(0x19); // key for GPS Lock Status |
Mike Fiore |
1:71125aa00e33 | 284 | satfix = (_gps->getNumSatellites() << 4 ) | (_gps->getFixStatus() & 0x0F ); |
Mike Fiore |
1:71125aa00e33 | 285 | send_data.push_back(satfix); |
Mike Fiore |
1:71125aa00e33 | 286 | |
Mike Fiore |
1:71125aa00e33 | 287 | if (_gps->getLockStatus()){ // if gps has a lock |
Mike Fiore |
1:71125aa00e33 | 288 | // Send GPS data if GPS device locked |
Mike Fiore |
1:71125aa00e33 | 289 | send_data.push_back(0x15); // key for GPS Latitude |
Mike Fiore |
1:71125aa00e33 | 290 | send_data.push_back(data.gps_latitude.degrees); |
Mike Fiore |
1:71125aa00e33 | 291 | send_data.push_back(data.gps_latitude.minutes); |
Mike Fiore |
1:71125aa00e33 | 292 | convertS.f_s = data.gps_latitude.seconds; |
Mike Fiore |
1:71125aa00e33 | 293 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 294 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 295 | |
Mike Fiore |
1:71125aa00e33 | 296 | send_data.push_back(0x16); // key for GPS Longitude |
Mike Fiore |
1:71125aa00e33 | 297 | convertS.f_s = data.gps_longitude.degrees; |
Mike Fiore |
1:71125aa00e33 | 298 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 299 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 300 | |
Mike Fiore |
1:71125aa00e33 | 301 | send_data.push_back(data.gps_longitude.minutes); |
Mike Fiore |
1:71125aa00e33 | 302 | convertS.f_s = data.gps_longitude.seconds; |
Mike Fiore |
1:71125aa00e33 | 303 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 304 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 305 | } |
Mike Fiore |
1:71125aa00e33 | 306 | } |
Mike Fiore |
1:71125aa00e33 | 307 | // key for end of data structure |
Mike Fiore |
1:71125aa00e33 | 308 | send_data.push_back(0x1D); |
Mike Fiore |
1:71125aa00e33 | 309 | |
Mike Fiore |
1:71125aa00e33 | 310 | return send_data; |
Mike Fiore |
1:71125aa00e33 | 311 | } |
Mike Fiore |
1:71125aa00e33 | 312 | |
Mike Fiore |
1:71125aa00e33 | 313 | std::vector<uint8_t> Mode::formatSensorData(SensorItem& data) { |
Mike Fiore |
1:71125aa00e33 | 314 | std::vector<uint8_t> send_data; |
Mike Fiore |
1:71125aa00e33 | 315 | send_data.clear(); |
Mike Fiore |
1:71125aa00e33 | 316 | send_data.push_back(0x0E); // key for Current Acceleration 3-Axis Value |
Mike Fiore |
1:71125aa00e33 | 317 | convertS.f_s = data.accel_data._x *4; // shift data 2 bits while retaining sign |
Mike Fiore |
1:71125aa00e33 | 318 | send_data.push_back(convertS.t_u[1]); // get 8 MSB of 14 bit value |
Mike Fiore |
1:71125aa00e33 | 319 | convertS.f_s = data.accel_data._y * 4; // shift data 2 bits while retaining sign |
Mike Fiore |
1:71125aa00e33 | 320 | send_data.push_back(convertS.t_u[1]); // get 8 MSB of 14 bit value |
Mike Fiore |
1:71125aa00e33 | 321 | convertS.f_s = data.accel_data._z * 4; // shift data 2 bits while retaining sign |
Mike Fiore |
1:71125aa00e33 | 322 | send_data.push_back(convertS.t_u[1]); // get 8 MSB of 14 bit value |
Mike Fiore |
1:71125aa00e33 | 323 | send_data.push_back(0x08); // key for Current Pressure Value |
Mike Fiore |
1:71125aa00e33 | 324 | convertL.f_u = data.pressure_raw; // pressure data is 20 bits unsigned |
Mike Fiore |
1:71125aa00e33 | 325 | send_data.push_back(convertL.t_u[2]); |
Mike Fiore |
1:71125aa00e33 | 326 | send_data.push_back(convertL.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 327 | send_data.push_back(convertL.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 328 | send_data.push_back(0x05); // key for Current Ambient Light Value |
Mike Fiore |
1:71125aa00e33 | 329 | convertS.f_u = data.lux_data_raw; // data is 16 bits unsigned |
Mike Fiore |
1:71125aa00e33 | 330 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 331 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 332 | send_data.push_back(0x0B); // key for Current Temperature Value |
Mike Fiore |
1:71125aa00e33 | 333 | convertS.f_s = data.baro_data._temp; // temperature is signed 12 bit |
Mike Fiore |
1:71125aa00e33 | 334 | send_data.push_back(convertS.t_u[1]); |
Mike Fiore |
1:71125aa00e33 | 335 | send_data.push_back(convertS.t_u[0]); |
Mike Fiore |
1:71125aa00e33 | 336 | |
Mike Fiore |
1:71125aa00e33 | 337 | return send_data; |
Mike Fiore |
1:71125aa00e33 | 338 | } |
Mike Fiore |
1:71125aa00e33 | 339 |