Diff: mainDistance.cpp

Revision:

5:808964f041bf

Parent:

4:aa980c0a2775

Child:

6:5102672e8ff4

--- a/mainDistance.cpp	Fri Jan 25 02:04:18 2019 +0000
+++ b/mainDistance.cpp	Fri Jan 25 02:08:12 2019 +0000
@@ -0,0 +1,111 @@
+#include "sensor.h"
+#include "mbed.h"
+#include "msg.h"
+#include "dbg.h"
+#include "coapClient.h"
+#include <string>
+
+// https://os.mbed.com/users/Sissors/code/WakeUp/
+#include "WakeUp.h"
+
+#include "DHT11.h"
+#include "distasnceMeter.h"
+
+#define DATA_BUFFER_LEN 10
+#define BUFFER_LEN 32
+#define CHANNEL 4
+#define RX_ADDRESS 0xABCDEF08
+#define TX_ADDRESS 0xABCDEF11
+#define DATA_RATE 1000
+#define RETRANSMITS 4
+
+char postUri[] = "/dist";
+char getConfUri[] = "/conf/dist";
+
+Serial pc(USBTX, USBRX); // tx, rx
+PinName pinA = PinName(PB_3);
+PinName pinB = PinName(PA_10);
+uint8_t token[] = {2};
+CoapClient coapClient = CoapClient(token, RETRANSMITS, DATA_RATE, CHANNEL, RX_ADDRESS, TX_ADDRESS);
+InterruptIn button(USER_BUTTON);
+
+
+// change this
+DistanceMeter sensor = DistanceMeter(pinA, pinB);
+
+int config_interval = 30;
+int sense_interval = 10;
+
+int config_time_left = 0;
+int sense_time_left = 0;
+
+void check_for_new_config() {
+    uint8_t buffer[BUFFER_LEN];
+    int ret = coapClient.get(buffer, BUFFER_LEN, getConfUri);
+    if(ret > 0) {
+        uint8_t sensor_id = 0;
+        int data = -1;
+        Msg::deconstruct_data_msg(&sensor_id, &data, buffer, ret);
+        DBG("INTERVAL: %d", data);
+        sense_interval = data;
+    }
+    DBG("GET: %d", ret);
+}
+
+void collect_and_send_data() {
+    uint8_t buffer[DATA_BUFFER_LEN];
+    int data = sensor.read();
+    DBG("DATA: %d", data);
+    int sensor_id = sensor.getSensorId();
+    // TODO put sensor_id in URI, not in payload
+    Msg::construct_data_msg(sensor_id, data, buffer, DATA_BUFFER_LEN);
+    int ret = coapClient.post(buffer, DATA_BUFFER_LEN, postUri);
+    DBG("POST: %d", ret);
+}
+
+bool start = false;
+void send_packet() {
+    DBG("Start");
+    start = true;
+}
+
+
+int main() {
+    pc.baud(115200);
+    WakeUp::calibrate();
+    sensor.initialize();
+    sensor2.initialize();
+    DBG("RESTART");
+    int czas_na_spanko = 1;
+    Timer t;
+    button.rise(&send_packet);
+    while(true) {
+        while(start) {
+            if (config_time_left <= 0) {
+                check_for_new_config();
+                config_time_left = config_interval;
+            }
+            if (sense_time_left <= 0) {
+                collect_and_send_data();
+                sense_time_left = sense_interval;
+            }
+
+            czas_na_spanko = min(config_time_left, sense_time_left);
+            DBG("SPANKO: %d", czas_na_spanko);
+            if(czas_na_spanko > 0) {
+                t.stop();
+                //WakeUp::set(czas_na_spanko);
+                wait(czas_na_spanko);
+                t.reset();
+                t.start();
+                config_time_left -= czas_na_spanko;
+                sense_time_left -= czas_na_spanko;
+            } else {
+                config_time_left -= t.read_ms();
+                t.stop();
+                t.reset();
+                t.start();
+            }
+        }
+    }
+}
\ No newline at end of file