pwm period is now 200us instead of the default 20ms veml6040 config is now AF_BIT | TRIG_BIT
Dependencies: mbed MMA8451Q USBDevice WakeUp vt100
Fork of afero_node_suntory_2017_06_15 by
afLib/Command.cpp@2:dfe671e31221, 2017-01-24 (annotated)
- Committer:
- wataloh
- Date:
- Tue Jan 24 10:00:28 2017 +0000
- Revision:
- 2:dfe671e31221
- Parent:
- 1:b2a9a6f2c30e
- Child:
- 5:9d5c7ee80f3b
latest
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
wataloh | 0:20bce0dcc921 | 1 | /** |
wataloh | 0:20bce0dcc921 | 2 | * Copyright 2015 Afero, Inc. |
wataloh | 0:20bce0dcc921 | 3 | * |
wataloh | 0:20bce0dcc921 | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
wataloh | 0:20bce0dcc921 | 5 | * you may not use this file except in compliance with the License. |
wataloh | 0:20bce0dcc921 | 6 | * You may obtain a copy of the License at |
wataloh | 0:20bce0dcc921 | 7 | * |
wataloh | 0:20bce0dcc921 | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
wataloh | 0:20bce0dcc921 | 9 | * |
wataloh | 0:20bce0dcc921 | 10 | * Unless required by applicable law or agreed to in writing, software |
wataloh | 0:20bce0dcc921 | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
wataloh | 0:20bce0dcc921 | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
wataloh | 0:20bce0dcc921 | 13 | * See the License for the specific language governing permissions and |
wataloh | 0:20bce0dcc921 | 14 | * limitations under the License. |
wataloh | 0:20bce0dcc921 | 15 | */ |
wataloh | 0:20bce0dcc921 | 16 | |
wataloh | 0:20bce0dcc921 | 17 | //wsugi #include "Arduino.h" |
wataloh | 0:20bce0dcc921 | 18 | #include "mbed.h" |
wataloh | 0:20bce0dcc921 | 19 | #include <stdio.h> |
wataloh | 0:20bce0dcc921 | 20 | #include "Command.h" |
wataloh | 0:20bce0dcc921 | 21 | #include "msg_types.h" |
wataloh | 0:20bce0dcc921 | 22 | |
wataloh | 0:20bce0dcc921 | 23 | #define CMD_HDR_LEN 4 // 4 byte header on all commands |
wataloh | 0:20bce0dcc921 | 24 | #define CMD_VAL_LEN 2 // 2 byte value length for commands that have a value |
wataloh | 0:20bce0dcc921 | 25 | |
wataloh | 0:20bce0dcc921 | 26 | const char *CMD_NAMES[] = {"SET ", "GET ", "UPDATE"}; |
wataloh | 0:20bce0dcc921 | 27 | |
wataloh | 0:20bce0dcc921 | 28 | |
wataloh | 0:20bce0dcc921 | 29 | Command::Command(uint16_t len, uint8_t *bytes) { |
wataloh | 0:20bce0dcc921 | 30 | int index = 0; |
wataloh | 0:20bce0dcc921 | 31 | |
wataloh | 0:20bce0dcc921 | 32 | _cmd = bytes[index++]; |
wataloh | 0:20bce0dcc921 | 33 | _requestId = bytes[index++]; |
wataloh | 0:20bce0dcc921 | 34 | _attrId = bytes[index + 0] | bytes[index + 1] << 8; |
wataloh | 0:20bce0dcc921 | 35 | index += 2; |
wataloh | 0:20bce0dcc921 | 36 | |
wataloh | 0:20bce0dcc921 | 37 | if (_cmd == MSG_TYPE_GET) { |
wataloh | 0:20bce0dcc921 | 38 | return; |
wataloh | 0:20bce0dcc921 | 39 | } |
wataloh | 0:20bce0dcc921 | 40 | if (_cmd == MSG_TYPE_UPDATE) { |
wataloh | 0:20bce0dcc921 | 41 | _status = bytes[index++]; |
wataloh | 0:20bce0dcc921 | 42 | _reason = bytes[index++]; |
wataloh | 0:20bce0dcc921 | 43 | } |
wataloh | 0:20bce0dcc921 | 44 | |
wataloh | 0:20bce0dcc921 | 45 | _valueLen = bytes[index + 0] | bytes[index + 1] << 8; |
wataloh | 0:20bce0dcc921 | 46 | index += 2; |
wataloh | 0:20bce0dcc921 | 47 | _value = new uint8_t[_valueLen]; |
wataloh | 0:20bce0dcc921 | 48 | for (int i = 0; i < _valueLen; i++) { |
wataloh | 0:20bce0dcc921 | 49 | _value[i] = bytes[index + i]; |
wataloh | 0:20bce0dcc921 | 50 | } |
wataloh | 0:20bce0dcc921 | 51 | } |
wataloh | 0:20bce0dcc921 | 52 | |
wataloh | 0:20bce0dcc921 | 53 | Command::Command(uint8_t requestId, const char *str) { |
wataloh | 0:20bce0dcc921 | 54 | _requestId = requestId & 0xff; |
wataloh | 0:20bce0dcc921 | 55 | |
wataloh | 0:20bce0dcc921 | 56 | char *cp; //wsugi = strdup(str); |
wataloh | 0:20bce0dcc921 | 57 | //wsugi 00 start |
wataloh | 0:20bce0dcc921 | 58 | { |
wataloh | 0:20bce0dcc921 | 59 | int length = strlen(str)+1; |
wataloh | 0:20bce0dcc921 | 60 | cp = (char*)malloc(length); |
wataloh | 0:20bce0dcc921 | 61 | strcpy(cp,str); |
wataloh | 0:20bce0dcc921 | 62 | } |
wataloh | 0:20bce0dcc921 | 63 | //wsugi 00 end |
wataloh | 0:20bce0dcc921 | 64 | char *tok = strtok(cp, " "); |
wataloh | 0:20bce0dcc921 | 65 | _cmd = strToCmd(tok); |
wataloh | 0:20bce0dcc921 | 66 | |
wataloh | 0:20bce0dcc921 | 67 | tok = strtok(NULL, " "); |
wataloh | 0:20bce0dcc921 | 68 | _attrId = strToAttrId(tok); |
wataloh | 0:20bce0dcc921 | 69 | |
wataloh | 0:20bce0dcc921 | 70 | if (_cmd == MSG_TYPE_GET) { |
wataloh | 0:20bce0dcc921 | 71 | _valueLen = 0; |
wataloh | 0:20bce0dcc921 | 72 | _value = NULL; |
wataloh | 0:20bce0dcc921 | 73 | } else { |
wataloh | 0:20bce0dcc921 | 74 | tok = strtok(NULL, " "); |
wataloh | 0:20bce0dcc921 | 75 | _valueLen = strlen(tok) / 2; |
wataloh | 0:20bce0dcc921 | 76 | _value = new uint8_t[_valueLen]; |
wataloh | 0:20bce0dcc921 | 77 | strToValue(tok, _value); |
wataloh | 0:20bce0dcc921 | 78 | } |
wataloh | 0:20bce0dcc921 | 79 | |
wataloh | 0:20bce0dcc921 | 80 | free(cp); |
wataloh | 0:20bce0dcc921 | 81 | } |
wataloh | 0:20bce0dcc921 | 82 | |
wataloh | 0:20bce0dcc921 | 83 | Command::Command(uint8_t requestId, uint8_t cmd, uint16_t attrId) { |
wataloh | 0:20bce0dcc921 | 84 | _requestId = requestId; |
wataloh | 0:20bce0dcc921 | 85 | _cmd = cmd; |
wataloh | 0:20bce0dcc921 | 86 | _attrId = attrId; |
wataloh | 0:20bce0dcc921 | 87 | _valueLen = 0; |
wataloh | 0:20bce0dcc921 | 88 | _value = NULL; |
wataloh | 0:20bce0dcc921 | 89 | } |
wataloh | 0:20bce0dcc921 | 90 | |
wataloh | 0:20bce0dcc921 | 91 | Command::Command(uint8_t requestId, uint8_t cmd, uint16_t attrId, uint16_t valueLen, uint8_t *value) { |
wataloh | 0:20bce0dcc921 | 92 | _requestId = requestId; |
wataloh | 0:20bce0dcc921 | 93 | _cmd = cmd; |
wataloh | 0:20bce0dcc921 | 94 | _attrId = attrId; |
wataloh | 0:20bce0dcc921 | 95 | _valueLen = valueLen; |
wataloh | 0:20bce0dcc921 | 96 | _value = new uint8_t[_valueLen]; |
wataloh | 0:20bce0dcc921 | 97 | memcpy(_value, value, valueLen); |
wataloh | 0:20bce0dcc921 | 98 | } |
wataloh | 0:20bce0dcc921 | 99 | |
wataloh | 0:20bce0dcc921 | 100 | Command::Command(uint8_t requestId, uint8_t cmd, uint16_t attrId, uint8_t status, uint8_t reason, uint16_t valueLen, |
wataloh | 0:20bce0dcc921 | 101 | uint8_t *value) { |
wataloh | 0:20bce0dcc921 | 102 | _requestId = requestId; |
wataloh | 0:20bce0dcc921 | 103 | _cmd = cmd; |
wataloh | 0:20bce0dcc921 | 104 | _attrId = attrId; |
wataloh | 0:20bce0dcc921 | 105 | _status = status; |
wataloh | 0:20bce0dcc921 | 106 | _reason = reason; |
wataloh | 0:20bce0dcc921 | 107 | _valueLen = valueLen; |
wataloh | 0:20bce0dcc921 | 108 | _value = new uint8_t[_valueLen]; |
wataloh | 0:20bce0dcc921 | 109 | memcpy(_value, value, valueLen); |
wataloh | 0:20bce0dcc921 | 110 | } |
wataloh | 0:20bce0dcc921 | 111 | |
wataloh | 0:20bce0dcc921 | 112 | Command::Command() { |
wataloh | 0:20bce0dcc921 | 113 | } |
wataloh | 0:20bce0dcc921 | 114 | |
wataloh | 0:20bce0dcc921 | 115 | Command::~Command() { |
wataloh | 0:20bce0dcc921 | 116 | if (_value != NULL) { |
wataloh | 2:dfe671e31221 | 117 | delete[] _value; //wsugi delete (_value); |
wataloh | 0:20bce0dcc921 | 118 | } |
wataloh | 0:20bce0dcc921 | 119 | } |
wataloh | 0:20bce0dcc921 | 120 | |
wataloh | 0:20bce0dcc921 | 121 | int Command::strToValue(char *valueStr, uint8_t *value) { |
wataloh | 0:20bce0dcc921 | 122 | for (int i = 0; i < (int) (strlen(valueStr) / 2); i++) { |
wataloh | 0:20bce0dcc921 | 123 | int j = i * 2; |
wataloh | 0:20bce0dcc921 | 124 | value[i] = getVal(valueStr[j + 1]) + (getVal(valueStr[j]) << 4); |
wataloh | 0:20bce0dcc921 | 125 | } |
wataloh | 0:20bce0dcc921 | 126 | |
wataloh | 0:20bce0dcc921 | 127 | return 0; |
wataloh | 0:20bce0dcc921 | 128 | } |
wataloh | 0:20bce0dcc921 | 129 | |
wataloh | 0:20bce0dcc921 | 130 | uint16_t Command::strToAttrId(char *attrIdStr) { |
wataloh | 0:20bce0dcc921 | 131 | return atoi(attrIdStr); |
wataloh | 0:20bce0dcc921 | 132 | //return String(attrIdStr).toInt(); |
wataloh | 0:20bce0dcc921 | 133 | } |
wataloh | 0:20bce0dcc921 | 134 | |
wataloh | 0:20bce0dcc921 | 135 | uint8_t Command::strToCmd(char *cmdStr) { |
wataloh | 0:20bce0dcc921 | 136 | char c = cmdStr[0]; |
wataloh | 0:20bce0dcc921 | 137 | if (c == 'g' || c == 'G') { |
wataloh | 0:20bce0dcc921 | 138 | return MSG_TYPE_GET; |
wataloh | 0:20bce0dcc921 | 139 | } else if (c == 's' || c == 'S') { |
wataloh | 0:20bce0dcc921 | 140 | return MSG_TYPE_SET; |
wataloh | 0:20bce0dcc921 | 141 | } else if (c == 'u' || c == 'U') { |
wataloh | 0:20bce0dcc921 | 142 | return MSG_TYPE_UPDATE; |
wataloh | 0:20bce0dcc921 | 143 | } |
wataloh | 0:20bce0dcc921 | 144 | |
wataloh | 0:20bce0dcc921 | 145 | return -1; |
wataloh | 0:20bce0dcc921 | 146 | } |
wataloh | 0:20bce0dcc921 | 147 | |
wataloh | 0:20bce0dcc921 | 148 | uint8_t Command::getCommand() { |
wataloh | 0:20bce0dcc921 | 149 | return _cmd; |
wataloh | 0:20bce0dcc921 | 150 | } |
wataloh | 0:20bce0dcc921 | 151 | |
wataloh | 0:20bce0dcc921 | 152 | uint8_t Command::getReqId() { |
wataloh | 0:20bce0dcc921 | 153 | return _requestId; |
wataloh | 0:20bce0dcc921 | 154 | } |
wataloh | 0:20bce0dcc921 | 155 | |
wataloh | 0:20bce0dcc921 | 156 | uint16_t Command::getAttrId() { |
wataloh | 0:20bce0dcc921 | 157 | return _attrId; |
wataloh | 0:20bce0dcc921 | 158 | } |
wataloh | 0:20bce0dcc921 | 159 | |
wataloh | 0:20bce0dcc921 | 160 | uint16_t Command::getValueLen() { |
wataloh | 0:20bce0dcc921 | 161 | return _valueLen; |
wataloh | 0:20bce0dcc921 | 162 | } |
wataloh | 0:20bce0dcc921 | 163 | |
wataloh | 0:20bce0dcc921 | 164 | void Command::getValue(uint8_t *value) { |
wataloh | 0:20bce0dcc921 | 165 | for (int i = 0; i < _valueLen; i++) { |
wataloh | 0:20bce0dcc921 | 166 | value[i] = _value[i]; |
wataloh | 0:20bce0dcc921 | 167 | } |
wataloh | 0:20bce0dcc921 | 168 | } |
wataloh | 0:20bce0dcc921 | 169 | |
wataloh | 0:20bce0dcc921 | 170 | uint8_t *Command::getValueP() { |
wataloh | 0:20bce0dcc921 | 171 | return _value; |
wataloh | 0:20bce0dcc921 | 172 | } |
wataloh | 0:20bce0dcc921 | 173 | |
wataloh | 0:20bce0dcc921 | 174 | uint16_t Command::getSize() { |
wataloh | 0:20bce0dcc921 | 175 | uint16_t len = CMD_HDR_LEN; |
wataloh | 0:20bce0dcc921 | 176 | |
wataloh | 0:20bce0dcc921 | 177 | if (_cmd != MSG_TYPE_GET) { |
wataloh | 0:20bce0dcc921 | 178 | len += CMD_VAL_LEN + _valueLen; |
wataloh | 0:20bce0dcc921 | 179 | } |
wataloh | 0:20bce0dcc921 | 180 | |
wataloh | 0:20bce0dcc921 | 181 | if (_cmd == MSG_TYPE_UPDATE) { |
wataloh | 0:20bce0dcc921 | 182 | len += 2; // status byte + reason byte |
wataloh | 0:20bce0dcc921 | 183 | } |
wataloh | 0:20bce0dcc921 | 184 | |
wataloh | 0:20bce0dcc921 | 185 | return len; |
wataloh | 0:20bce0dcc921 | 186 | } |
wataloh | 0:20bce0dcc921 | 187 | |
wataloh | 0:20bce0dcc921 | 188 | uint16_t Command::getBytes(uint8_t *bytes) { |
wataloh | 0:20bce0dcc921 | 189 | uint16_t len = getSize(); |
wataloh | 0:20bce0dcc921 | 190 | |
wataloh | 0:20bce0dcc921 | 191 | int index = 0; |
wataloh | 0:20bce0dcc921 | 192 | |
wataloh | 0:20bce0dcc921 | 193 | bytes[index++] = (_cmd); |
wataloh | 0:20bce0dcc921 | 194 | |
wataloh | 0:20bce0dcc921 | 195 | bytes[index++] = (_requestId); |
wataloh | 0:20bce0dcc921 | 196 | |
wataloh | 0:20bce0dcc921 | 197 | bytes[index++] = (_attrId & 0xff); |
wataloh | 0:20bce0dcc921 | 198 | bytes[index++] = ((_attrId >> 8) & 0xff); |
wataloh | 0:20bce0dcc921 | 199 | |
wataloh | 0:20bce0dcc921 | 200 | if (_cmd == MSG_TYPE_GET) { |
wataloh | 0:20bce0dcc921 | 201 | return len; |
wataloh | 0:20bce0dcc921 | 202 | } |
wataloh | 0:20bce0dcc921 | 203 | |
wataloh | 0:20bce0dcc921 | 204 | if (_cmd == MSG_TYPE_UPDATE) { |
wataloh | 0:20bce0dcc921 | 205 | bytes[index++] = (_status); |
wataloh | 0:20bce0dcc921 | 206 | bytes[index++] = (_reason); |
wataloh | 0:20bce0dcc921 | 207 | } |
wataloh | 0:20bce0dcc921 | 208 | |
wataloh | 0:20bce0dcc921 | 209 | bytes[index++] = (_valueLen & 0xff); |
wataloh | 0:20bce0dcc921 | 210 | bytes[index++] = ((_valueLen >> 8) & 0xff); |
wataloh | 0:20bce0dcc921 | 211 | |
wataloh | 0:20bce0dcc921 | 212 | for (int i = 0; i < _valueLen; i++) { |
wataloh | 0:20bce0dcc921 | 213 | bytes[index++] = (_value[i]); |
wataloh | 0:20bce0dcc921 | 214 | } |
wataloh | 0:20bce0dcc921 | 215 | |
wataloh | 0:20bce0dcc921 | 216 | return len; |
wataloh | 0:20bce0dcc921 | 217 | } |
wataloh | 0:20bce0dcc921 | 218 | |
wataloh | 0:20bce0dcc921 | 219 | bool Command::isValid() { |
wataloh | 0:20bce0dcc921 | 220 | return (_cmd == MSG_TYPE_SET) || (_cmd == MSG_TYPE_GET) || (_cmd == MSG_TYPE_UPDATE); |
wataloh | 0:20bce0dcc921 | 221 | } |
wataloh | 0:20bce0dcc921 | 222 | |
wataloh | 0:20bce0dcc921 | 223 | void Command::dumpBytes() { |
wataloh | 0:20bce0dcc921 | 224 | uint16_t len = getSize(); |
wataloh | 0:20bce0dcc921 | 225 | uint8_t bytes[len]; |
wataloh | 0:20bce0dcc921 | 226 | getBytes(bytes); |
wataloh | 0:20bce0dcc921 | 227 | |
wataloh | 0:20bce0dcc921 | 228 | _printBuf[0] = 0; |
wataloh | 0:20bce0dcc921 | 229 | sprintf(_printBuf, "len: %d value: ", len); |
wataloh | 0:20bce0dcc921 | 230 | for (int i = 0; i < len; i++) { |
wataloh | 0:20bce0dcc921 | 231 | int b = bytes[i] & 0xff; |
wataloh | 0:20bce0dcc921 | 232 | sprintf(&_printBuf[strlen(_printBuf)], "%02x", b); |
wataloh | 0:20bce0dcc921 | 233 | } |
wataloh | 1:b2a9a6f2c30e | 234 | SERIAL_PRINT_DBG_ASR("%s\n",_printBuf); |
wataloh | 0:20bce0dcc921 | 235 | } |
wataloh | 0:20bce0dcc921 | 236 | |
wataloh | 0:20bce0dcc921 | 237 | void Command::dump() { |
wataloh | 0:20bce0dcc921 | 238 | _printBuf[0] = 0; |
wataloh | 0:20bce0dcc921 | 239 | sprintf(_printBuf, "cmd: %s attr: %d value: ", |
wataloh | 0:20bce0dcc921 | 240 | CMD_NAMES[_cmd - MESSAGE_CHANNEL_BASE - 1], |
wataloh | 0:20bce0dcc921 | 241 | _attrId |
wataloh | 0:20bce0dcc921 | 242 | ); |
wataloh | 0:20bce0dcc921 | 243 | if (_cmd != MSG_TYPE_GET) { |
wataloh | 0:20bce0dcc921 | 244 | for (int i = 0; i < _valueLen; i++) { |
wataloh | 0:20bce0dcc921 | 245 | int b = _value[i] & 0xff; |
wataloh | 0:20bce0dcc921 | 246 | sprintf(&_printBuf[strlen(_printBuf)], "%02x", b); |
wataloh | 0:20bce0dcc921 | 247 | } |
wataloh | 0:20bce0dcc921 | 248 | } |
wataloh | 1:b2a9a6f2c30e | 249 | SERIAL_PRINT_DBG_ASR("%s\n",_printBuf); |
wataloh | 0:20bce0dcc921 | 250 | } |
wataloh | 0:20bce0dcc921 | 251 | |
wataloh | 0:20bce0dcc921 | 252 | uint8_t Command::getVal(char c) { |
wataloh | 0:20bce0dcc921 | 253 | if (c >= '0' && c <= '9') |
wataloh | 0:20bce0dcc921 | 254 | return (uint8_t)(c - '0'); |
wataloh | 0:20bce0dcc921 | 255 | else if (c >= 'A' && c <= 'F') |
wataloh | 0:20bce0dcc921 | 256 | return (uint8_t)(c - 'A' + 10); |
wataloh | 0:20bce0dcc921 | 257 | else if (c >= 'a' && c <= 'f') |
wataloh | 0:20bce0dcc921 | 258 | return (uint8_t)(c - 'a' + 10); |
wataloh | 0:20bce0dcc921 | 259 | |
wataloh | 0:20bce0dcc921 | 260 | SERIAL_PRINT_ERR("bad hex char: %c\n",c); |
wataloh | 0:20bce0dcc921 | 261 | |
wataloh | 0:20bce0dcc921 | 262 | return 0; |
wataloh | 0:20bce0dcc921 | 263 | } |