Upload new file

1 files changed, 335 insertions, 0 deletions

diff --git a/Mode/ModeSemtech.cpp b/Mode/ModeSemtech.cpp
new file mode 100644
index 0000000..e6ae52b
--- /dev/null
+++ b/Mode/ModeSemtech.cpp
@@ -0,0 +1,335 @@
+/* Copyright (c) <2016> <MultiTech Systems>, 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.
+ */
+
+#include "ModeSemtech.h"
+#include "MTSLog.h"
+#include "rtos.h"
+#include "mbed.h"
+#include <sstream>
+//this is exactly what it sounds like
+#define TWO_TO_THE_THIRTY_ONE_MINUS_ONE 2147483647
+#define PACKETSIZE 11
+
+
+
+
+ModeSemtech::ModeSemtech(DOGS102* lcd, ButtonHandler* buttons, mDot* dot, LoRaHandler* lora, GPSPARSER* gps, SensorHandler* sensors)
+    : Mode(lcd, buttons, dot, lora, gps, sensors),
+      _sem(lcd,_band),
+      _help(lcd),
+      _sem_join(lcd,_band)
+{}
+
+string ModeSemtech::intToString(int num)
+{
+    return static_cast<ostringstream*>(&(ostringstream() << num))->str();
+}
+
+void ModeSemtech::init()
+{
+    //resets all parameters when re-entering mode 
+    _interval = 5;
+    _padding = 0;
+    _power = 20;
+    _band = _dot->getFrequencyBand(); 
+    _parameter = POWER;
+    _drAll=false;
+    _link_check = false;
+    _GPS = false;
+    _sub_band = _dot->getFrequencySubBand();
+    _data_rate = mDot::DR4;
+    _max_padding = _dot->getMaxPacketLength()-PACKETSIZE;
+    _Sw2 = "Power";
+    _Sw1 = intToString(_power);
+    _help.display();
+    osDelay(2000);
+    if(_band==mDot::FB_868){
+         _sem.display(_link_check, _snr, _rssi, _power, _sub_band, _padding, _data_rate);
+         _state = PARAMETERS;
+         }
+    else { _state = BAND_CHANGE;
+          changeBand();
+         }
+    _send_timer.start();
+}
+
+void ModeSemtech::drIncrement()
+{
+    _data_rate++;
+    if (_data_rate > mDot::DR5) {
+        _drAll = true;
+        _data_rate=0;
+    }
+    _dot->setTxDataRate(_data_rate);
+    logInfo("new data rate %s, POWER %lu", mDot::DataRateStr(_data_rate).c_str(), _power);
+    _max_padding = _dot->getMaxPacketLength()-PACKETSIZE;
+}
+
+void ModeSemtech::changeDataRate()
+{
+    if(_drAll) {
+       if(_band == mDot::FB_868) _data_rate = -1;
+       else _data_rate = mDot::DR1;
+        _drAll = false;
+    }
+    drIncrement();
+}
+
+void ModeSemtech::changeParameter()
+{
+    _parameter++;
+    if(_band==mDot::FB_868&&_parameter==FSB)_parameter++;
+    if(_parameter>INTERVAL)_parameter=0;
+    switch(_parameter) {
+        case DATA_RATE:
+            _Sw2 = "Data Rate";
+            _Sw1 = intToString(_data_rate);
+            if(_drAll)_Sw1 = "All";
+            break;
+        case FSB:
+            _Sw2 = "FSB";
+            _Sw1 = intToString(_sub_band);
+            break;
+        case PADDING:
+            _Sw2 = "Padding";
+            _Sw1 = intToString(_padding);
+            break;
+        case POWER:
+            _Sw2 = "Power";
+            _Sw1 = intToString(_power);
+            break;
+        case INTERVAL:
+            _Sw2 = "Interval";
+            _Sw1 = intToString(_interval);
+            break;
+        default:
+            break;
+    }
+}
+
+void ModeSemtech::editParameter()
+{
+    switch(_parameter) {
+        case POWER:
+            if(_power<20)_power+=3;
+            else _power = 2;
+            _Sw1 = intToString(_power);
+            _dot->setTxPower(_power);
+            break;
+            
+        case DATA_RATE:
+            changeDataRate();
+            _Sw1 = intToString(_data_rate);
+            if(_drAll)_Sw1="All";
+            break;
+
+        case FSB:
+            _send_timer.stop();
+            _send_timer.reset();
+            _state = BAND_CHANGE;
+            _dot->resetNetworkSession();
+            _lora->resetActivityLed();
+            changeBand();
+            break;
+
+        case PADDING:
+            if(_padding<_max_padding)_padding +=10 - (_padding%10);
+            else _padding = 0;
+            if(_padding>_max_padding)_padding = _max_padding;
+            _Sw1 = intToString(_padding);
+            break;
+
+        default:
+            if(_interval<60)_interval += 5;
+            else _interval = 5;
+            _Sw1 = intToString(_interval);
+            break;
+    }
+}
+
+void ModeSemtech::formatData()
+{
+    _send_data.clear();
+    uint32_t lat = 0;
+    uint32_t lng = 0;
+    _temp_C+=0.5;
+
+    if(_GPS) {
+        if(_latitude.degrees<0)  lat = ~(int)((_latitude.degrees - ((double)_latitude.minutes/60.0) - ((double)_latitude.seconds/600000.0))*((double)-TWO_TO_THE_THIRTY_ONE_MINUS_ONE/90.0)+1.5);
+        else                     lat =  (int)((_latitude.degrees + ((double)_latitude.minutes/60.0) + ((double)_latitude.seconds/600000.0))*((double)TWO_TO_THE_THIRTY_ONE_MINUS_ONE/90.0)+0.5);
+        if(_longitude.degrees<0) lng = ~(int)((_longitude.degrees - ((double)_longitude.minutes/60.0) - ((double)_longitude.seconds/600000.0))*((double)-TWO_TO_THE_THIRTY_ONE_MINUS_ONE/180.0)+1.5);
+        else                     lng =  (int)((_longitude.degrees + ((double)_longitude.minutes/60.0) + ((double)_longitude.seconds/600000.0))*((double)TWO_TO_THE_THIRTY_ONE_MINUS_ONE/180.0)+0.5);
+    }
+    _send_data.push_back(0);
+    _send_data.push_back((int8_t) _temp_C);
+    _send_data.push_back(0);
+    for(int i=24; i>=0; i-=8)_send_data.push_back((lat>>i)&0xFF);
+    for(int i=24; i>=0; i-=8)_send_data.push_back((lng>>i)&0xFF);
+    for(int i=0; i<(_padding>_max_padding ? _max_padding : _padding); i++) _send_data.push_back(0);
+}
+
+void ModeSemtech::setBand()
+{
+    _sub_band++;
+    if(_sub_band > mDot::FSB_8) _sub_band = mDot::FSB_ALL;
+    _dot->setFrequencySubBand(_sub_band);
+}
+
+void ModeSemtech::changeBand()
+{
+    _sem_join.display();
+    _sem_join.updatePower(_power);
+    _sem_join.updateFsb(_sub_band);
+    _sem_join.updateId(_dot->getNetworkName());
+    _sem_join.updateRate(intToString(_data_rate));
+    _sem_join.updateKey(_dot->getNetworkPassphrase());
+}
+
+void ModeSemtech::updateScreen()
+{
+    _temp_C = _sensors->getTemp(SensorHandler::CELSIUS);
+    if(_gps->getLockStatus()&& _gps_available) {
+        _GPS = true;
+        _latitude = _gps->getLatitude();
+        _longitude = _gps->getLongitude();
+        _time = _gps->getTimestamp();
+    } else _GPS = false;
+    _sem.updateStats( _GPS, _longitude, _latitude, _time, _temp_C);
+    _sem.updateSw1(_Sw1,_Sw2,_data_rate,_power,_padding);
+    _sem.updateSw2(_Sw2);
+}
+
+void ModeSemtech::send()
+{   
+    _state = SENDING;
+    _send_timer.stop();
+    if(_band==mDot::FB_868) {
+        while(_dot->getNextTxMs()>0) {
+            _sem.updateNextCh((int)(_dot->getNextTxMs()/1000));
+            osDelay(250);
+        }
+    }
+    formatData();
+    _sem.sending();
+    _send_timer.reset();
+    _send_timer.start();
+    _lora->send(_send_data);
+    osDelay(500);
+}
+
+bool ModeSemtech::start()
+{
+    init();
+    _button_timer.start();
+    ButtonHandler::ButtonEvent be;
+    osSignalClear(_main_id, buttonSignal | loraSignal);
+    if(_band==mDot::FB_915)_join = new ModeJoin(_lcd, _buttons, _dot, _lora, _gps, _sensors);
+    
+    while (true) {
+        if(_state==PARAMETERS)updateScreen();
+
+        osEvent e = Thread::signal_wait(0, 250);
+        if (e.status == osEventSignal) {
+            if (e.value.signals & buttonSignal) {
+                _button_timer.reset();
+                be = _buttons->getButtonEvent();
+
+                switch(be) {
+                    case ButtonHandler::sw1_press:
+                        switch(_state) {
+                            case BAND_CHANGE:
+                                setBand();
+                                changeBand();
+                                break;
+
+                            case SENDING:
+                                break;
+
+                            case PARAMETERS:
+                                editParameter();
+                                break;
+                        }
+                        break;
+                    case ButtonHandler::sw2_press:
+                        switch(_state) {
+                            case BAND_CHANGE:
+                                if(_join->start()){
+                                    _state = PARAMETERS;
+                                    _send_timer.start();
+                                    _sem.display(_link_check, _snr, _rssi, _power, _sub_band, _padding, DATA_RATE);
+                                    _dot->setTxDataRate(_data_rate);
+                                } else changeBand();
+                                break;
+
+                            case SENDING:
+                                break;
+
+                            case PARAMETERS:
+                                changeParameter();
+                                break;
+                        }
+                        break;
+                    case ButtonHandler::sw1_hold:
+                        _send_timer.stop();
+                        _send_timer.reset();
+                        return true;
+
+                    default:
+                        break;
+                }
+
+            }
+        }
+        if (e.value.signals & loraSignal) {
+            _ls = _lora->getStatus();
+            switch (_ls) {
+
+                case LoRaHandler::send_success:
+                    _sem.sendResult("Send Sucess!");
+                    _link_check = true;
+                    _snr = _dot->getSnrStats();
+                    _rssi = _dot->getRssiStats();
+                    osDelay(500);
+                    _button_timer.reset();
+                    _state = PARAMETERS;
+                    _sem.display(_link_check, _snr, _rssi, _power, _sub_band, _padding, _data_rate);
+                    if(_drAll)drIncrement();
+                    break;
+
+                case LoRaHandler::send_failure:
+                    _sem.sendResult("Send Failed.");
+                    _link_check = false;
+                    osDelay(500);
+                    _button_timer.reset();
+                    _state = PARAMETERS;
+                    _sem.display(_link_check, _snr, _rssi, _power, _sub_band, _padding, _data_rate);
+                    if(_drAll)drIncrement();
+                    break;
+
+                default:
+                    break;
+            }
+       
+        }
+
+        if(_send_timer.read_ms()>_interval*1000&&_button_timer.read_ms()>3000) send();
+
+    }
+}
+
+