Koyo Takenoshita / EEAB-P1

library for enebular edge agent board(version p1)

Dependents:   ina-hack-2nd

Eeabp1.cpp@3:f80f2838a956, 2017-10-22 (annotated)

Committer:
koyo_take
Date:
Sun Oct 22 03:56:20 2017 +0000
Revision:
3:f80f2838a956
Parent:
2:d48fcae8b5bd 
resolve LoRa port number conflit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
koyo_take 0:c6b2a8ace823 1 #include "Eeabp1.h"
koyo_take 2:d48fcae8b5bd 2 #include <string.h>
koyo_take 0:c6b2a8ace823 3
koyo_take 0:c6b2a8ace823 4 static const int lora_msg_max_len = 11;
koyo_take 0:c6b2a8ace823 5
koyo_take 0:c6b2a8ace823 6 Eeabp1::Eeabp1() : pwr_en(P0_0), led(P0_23),
koyo_take 0:c6b2a8ace823 7 lora_power(P0_5), lora_reset(P0_22), grove_power(P0_6),
koyo_take 0:c6b2a8ace823 8 grv_sel2a(P0_19), grv_sel2g(P0_18), grv_sel1a(P0_17), grv_sel1g(P0_16),
koyo_take 0:c6b2a8ace823 9 grv_p1s1a(P0_2), grv_p1s2a(P0_1),
koyo_take 0:c6b2a8ace823 10 grv_p2s1a(P0_4), grv_p2s2a(P0_3)
koyo_take 0:c6b2a8ace823 11 {
koyo_take 0:c6b2a8ace823 12 this->led_state = LED_OFF;
koyo_take 0:c6b2a8ace823 13 this->led = 0;
koyo_take 0:c6b2a8ace823 14 this->serial = new RawSerial(P0_9, P0_11);
koyo_take 0:c6b2a8ace823 15 this->serial->baud(9600); /* use for LoRa */
koyo_take 0:c6b2a8ace823 16 this->pwr_en = 1; // メイン電源投入
koyo_take 0:c6b2a8ace823 17 this->lora_power = 0;
koyo_take 0:c6b2a8ace823 18 this->lora_reset = 0;
koyo_take 0:c6b2a8ace823 19 this->grove_power = 0;
koyo_take 0:c6b2a8ace823 20 this->lora_enabled = false;
koyo_take 0:c6b2a8ace823 21 this->grove_enabled = false;
koyo_take 0:c6b2a8ace823 22 // Grove端子をHiZに
koyo_take 0:c6b2a8ace823 23 this->grv_sel1g = 1;
koyo_take 0:c6b2a8ace823 24 this->grv_sel1a = 1;
koyo_take 0:c6b2a8ace823 25 this->grv_sel2g = 1;
koyo_take 0:c6b2a8ace823 26 this->grv_sel2a = 1;
koyo_take 0:c6b2a8ace823 27 grv_p1s1do = NULL, grv_p1s2do = NULL, grv_p1s1di = NULL, grv_p1s2di = NULL;
koyo_take 0:c6b2a8ace823 28 grv_p2s1do = NULL, grv_p2s2do = NULL, grv_p2s1di = NULL, grv_p2s2di = NULL;
koyo_take 0:c6b2a8ace823 29 temp_humid_sensor = NULL;
koyo_take 0:c6b2a8ace823 30 }
koyo_take 0:c6b2a8ace823 31
koyo_take 0:c6b2a8ace823 32 int Eeabp1::setLedState(EeabLedState state)
koyo_take 0:c6b2a8ace823 33 {
koyo_take 0:c6b2a8ace823 34 this->led_state = state;
koyo_take 0:c6b2a8ace823 35
koyo_take 0:c6b2a8ace823 36 if (this->led_state == LED_OFF) {
koyo_take 0:c6b2a8ace823 37 this->led = 0;
koyo_take 0:c6b2a8ace823 38 } else {
koyo_take 0:c6b2a8ace823 39 this->led = 1;
koyo_take 0:c6b2a8ace823 40 }
koyo_take 0:c6b2a8ace823 41
koyo_take 0:c6b2a8ace823 42 return 0;
koyo_take 0:c6b2a8ace823 43 }
koyo_take 0:c6b2a8ace823 44
koyo_take 0:c6b2a8ace823 45 void Eeabp1::loop(void)
koyo_take 0:c6b2a8ace823 46 {
koyo_take 0:c6b2a8ace823 47 switch (this->led_state) {
koyo_take 0:c6b2a8ace823 48 case LED_OFF:
koyo_take 0:c6b2a8ace823 49 /* fall through */
koyo_take 0:c6b2a8ace823 50 case LED_ON:
koyo_take 0:c6b2a8ace823 51 break;
koyo_take 0:c6b2a8ace823 52 case LED_BLINK_FAST:
koyo_take 0:c6b2a8ace823 53 case LED_BLINK_MID:
koyo_take 0:c6b2a8ace823 54 case LED_BLINK_SLOW:
koyo_take 0:c6b2a8ace823 55 this->led = !this->led;
koyo_take 0:c6b2a8ace823 56 break;
koyo_take 0:c6b2a8ace823 57 }
koyo_take 0:c6b2a8ace823 58 }
koyo_take 0:c6b2a8ace823 59
koyo_take 0:c6b2a8ace823 60 int Eeabp1::debug(const char * format, ...)
koyo_take 0:c6b2a8ace823 61 {
koyo_take 0:c6b2a8ace823 62 char tmp[80];
koyo_take 0:c6b2a8ace823 63 int ret;
koyo_take 0:c6b2a8ace823 64
koyo_take 0:c6b2a8ace823 65 std::va_list arg;
koyo_take 0:c6b2a8ace823 66 va_start(arg, format);
koyo_take 0:c6b2a8ace823 67 vsnprintf(tmp, sizeof(tmp), format, arg);
koyo_take 0:c6b2a8ace823 68 va_end(arg);
koyo_take 0:c6b2a8ace823 69
koyo_take 0:c6b2a8ace823 70 delete this->serial;
koyo_take 0:c6b2a8ace823 71 this->serial = new RawSerial(P0_8, P0_10);
koyo_take 0:c6b2a8ace823 72 ret = this->serial->puts(tmp);
koyo_take 0:c6b2a8ace823 73 delete this->serial;
koyo_take 0:c6b2a8ace823 74 this->serial = new RawSerial(P0_9, P0_11);
koyo_take 0:c6b2a8ace823 75
koyo_take 0:c6b2a8ace823 76 return ret;
koyo_take 0:c6b2a8ace823 77 }
koyo_take 0:c6b2a8ace823 78
koyo_take 2:d48fcae8b5bd 79 static char linebuf[64];
koyo_take 0:c6b2a8ace823 80 int Eeabp1::setLoRaPower(bool on)
koyo_take 0:c6b2a8ace823 81 {
koyo_take 0:c6b2a8ace823 82 int ret;
koyo_take 1:da9fd2252ed5 83 int retry;
koyo_take 1:da9fd2252ed5 84 const int retry_max = 10;
koyo_take 0:c6b2a8ace823 85
koyo_take 0:c6b2a8ace823 86 if (on) {
koyo_take 0:c6b2a8ace823 87 if (lora_enabled)
koyo_take 0:c6b2a8ace823 88 return 0; /* power is already on, do nothing */
koyo_take 0:c6b2a8ace823 89
koyo_take 0:c6b2a8ace823 90 this->lora_power= 1;
koyo_take 0:c6b2a8ace823 91 this->lora_reset = 1;
koyo_take 0:c6b2a8ace823 92 wait_us(500000);
koyo_take 0:c6b2a8ace823 93 serial->printf("mod set_echo off\r\n"); // ローカルエコー：無効
koyo_take 0:c6b2a8ace823 94 wait(1);
koyo_take 0:c6b2a8ace823 95 flushSerial();
koyo_take 2:d48fcae8b5bd 96
koyo_take 0:c6b2a8ace823 97 serial->printf("mod factory_reset\r\n"); // ファクトリーリセットを行い鍵をリフレッシュ
koyo_take 0:c6b2a8ace823 98 ret = chkSerialCharOk();
koyo_take 0:c6b2a8ace823 99 if (ret != 0)
koyo_take 0:c6b2a8ace823 100 return ret;
koyo_take 0:c6b2a8ace823 101 serial->printf("mod set_echo off\r\n"); // ローカルエコー：無効
koyo_take 0:c6b2a8ace823 102 wait(1);
koyo_take 1:da9fd2252ed5 103 for(retry=0; retry < retry_max; retry++) {
koyo_take 1:da9fd2252ed5 104 serial->printf("lorawan join otaa\r\n"); // Gatewayに接続(OTAA)
koyo_take 1:da9fd2252ed5 105 ret = chkSerialCharRes('a'); // 成功 ">> accepted" 失敗 ">> unsuccess"
koyo_take 1:da9fd2252ed5 106 if (ret == 0)
koyo_take 1:da9fd2252ed5 107 break;
koyo_take 1:da9fd2252ed5 108 wait(10);
koyo_take 1:da9fd2252ed5 109 }
koyo_take 1:da9fd2252ed5 110 if (retry == retry_max)
koyo_take 1:da9fd2252ed5 111 return __LINE__;
koyo_take 1:da9fd2252ed5 112
koyo_take 0:c6b2a8ace823 113 serial->printf("lorawan set_dr 2\r\n"); // データレートの設定(11byte)
koyo_take 0:c6b2a8ace823 114 ret = chkSerialCharOk();
koyo_take 0:c6b2a8ace823 115 if (ret != 0)
koyo_take 0:c6b2a8ace823 116 return ret;
koyo_take 0:c6b2a8ace823 117
koyo_take 0:c6b2a8ace823 118 this->lora_enabled = true;
koyo_take 0:c6b2a8ace823 119 } else { /* off */
koyo_take 0:c6b2a8ace823 120 if (!lora_enabled)
koyo_take 0:c6b2a8ace823 121 return 0; /* power is already off, do nothing */
koyo_take 0:c6b2a8ace823 122
koyo_take 0:c6b2a8ace823 123 lora_power= 0;
koyo_take 0:c6b2a8ace823 124 lora_enabled = false;
koyo_take 0:c6b2a8ace823 125 }
koyo_take 2:d48fcae8b5bd 126
koyo_take 0:c6b2a8ace823 127 return 0;
koyo_take 0:c6b2a8ace823 128 }
koyo_take 0:c6b2a8ace823 129
koyo_take 0:c6b2a8ace823 130 int Eeabp1::sendLoRaString(const char * format, ...)
koyo_take 0:c6b2a8ace823 131 {
koyo_take 0:c6b2a8ace823 132 char str[lora_msg_max_len+1] = {0x00, };
koyo_take 0:c6b2a8ace823 133 char msg[64];
koyo_take 0:c6b2a8ace823 134 char *p = msg;
koyo_take 0:c6b2a8ace823 135
koyo_take 0:c6b2a8ace823 136 std::va_list arg;
koyo_take 0:c6b2a8ace823 137 va_start(arg, format);
koyo_take 0:c6b2a8ace823 138 vsnprintf(str, sizeof(str), format, arg);
koyo_take 0:c6b2a8ace823 139 va_end(arg);
koyo_take 0:c6b2a8ace823 140
koyo_take 3:f80f2838a956 141 p += sprintf(msg, "lorawan tx ucnf %d ", getLoraPort());
koyo_take 0:c6b2a8ace823 142 for (unsigned int i = 0; i < strlen(str); i++) {
koyo_take 0:c6b2a8ace823 143 p += sprintf(p, "%02x", str[i]);
koyo_take 0:c6b2a8ace823 144 }
koyo_take 0:c6b2a8ace823 145 sprintf(p, "\r\n");
koyo_take 0:c6b2a8ace823 146
koyo_take 0:c6b2a8ace823 147 flushSerial();
koyo_take 0:c6b2a8ace823 148 serial->puts(msg);
koyo_take 0:c6b2a8ace823 149
koyo_take 0:c6b2a8ace823 150 return 0;
koyo_take 0:c6b2a8ace823 151 }
koyo_take 0:c6b2a8ace823 152
koyo_take 2:d48fcae8b5bd 153 int Eeabp1::sendLoRaStringAndReceiveResponse(char res[], const char * format, ...)
koyo_take 2:d48fcae8b5bd 154 {
koyo_take 2:d48fcae8b5bd 155 char str[lora_msg_max_len+1] = {0x00, };
koyo_take 2:d48fcae8b5bd 156 char msg[64];
koyo_take 2:d48fcae8b5bd 157 char *p = msg;
koyo_take 2:d48fcae8b5bd 158 // int count;
koyo_take 2:d48fcae8b5bd 159 char *tp;
koyo_take 2:d48fcae8b5bd 160 int ret;
koyo_take 2:d48fcae8b5bd 161
koyo_take 2:d48fcae8b5bd 162 std::va_list arg;
koyo_take 2:d48fcae8b5bd 163 va_start(arg, format);
koyo_take 2:d48fcae8b5bd 164 vsnprintf(str, sizeof(str), format, arg);
koyo_take 2:d48fcae8b5bd 165 va_end(arg);
koyo_take 2:d48fcae8b5bd 166
koyo_take 3:f80f2838a956 167 p += sprintf(msg, "lorawan tx ucnf %d ", getLoraPort());
koyo_take 2:d48fcae8b5bd 168 for (unsigned int i = 0; i < strlen(str); i++) {
koyo_take 2:d48fcae8b5bd 169 p += sprintf(p, "%02x", str[i]);
koyo_take 2:d48fcae8b5bd 170 }
koyo_take 2:d48fcae8b5bd 171 sprintf(p, "\r\n");
koyo_take 2:d48fcae8b5bd 172
koyo_take 2:d48fcae8b5bd 173 flushSerial();
koyo_take 2:d48fcae8b5bd 174 serial->puts(msg);
koyo_take 2:d48fcae8b5bd 175
koyo_take 2:d48fcae8b5bd 176 getline(linebuf, sizeof(linebuf), 10000);
koyo_take 2:d48fcae8b5bd 177 // count = getline(linebuf, sizeof(linebuf), 10000);
koyo_take 2:d48fcae8b5bd 178 // this->debug("%d '%s'\r\n", count, linebuf);
koyo_take 2:d48fcae8b5bd 179
koyo_take 2:d48fcae8b5bd 180 ret = -1;
koyo_take 2:d48fcae8b5bd 181 res[0] = '\0';
koyo_take 2:d48fcae8b5bd 182 tp = strtok(linebuf, " \r\n");
koyo_take 2:d48fcae8b5bd 183 while(tp != NULL){
koyo_take 2:d48fcae8b5bd 184 // this->debug("%s\r\n", tp);
koyo_take 2:d48fcae8b5bd 185 if (strcmp(tp, "tx_ok") == 0) {
koyo_take 2:d48fcae8b5bd 186 ret = 0;
koyo_take 2:d48fcae8b5bd 187 } else if (strcmp(tp, "err") == 0) {
koyo_take 2:d48fcae8b5bd 188 ret = -2;
koyo_take 2:d48fcae8b5bd 189 } else if (strcmp(tp, "rx") == 0) {
koyo_take 2:d48fcae8b5bd 190 // this->debug("rx found\r\n");
koyo_take 2:d48fcae8b5bd 191 tp = strtok(NULL, " \r\n");
koyo_take 2:d48fcae8b5bd 192 // this->debug("%s\r\n", tp);
koyo_take 2:d48fcae8b5bd 193 tp = strtok(NULL, " \r\n");
koyo_take 2:d48fcae8b5bd 194 // this->debug("%s\r\n", tp);
koyo_take 2:d48fcae8b5bd 195 strcpy(res, tp);
koyo_take 2:d48fcae8b5bd 196 }
koyo_take 2:d48fcae8b5bd 197 tp = strtok(NULL, " \r\n");
koyo_take 2:d48fcae8b5bd 198 }
koyo_take 2:d48fcae8b5bd 199
koyo_take 2:d48fcae8b5bd 200 return ret;
koyo_take 2:d48fcae8b5bd 201 }
koyo_take 2:d48fcae8b5bd 202
koyo_take 0:c6b2a8ace823 203 int Eeabp1::sendLoRaBinary(const char *payload, size_t len)
koyo_take 0:c6b2a8ace823 204 {
koyo_take 0:c6b2a8ace823 205 char msg[64];
koyo_take 0:c6b2a8ace823 206 char *p = msg;
koyo_take 0:c6b2a8ace823 207
koyo_take 0:c6b2a8ace823 208 if (lora_msg_max_len < len)
koyo_take 0:c6b2a8ace823 209 return -1;
koyo_take 0:c6b2a8ace823 210
koyo_take 3:f80f2838a956 211 p += sprintf(msg, "lorawan tx ucnf %d ", getLoraPort());
koyo_take 0:c6b2a8ace823 212 for (unsigned int i = 0; i < len; i++) {
koyo_take 0:c6b2a8ace823 213 p += sprintf(p, "%02x", payload[i]);
koyo_take 0:c6b2a8ace823 214 }
koyo_take 0:c6b2a8ace823 215 sprintf(p, "\r\n");
koyo_take 0:c6b2a8ace823 216
koyo_take 0:c6b2a8ace823 217 flushSerial();
koyo_take 0:c6b2a8ace823 218 serial->puts(msg);
koyo_take 0:c6b2a8ace823 219
koyo_take 0:c6b2a8ace823 220 return 0;
koyo_take 0:c6b2a8ace823 221 }
koyo_take 0:c6b2a8ace823 222
koyo_take 0:c6b2a8ace823 223 void Eeabp1::setGrovePower(bool on)
koyo_take 0:c6b2a8ace823 224 {
koyo_take 0:c6b2a8ace823 225 if (on) {
koyo_take 0:c6b2a8ace823 226 if (grove_enabled)
koyo_take 0:c6b2a8ace823 227 return; /* power is already on, do nothing */
koyo_take 0:c6b2a8ace823 228
koyo_take 0:c6b2a8ace823 229 grove_power = 1;
koyo_take 0:c6b2a8ace823 230 } else {
koyo_take 0:c6b2a8ace823 231 if (!grove_enabled)
koyo_take 0:c6b2a8ace823 232 return; /* power is already off, do nothing */
koyo_take 0:c6b2a8ace823 233
koyo_take 0:c6b2a8ace823 234 // Grove端子をHiZに
koyo_take 0:c6b2a8ace823 235 grv_sel1g = 1;
koyo_take 0:c6b2a8ace823 236 grv_sel1a = 1;
koyo_take 0:c6b2a8ace823 237 grv_sel2g = 1;
koyo_take 0:c6b2a8ace823 238 grv_sel2a = 1;
koyo_take 0:c6b2a8ace823 239 grove_power = 0;
koyo_take 0:c6b2a8ace823 240 }
koyo_take 0:c6b2a8ace823 241 }
koyo_take 0:c6b2a8ace823 242
koyo_take 0:c6b2a8ace823 243 int Eeabp1::setGrovePortType(EeabGrovePort port, EeabGrovePortType type)
koyo_take 0:c6b2a8ace823 244 {
koyo_take 0:c6b2a8ace823 245 switch (port) {
koyo_take 0:c6b2a8ace823 246 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 247 if (type == GROVE_ANALOG) {
koyo_take 0:c6b2a8ace823 248 grv_sel1g = 1;
koyo_take 0:c6b2a8ace823 249 grv_sel1a = 0;
koyo_take 0:c6b2a8ace823 250 } else {
koyo_take 0:c6b2a8ace823 251 grv_sel1g = 0;
koyo_take 0:c6b2a8ace823 252 grv_sel1a = 1;
koyo_take 0:c6b2a8ace823 253 }
koyo_take 0:c6b2a8ace823 254 break;
koyo_take 0:c6b2a8ace823 255 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 256 if (type == GROVE_ANALOG) {
koyo_take 0:c6b2a8ace823 257 grv_sel2g = 1;
koyo_take 0:c6b2a8ace823 258 grv_sel2a = 0;
koyo_take 0:c6b2a8ace823 259 } else {
koyo_take 0:c6b2a8ace823 260 grv_sel2g = 0;
koyo_take 0:c6b2a8ace823 261 grv_sel2a = 1;
koyo_take 0:c6b2a8ace823 262 }
koyo_take 0:c6b2a8ace823 263 break;
koyo_take 0:c6b2a8ace823 264 default:
koyo_take 0:c6b2a8ace823 265 /* do nothing */
koyo_take 0:c6b2a8ace823 266 break;
koyo_take 0:c6b2a8ace823 267 }
koyo_take 0:c6b2a8ace823 268
koyo_take 0:c6b2a8ace823 269 return 0;
koyo_take 0:c6b2a8ace823 270 }
koyo_take 0:c6b2a8ace823 271
koyo_take 0:c6b2a8ace823 272 int Eeabp1::setGroveDioDirection(EeabGrovePort port, EeabGroveDioDirection dir, Callback<void()> f)
koyo_take 0:c6b2a8ace823 273 {
koyo_take 0:c6b2a8ace823 274 switch (port) {
koyo_take 0:c6b2a8ace823 275 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 276 if(dir == GROVE_DIO_OUT) {
koyo_take 0:c6b2a8ace823 277 if (grv_p1s1di) {
koyo_take 0:c6b2a8ace823 278 delete grv_p1s1di;
koyo_take 0:c6b2a8ace823 279 grv_p1s1di = NULL;
koyo_take 0:c6b2a8ace823 280 }
koyo_take 0:c6b2a8ace823 281 grv_p1s1do = new DigitalOut(P0_13);
koyo_take 0:c6b2a8ace823 282
koyo_take 0:c6b2a8ace823 283 if (grv_p1s2di) {
koyo_take 0:c6b2a8ace823 284 delete grv_p1s2di;
koyo_take 0:c6b2a8ace823 285 grv_p1s2di = NULL;
koyo_take 0:c6b2a8ace823 286 }
koyo_take 0:c6b2a8ace823 287 grv_p1s2do = new DigitalOut(P0_12);
koyo_take 0:c6b2a8ace823 288 } else { /* GROVE_DIO_IN */
koyo_take 0:c6b2a8ace823 289 if (grv_p1s1do) {
koyo_take 0:c6b2a8ace823 290 delete grv_p1s1do;
koyo_take 0:c6b2a8ace823 291 grv_p1s1do = NULL;
koyo_take 0:c6b2a8ace823 292 }
koyo_take 0:c6b2a8ace823 293 grv_p1s1di = new InterruptIn(P0_13);
koyo_take 0:c6b2a8ace823 294 if (f)
koyo_take 0:c6b2a8ace823 295 grv_p1s1di->rise(f);
koyo_take 0:c6b2a8ace823 296
koyo_take 0:c6b2a8ace823 297 if (grv_p1s2do) {
koyo_take 0:c6b2a8ace823 298 delete grv_p1s2do;
koyo_take 0:c6b2a8ace823 299 grv_p1s2do = NULL;
koyo_take 0:c6b2a8ace823 300 }
koyo_take 0:c6b2a8ace823 301 grv_p1s2di = new InterruptIn(P0_12);
koyo_take 0:c6b2a8ace823 302 grv_p1s2di->rise(f);
koyo_take 0:c6b2a8ace823 303 }
koyo_take 0:c6b2a8ace823 304 break;
koyo_take 0:c6b2a8ace823 305 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 306 if(dir == GROVE_DIO_OUT) {
koyo_take 0:c6b2a8ace823 307 if (grv_p2s1di) {
koyo_take 0:c6b2a8ace823 308 delete grv_p2s1di;
koyo_take 0:c6b2a8ace823 309 grv_p2s1di = NULL;
koyo_take 0:c6b2a8ace823 310 }
koyo_take 0:c6b2a8ace823 311 grv_p2s1do = new DigitalOut(P0_15);
koyo_take 0:c6b2a8ace823 312
koyo_take 0:c6b2a8ace823 313 if (grv_p2s2di) {
koyo_take 0:c6b2a8ace823 314 delete grv_p2s2di;
koyo_take 0:c6b2a8ace823 315 grv_p2s2di = NULL;
koyo_take 0:c6b2a8ace823 316 }
koyo_take 0:c6b2a8ace823 317 grv_p2s2do = new DigitalOut(P0_14);
koyo_take 0:c6b2a8ace823 318 } else { /* GROVE_DIO_IN */
koyo_take 0:c6b2a8ace823 319 if (grv_p2s1do) {
koyo_take 0:c6b2a8ace823 320 delete grv_p2s1do;
koyo_take 0:c6b2a8ace823 321 grv_p2s1do = NULL;
koyo_take 0:c6b2a8ace823 322 }
koyo_take 0:c6b2a8ace823 323 grv_p2s1di = new InterruptIn(P0_15);
koyo_take 0:c6b2a8ace823 324 if (f)
koyo_take 0:c6b2a8ace823 325 grv_p2s1di->rise(f);
koyo_take 0:c6b2a8ace823 326
koyo_take 0:c6b2a8ace823 327 if (grv_p2s2do) {
koyo_take 0:c6b2a8ace823 328 delete grv_p2s2do;
koyo_take 0:c6b2a8ace823 329 grv_p2s2do = NULL;
koyo_take 0:c6b2a8ace823 330 }
koyo_take 0:c6b2a8ace823 331 grv_p2s2di = new InterruptIn(P0_14);
koyo_take 0:c6b2a8ace823 332 grv_p2s2di->rise(f);
koyo_take 0:c6b2a8ace823 333 }
koyo_take 0:c6b2a8ace823 334 break;
koyo_take 0:c6b2a8ace823 335 default:
koyo_take 0:c6b2a8ace823 336 /* do nothing */
koyo_take 0:c6b2a8ace823 337 break;
koyo_take 0:c6b2a8ace823 338 }
koyo_take 0:c6b2a8ace823 339
koyo_take 0:c6b2a8ace823 340 return 0;
koyo_take 0:c6b2a8ace823 341 }
koyo_take 0:c6b2a8ace823 342
koyo_take 0:c6b2a8ace823 343 int Eeabp1::setGroveDio(EeabGrovePort port, EeabGroveDio val)
koyo_take 0:c6b2a8ace823 344 {
koyo_take 0:c6b2a8ace823 345 switch (port) {
koyo_take 0:c6b2a8ace823 346 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 347 *grv_p1s1do = val;
koyo_take 0:c6b2a8ace823 348 *grv_p1s2do = val;
koyo_take 0:c6b2a8ace823 349 break;
koyo_take 0:c6b2a8ace823 350 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 351 *grv_p2s1do = val;
koyo_take 0:c6b2a8ace823 352 *grv_p2s2do = val;
koyo_take 0:c6b2a8ace823 353 break;
koyo_take 0:c6b2a8ace823 354 default:
koyo_take 0:c6b2a8ace823 355 break;
koyo_take 0:c6b2a8ace823 356 }
koyo_take 0:c6b2a8ace823 357
koyo_take 0:c6b2a8ace823 358 return 0;
koyo_take 0:c6b2a8ace823 359 }
koyo_take 0:c6b2a8ace823 360
koyo_take 0:c6b2a8ace823 361 int Eeabp1::setGroveDio(EeabGrovePort port, EeabGroveSig sig , EeabGroveDio val)
koyo_take 0:c6b2a8ace823 362 {
koyo_take 0:c6b2a8ace823 363 switch (port) {
koyo_take 0:c6b2a8ace823 364 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 365 (sig == GROVE_SIG1) ? *grv_p1s1do = val : *grv_p1s2do = val;
koyo_take 0:c6b2a8ace823 366 break;
koyo_take 0:c6b2a8ace823 367 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 368 (sig == GROVE_SIG1) ? *grv_p2s1do = val : *grv_p2s2do = val;
koyo_take 0:c6b2a8ace823 369 break;
koyo_take 0:c6b2a8ace823 370 default:
koyo_take 0:c6b2a8ace823 371 break;
koyo_take 0:c6b2a8ace823 372 }
koyo_take 0:c6b2a8ace823 373 return 0;
koyo_take 0:c6b2a8ace823 374 }
koyo_take 0:c6b2a8ace823 375
koyo_take 0:c6b2a8ace823 376
koyo_take 0:c6b2a8ace823 377 int Eeabp1::getGroveDio(EeabGrovePort port, EeabGroveSig sig)
koyo_take 0:c6b2a8ace823 378 {
koyo_take 0:c6b2a8ace823 379 switch (port) {
koyo_take 0:c6b2a8ace823 380 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 381 if (grv_p1s1di == NULL)
koyo_take 0:c6b2a8ace823 382 return -1;
koyo_take 0:c6b2a8ace823 383 return (sig == GROVE_SIG1) ?
koyo_take 0:c6b2a8ace823 384 grv_p1s1di->read() : grv_p1s2di->read();
koyo_take 0:c6b2a8ace823 385 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 386 if (grv_p2s1di == NULL)
koyo_take 0:c6b2a8ace823 387 return -1;
koyo_take 0:c6b2a8ace823 388 return (sig == GROVE_SIG1) ?
koyo_take 0:c6b2a8ace823 389 grv_p2s1di->read() : grv_p2s2di->read();
koyo_take 0:c6b2a8ace823 390 default:
koyo_take 0:c6b2a8ace823 391 break;
koyo_take 0:c6b2a8ace823 392 }
koyo_take 0:c6b2a8ace823 393
koyo_take 0:c6b2a8ace823 394 return -1;
koyo_take 0:c6b2a8ace823 395 }
koyo_take 0:c6b2a8ace823 396
koyo_take 0:c6b2a8ace823 397 float Eeabp1::getGroveAnalog(EeabGrovePort port, EeabGroveSig sig)
koyo_take 0:c6b2a8ace823 398 {
koyo_take 0:c6b2a8ace823 399 switch (port) {
koyo_take 0:c6b2a8ace823 400 case GROVE_CH1:
koyo_take 0:c6b2a8ace823 401 return (sig == GROVE_SIG1) ?
koyo_take 0:c6b2a8ace823 402 grv_p1s1a.read() : grv_p1s2a.read();
koyo_take 0:c6b2a8ace823 403 case GROVE_CH2:
koyo_take 0:c6b2a8ace823 404 return (sig == GROVE_SIG1) ?
koyo_take 0:c6b2a8ace823 405 grv_p2s1a.read() : grv_p2s2a.read();
koyo_take 0:c6b2a8ace823 406 default:
koyo_take 0:c6b2a8ace823 407 break;
koyo_take 0:c6b2a8ace823 408 }
koyo_take 0:c6b2a8ace823 409
koyo_take 0:c6b2a8ace823 410 return -1;
koyo_take 0:c6b2a8ace823 411 }
koyo_take 0:c6b2a8ace823 412
koyo_take 0:c6b2a8ace823 413 int Eeabp1::enableTempHumidSensor(void)
koyo_take 0:c6b2a8ace823 414 {
koyo_take 0:c6b2a8ace823 415 temp_humid_sensor = new Sht31(P0_30, P0_7);
koyo_take 0:c6b2a8ace823 416 return 0;
koyo_take 0:c6b2a8ace823 417 }
koyo_take 0:c6b2a8ace823 418
koyo_take 0:c6b2a8ace823 419 float Eeabp1::getTemp(void)
koyo_take 0:c6b2a8ace823 420 {
koyo_take 0:c6b2a8ace823 421 if (!temp_humid_sensor)
koyo_take 0:c6b2a8ace823 422 return -1;
koyo_take 0:c6b2a8ace823 423
koyo_take 0:c6b2a8ace823 424 return temp_humid_sensor->readTemperature();
koyo_take 0:c6b2a8ace823 425 }
koyo_take 0:c6b2a8ace823 426
koyo_take 0:c6b2a8ace823 427 float Eeabp1::getHumid(void)
koyo_take 0:c6b2a8ace823 428 {
koyo_take 0:c6b2a8ace823 429 if (!temp_humid_sensor)
koyo_take 0:c6b2a8ace823 430 return -1;
koyo_take 0:c6b2a8ace823 431
koyo_take 0:c6b2a8ace823 432 return temp_humid_sensor->readHumidity();
koyo_take 0:c6b2a8ace823 433 }
koyo_take 0:c6b2a8ace823 434
koyo_take 0:c6b2a8ace823 435 int Eeabp1::enableAccelerometer(void)
koyo_take 0:c6b2a8ace823 436 {
koyo_take 0:c6b2a8ace823 437 accelerometer = new ADXL345_I2C(P0_30, P0_7);
koyo_take 0:c6b2a8ace823 438
koyo_take 0:c6b2a8ace823 439 this->debug("Device ID is: 0x%02x\n", accelerometer->getDeviceID());
koyo_take 0:c6b2a8ace823 440 wait(.001);
koyo_take 0:c6b2a8ace823 441
koyo_take 0:c6b2a8ace823 442 // These are here to test whether any of the initialization fails. It will print the failure
koyo_take 0:c6b2a8ace823 443 if (accelerometer->setPowerControl(0x00)) {
koyo_take 0:c6b2a8ace823 444 this->debug("didn't intitialize power control\n");
koyo_take 0:c6b2a8ace823 445 return -1;
koyo_take 0:c6b2a8ace823 446 }
koyo_take 0:c6b2a8ace823 447 wait(.001);
koyo_take 0:c6b2a8ace823 448
koyo_take 0:c6b2a8ace823 449 //Full resolution, +/-16g, 4mg/LSB.
koyo_take 0:c6b2a8ace823 450 if(accelerometer->setDataFormatControl(0x0B)) {
koyo_take 0:c6b2a8ace823 451 this->debug("didn't set data format\n");
koyo_take 0:c6b2a8ace823 452 return -1;
koyo_take 0:c6b2a8ace823 453 }
koyo_take 0:c6b2a8ace823 454 wait(.001);
koyo_take 0:c6b2a8ace823 455
koyo_take 0:c6b2a8ace823 456 //3.2kHz data rate.
koyo_take 0:c6b2a8ace823 457 if(accelerometer->setDataRate(ADXL345_3200HZ)) {
koyo_take 0:c6b2a8ace823 458 this->debug("didn't set data rate\n");
koyo_take 0:c6b2a8ace823 459 return -1;
koyo_take 0:c6b2a8ace823 460 }
koyo_take 0:c6b2a8ace823 461 wait(.001);
koyo_take 0:c6b2a8ace823 462
koyo_take 0:c6b2a8ace823 463 //Measurement mode.
koyo_take 0:c6b2a8ace823 464 if(accelerometer->setPowerControl(MeasurementMode)) {
koyo_take 0:c6b2a8ace823 465 this->debug("didn't set the power control to measurement\n");
koyo_take 0:c6b2a8ace823 466 return -1;
koyo_take 0:c6b2a8ace823 467 }
koyo_take 0:c6b2a8ace823 468
koyo_take 0:c6b2a8ace823 469 return 0;
koyo_take 0:c6b2a8ace823 470 }
koyo_take 0:c6b2a8ace823 471
koyo_take 0:c6b2a8ace823 472 int Eeabp1::getAcc(int *x, int *y, int *z)
koyo_take 0:c6b2a8ace823 473 {
koyo_take 0:c6b2a8ace823 474 int readings[3] = {0, 0, 0};
koyo_take 0:c6b2a8ace823 475 accelerometer->getOutput(readings);
koyo_take 0:c6b2a8ace823 476 *x = readings[0];
koyo_take 0:c6b2a8ace823 477 *y = readings[1];
koyo_take 0:c6b2a8ace823 478 *z = readings[2];
koyo_take 0:c6b2a8ace823 479
koyo_take 0:c6b2a8ace823 480 return 0;
koyo_take 0:c6b2a8ace823 481 }
koyo_take 0:c6b2a8ace823 482
koyo_take 0:c6b2a8ace823 483 /* private functions */
koyo_take 0:c6b2a8ace823 484 void Eeabp1::flushSerial()
koyo_take 0:c6b2a8ace823 485 {
koyo_take 0:c6b2a8ace823 486 while(serial->readable() == true) {
koyo_take 0:c6b2a8ace823 487 serial->getc();
koyo_take 0:c6b2a8ace823 488 wait_us(1000);
koyo_take 0:c6b2a8ace823 489 }
koyo_take 0:c6b2a8ace823 490 }
koyo_take 0:c6b2a8ace823 491
koyo_take 2:d48fcae8b5bd 492 inline ssize_t Eeabp1::getline(char *buf, size_t bufsize, int timeout_ms)
koyo_take 2:d48fcae8b5bd 493 {
koyo_take 2:d48fcae8b5bd 494 char c;
koyo_take 2:d48fcae8b5bd 495 size_t receivedChars = 0;
koyo_take 2:d48fcae8b5bd 496 Timer t;
koyo_take 2:d48fcae8b5bd 497
koyo_take 2:d48fcae8b5bd 498 t.start();
koyo_take 2:d48fcae8b5bd 499
koyo_take 2:d48fcae8b5bd 500 *buf = '\0';
koyo_take 2:d48fcae8b5bd 501 do {
koyo_take 2:d48fcae8b5bd 502 if (!serial->readable()) {
koyo_take 2:d48fcae8b5bd 503 wait_us(50);
koyo_take 2:d48fcae8b5bd 504 continue;
koyo_take 2:d48fcae8b5bd 505 }
koyo_take 2:d48fcae8b5bd 506
koyo_take 2:d48fcae8b5bd 507 c = serial->getc();
koyo_take 2:d48fcae8b5bd 508 /*
koyo_take 2:d48fcae8b5bd 509 if (c == '\r' || c == '\n') {
koyo_take 2:d48fcae8b5bd 510 if (receivedChars == 0) {
koyo_take 2:d48fcae8b5bd 511 continue; //Ignore if first character is delimiter
koyo_take 2:d48fcae8b5bd 512 }
koyo_take 2:d48fcae8b5bd 513 if (serial->readable()) {
koyo_take 2:d48fcae8b5bd 514 continue; //continue to read next line
koyo_take 2:d48fcae8b5bd 515 }
koyo_take 2:d48fcae8b5bd 516 break;
koyo_take 2:d48fcae8b5bd 517 }
koyo_take 2:d48fcae8b5bd 518 */
koyo_take 2:d48fcae8b5bd 519 if (receivedChars < bufsize - 1)
koyo_take 2:d48fcae8b5bd 520 {
koyo_take 2:d48fcae8b5bd 521 *buf++ = c;
koyo_take 2:d48fcae8b5bd 522 receivedChars++;
koyo_take 2:d48fcae8b5bd 523 }
koyo_take 2:d48fcae8b5bd 524 } while(t.read_ms() < timeout_ms);
koyo_take 2:d48fcae8b5bd 525 *buf++ = '\0';
koyo_take 2:d48fcae8b5bd 526
koyo_take 2:d48fcae8b5bd 527 t.stop();
koyo_take 2:d48fcae8b5bd 528
koyo_take 2:d48fcae8b5bd 529 return receivedChars;
koyo_take 2:d48fcae8b5bd 530 }
koyo_take 2:d48fcae8b5bd 531
koyo_take 2:d48fcae8b5bd 532 int Eeabp1::chkSerialChar(const char ch, uint16_t timeout_ms)
koyo_take 0:c6b2a8ace823 533 {
koyo_take 0:c6b2a8ace823 534 uint32_t timeoutCount = 0;
koyo_take 0:c6b2a8ace823 535
koyo_take 0:c6b2a8ace823 536 while(serial->readable() == false) {
koyo_take 0:c6b2a8ace823 537 wait_us(50);
koyo_take 0:c6b2a8ace823 538 timeoutCount++;
koyo_take 0:c6b2a8ace823 539 if((timeoutCount / 20) >= timeout_ms)
koyo_take 0:c6b2a8ace823 540 return -2;
koyo_take 0:c6b2a8ace823 541 }
koyo_take 0:c6b2a8ace823 542
koyo_take 0:c6b2a8ace823 543 return (serial->getc() == ch) ? 0 : -1;
koyo_take 0:c6b2a8ace823 544 }
koyo_take 0:c6b2a8ace823 545
koyo_take 0:c6b2a8ace823 546 int Eeabp1::waitSerialChar(const char ch,uint16_t timeout_ms)
koyo_take 0:c6b2a8ace823 547 {
koyo_take 0:c6b2a8ace823 548 uint32_t timeoutCount = 0;
koyo_take 0:c6b2a8ace823 549
koyo_take 0:c6b2a8ace823 550 do {
koyo_take 0:c6b2a8ace823 551 while(serial->readable() == false) {
koyo_take 0:c6b2a8ace823 552 wait_us(50);
koyo_take 0:c6b2a8ace823 553 timeoutCount++;
koyo_take 0:c6b2a8ace823 554 if((timeoutCount / 20) >= timeout_ms)
koyo_take 0:c6b2a8ace823 555 return -2;
koyo_take 0:c6b2a8ace823 556 }
koyo_take 0:c6b2a8ace823 557 } while(serial->getc() != ch);
koyo_take 0:c6b2a8ace823 558
koyo_take 0:c6b2a8ace823 559 return 0;
koyo_take 0:c6b2a8ace823 560 }
koyo_take 0:c6b2a8ace823 561
koyo_take 0:c6b2a8ace823 562 int Eeabp1::chkSerialCharOk()
koyo_take 0:c6b2a8ace823 563 {
koyo_take 0:c6b2a8ace823 564 int ret;
koyo_take 0:c6b2a8ace823 565 ret = waitSerialChar('>',4000);
koyo_take 0:c6b2a8ace823 566 if (ret != 0)
koyo_take 0:c6b2a8ace823 567 return __LINE__;
koyo_take 0:c6b2a8ace823 568
koyo_take 0:c6b2a8ace823 569 ret = chkSerialChar('>',2000);
koyo_take 0:c6b2a8ace823 570 if (ret != 0)
koyo_take 0:c6b2a8ace823 571 return __LINE__;
koyo_take 0:c6b2a8ace823 572
koyo_take 0:c6b2a8ace823 573 ret = chkSerialChar(' ',2000);
koyo_take 0:c6b2a8ace823 574 if (ret != 0)
koyo_take 0:c6b2a8ace823 575 return __LINE__;
koyo_take 0:c6b2a8ace823 576
koyo_take 0:c6b2a8ace823 577 ret = chkSerialChar('O',2000);
koyo_take 0:c6b2a8ace823 578 if (ret != 0)
koyo_take 0:c6b2a8ace823 579 return __LINE__;
koyo_take 0:c6b2a8ace823 580
koyo_take 0:c6b2a8ace823 581 ret = chkSerialChar('k',2000);
koyo_take 0:c6b2a8ace823 582 if (ret != 0)
koyo_take 0:c6b2a8ace823 583 return __LINE__;
koyo_take 0:c6b2a8ace823 584
koyo_take 0:c6b2a8ace823 585 ret = waitSerialChar('>',4000);
koyo_take 0:c6b2a8ace823 586 if (ret != 0)
koyo_take 0:c6b2a8ace823 587 return __LINE__;
koyo_take 0:c6b2a8ace823 588
koyo_take 0:c6b2a8ace823 589 wait_us(1000);
koyo_take 0:c6b2a8ace823 590
koyo_take 0:c6b2a8ace823 591 return 0;
koyo_take 0:c6b2a8ace823 592 }
koyo_take 0:c6b2a8ace823 593
koyo_take 0:c6b2a8ace823 594 int Eeabp1::chkSerialCharRes(char chkchr)
koyo_take 0:c6b2a8ace823 595 {
koyo_take 0:c6b2a8ace823 596 int ret;
koyo_take 0:c6b2a8ace823 597 ret = waitSerialChar('>', 10000);
koyo_take 0:c6b2a8ace823 598 if (ret != 0)
koyo_take 0:c6b2a8ace823 599 return __LINE__;
koyo_take 0:c6b2a8ace823 600
koyo_take 0:c6b2a8ace823 601 ret = chkSerialChar('>',2000);
koyo_take 0:c6b2a8ace823 602 if (ret != 0)
koyo_take 0:c6b2a8ace823 603 return __LINE__;
koyo_take 0:c6b2a8ace823 604
koyo_take 0:c6b2a8ace823 605 ret = chkSerialChar(' ',2000);
koyo_take 0:c6b2a8ace823 606 if (ret != 0)
koyo_take 0:c6b2a8ace823 607 return __LINE__;
koyo_take 0:c6b2a8ace823 608
koyo_take 0:c6b2a8ace823 609 ret = chkSerialChar('O',2000);
koyo_take 0:c6b2a8ace823 610 if (ret != 0)
koyo_take 0:c6b2a8ace823 611 return __LINE__;
koyo_take 0:c6b2a8ace823 612
koyo_take 0:c6b2a8ace823 613 ret = chkSerialChar('k',2000);
koyo_take 0:c6b2a8ace823 614 if (ret != 0)
koyo_take 0:c6b2a8ace823 615 return __LINE__;
koyo_take 0:c6b2a8ace823 616
koyo_take 0:c6b2a8ace823 617 ret = waitSerialChar('>',16000);
koyo_take 0:c6b2a8ace823 618 if (ret != 0)
koyo_take 0:c6b2a8ace823 619 return __LINE__;
koyo_take 0:c6b2a8ace823 620
koyo_take 0:c6b2a8ace823 621 ret = chkSerialChar('>',2000);
koyo_take 0:c6b2a8ace823 622 if (ret != 0)
koyo_take 0:c6b2a8ace823 623 return __LINE__;
koyo_take 0:c6b2a8ace823 624
koyo_take 0:c6b2a8ace823 625 ret = chkSerialChar(' ',2000);
koyo_take 0:c6b2a8ace823 626 if (ret != 0)
koyo_take 0:c6b2a8ace823 627 return __LINE__;
koyo_take 0:c6b2a8ace823 628
koyo_take 0:c6b2a8ace823 629 ret = waitSerialChar(chkchr,4000);
koyo_take 0:c6b2a8ace823 630 if (ret != 0)
koyo_take 0:c6b2a8ace823 631 return __LINE__;
koyo_take 0:c6b2a8ace823 632
koyo_take 0:c6b2a8ace823 633 ret = waitSerialChar('>',4000);
koyo_take 0:c6b2a8ace823 634 if (ret != 0)
koyo_take 0:c6b2a8ace823 635 return __LINE__;
koyo_take 0:c6b2a8ace823 636
koyo_take 0:c6b2a8ace823 637 wait_us(1000);
koyo_take 0:c6b2a8ace823 638
koyo_take 0:c6b2a8ace823 639 return 0;
koyo_take 0:c6b2a8ace823 640 }