Suga koubou
Interplan IM920 library, 920MHz module
Dependents: IM920_sample IM920_SDlog IM920_sample IM920_sample3 ... more
IM920 ライブラリ
データモード、低速、長距離 の設定で通信するライブラリです。
920MHz無線モジュール
- mbedとモジュールとは、シリアル（TX,RX）、BUSY、RESET端子を接続します。
- モジュールはあらかじめ、コマンドでノード番号などを設定しておきます。
Diff: IM920_msg.cpp
- Revision:
- 0:d3ab05ed8142
- Child:
- 2:0b47f6b25cc4
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/IM920_msg.cpp Fri Dec 26 15:35:20 2014 +0000
@@ -0,0 +1,136 @@
+#include "IM920.h"
+
+void IM920::recvData (char c) {
+ static int sub, len, count;
+ static char chr;
+
+#ifdef DEBUG_DUMP
+ if (c < 0x20 || c >= 0x7f) {
+ std::printf("_%02x", c);
+ } else {
+ std::printf("_%c", c);
+ }
+#endif
+ switch (_state.mode) {
+ case MODE_COMMAND:
+ switch (c) {
+ case 0:
+ case 0x0a: // LF
+ case 0x0d: // CR
+ _state.buf[len] = 0;
+ len = 0;
+ parseMessage();
+ break;
+ case ':':
+ if (_state.buf[2] == ',' && _state.buf[7] == ',' && len == 10) {
+ sub = 0;
+ _state.mode = MODE_DATA_RX;
+ break;
+ }
+ /* FALLTHROUGH */
+ default:
+ if (len < sizeof(_state.buf) - 1) {
+ _state.buf[len] = c;
+ }
+ len ++;
+ break;
+ }
+ break;
+
+ case MODE_DATA_RX:
+ if (c == '\r' || c == '\n') {
+ DBG("recv %d/%d\r\n", count, len);
+ _state.received = true;
+ _state.mode = MODE_COMMAND;
+ len = 0;
+ break;
+ }
+ switch (sub) {
+ case 0:
+ chr = x2i(c) << 4;
+ sub ++;
+ break;
+ case 1:
+ chr |= x2i(c);
+ sub ++;
+ if (_state.data!= NULL) {
+ _state.data->queue(chr);
+ if (_state.func != NULL && _state.data->available() >= CFG_DATA_SIZE) {
+ _state.received = true;
+ WARN("buf full");
+ }
+ }
+ count ++;
+ break;
+ case 2:
+ if (c == ',') {
+ sub = 0;
+ }
+ break;
+ }
+ }
+}
+
+#define RES_TABLE_NUM 4
+int IM920::parseMessage () {
+ int i;
+ static const struct RES_TABLE {
+ const Response res;
+ void (IM920::*func)(const char*);
+ } res_table[RES_TABLE_NUM] = {
+ {RES_NULL, NULL},
+ {RES_RDID, &IM920::resRDID},
+ {RES_RDNN, &IM920::resRDNN},
+ {RES_RDRS, &IM920::resRDRS},
+ };
+
+ if (_state.res != RES_NULL) {
+ for (i = 0; i < RES_TABLE_NUM; i ++) {
+ if (res_table[i].res == _state.res) {
+ DBG("parse res %d '%s'\r\n", i, _state.buf);
+ if (res_table[i].func != NULL) {
+ (this->*(res_table[i].func))(_state.buf);
+ }
+ }
+ }
+ }
+
+ if (strncmp(_state.buf, "OK", 2) == 0) {
+ _state.ok = true;
+ if (_state.status == STAT_SLEEP) {
+ _state.status = STAT_NONE;
+ }
+ return 0;
+ } else
+ if (strncmp(_state.buf, "NG", 2) == 0) {
+ _state.failure = true;
+ return 0;
+ }
+
+ return -1;
+}
+
+void IM920::resRDID (const char *buf) {
+
+ if (buf[0] < '0' || buf[0] > 'F') return;
+
+ _state.id = strtol(buf, NULL, 16);
+ _state.res = RES_NULL;
+}
+
+void IM920::resRDNN (const char *buf) {
+
+ if (buf[0] < '0' || buf[0] > 'F') return;
+
+ _state.node = strtol(buf, NULL, 16);
+ _state.res = RES_NULL;
+}
+
+void IM920::resRDRS (const char *buf) {
+
+ if (buf[0] < '0' || buf[0] > 'F') return;
+
+ _state.rssi = strtol(buf, NULL, 16);
+ _state.res = RES_NULL;
+}
+
