Initial release
main.cpp@8:be1ae533ab8c, 2018-12-14 (annotated)
- Committer:
- masakjm
- Date:
- Fri Dec 14 18:40:09 2018 +0000
- Revision:
- 8:be1ae533ab8c
- Parent:
- 6:e2074d02065b
Initial release
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
masakjm | 0:28fb3e9ef81a | 1 | //================================= |
masakjm | 6:e2074d02065b | 2 | // microbit_switch_if_wear |
masakjm | 0:28fb3e9ef81a | 3 | //================================= |
masakjm | 6:e2074d02065b | 4 | // A wearable BLE switch interface using micro bits |
masakjm | 0:28fb3e9ef81a | 5 | // It is intended for use with ios devices. |
masakjm | 0:28fb3e9ef81a | 6 | // |
masakjm | 0:28fb3e9ef81a | 7 | // The MIT License (MIT) Copyright (c) 2018 Masatomo Kojima |
masakjm | 0:28fb3e9ef81a | 8 | // |
masakjm | 0:28fb3e9ef81a | 9 | // LED message |
masakjm | 0:28fb3e9ef81a | 10 | // S key code setting sw1,2 |
masakjm | 0:28fb3e9ef81a | 11 | // C Conected |
masakjm | 0:28fb3e9ef81a | 12 | // P success Pearing |
masakjm | 0:28fb3e9ef81a | 13 | // F Fail pearing |
masakjm | 0:28fb3e9ef81a | 14 | // E Error at sending data by ble |
masakjm | 0:28fb3e9ef81a | 15 | // e Error at writting data to flash memory |
masakjm | 0:28fb3e9ef81a | 16 | // I Error by Incorrect cording |
masakjm | 0:28fb3e9ef81a | 17 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 18 | |
masakjm | 6:e2074d02065b | 19 | #define VERSION "WER-181214" |
masakjm | 0:28fb3e9ef81a | 20 | //#define NO_DEBUG |
masakjm | 0:28fb3e9ef81a | 21 | |
masakjm | 6:e2074d02065b | 22 | #include "microbit_switch_if_wear.h" |
masakjm | 0:28fb3e9ef81a | 23 | #include "KeyValueInt.h" |
masakjm | 0:28fb3e9ef81a | 24 | |
masakjm | 0:28fb3e9ef81a | 25 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 26 | // Display |
masakjm | 0:28fb3e9ef81a | 27 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 28 | MicroBitDisplay display; |
masakjm | 3:b6e9850d3e76 | 29 | int state; // 状態遷移 |
masakjm | 0:28fb3e9ef81a | 30 | char dispChar = 0; // LEDに表示する文字コード |
masakjm | 0:28fb3e9ef81a | 31 | char dispCharLast = 0; // 最後に表示した文字コード |
masakjm | 0:28fb3e9ef81a | 32 | bool turnOffMode = false; // LED非表示モードのフラグ |
masakjm | 0:28fb3e9ef81a | 33 | |
masakjm | 3:b6e9850d3e76 | 34 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 35 | * @brief 整数値をLEDに表示する |
masakjm | 3:b6e9850d3e76 | 36 | * @param data 整数値 |
masakjm | 3:b6e9850d3e76 | 37 | */ |
masakjm | 0:28fb3e9ef81a | 38 | static void displayNumber(int data) |
masakjm | 0:28fb3e9ef81a | 39 | { |
masakjm | 0:28fb3e9ef81a | 40 | if (0<=data && data<=9) { // 1桁はスクロールしない |
masakjm | 0:28fb3e9ef81a | 41 | display.print(data); |
masakjm | 0:28fb3e9ef81a | 42 | } else { |
masakjm | 0:28fb3e9ef81a | 43 | display.scroll(data); |
masakjm | 0:28fb3e9ef81a | 44 | } |
masakjm | 0:28fb3e9ef81a | 45 | } |
masakjm | 0:28fb3e9ef81a | 46 | |
masakjm | 0:28fb3e9ef81a | 47 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 48 | // Flash Memory |
masakjm | 0:28fb3e9ef81a | 49 | //--------------------------------- |
masakjm | 3:b6e9850d3e76 | 50 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 51 | * @brief キー名を指定して不揮発メモリから値を読み出す |
masakjm | 3:b6e9850d3e76 | 52 | * @param key キー名 |
masakjm | 3:b6e9850d3e76 | 53 | * @param init データが保存されていなかった時の初期値 |
masakjm | 3:b6e9850d3e76 | 54 | * @return int 取得したデータ |
masakjm | 3:b6e9850d3e76 | 55 | */ |
masakjm | 0:28fb3e9ef81a | 56 | static int FlashGet(MicroBitStorage storage, const char* key, int init=0) |
masakjm | 0:28fb3e9ef81a | 57 | { |
masakjm | 0:28fb3e9ef81a | 58 | KeyValuePair* kvp = storage.get(key); |
masakjm | 0:28fb3e9ef81a | 59 | if(kvp != NULL) { |
masakjm | 0:28fb3e9ef81a | 60 | int data; |
masakjm | 0:28fb3e9ef81a | 61 | memcpy(&data, kvp->value, sizeof(int)); |
masakjm | 0:28fb3e9ef81a | 62 | DEBUG("== FlashGet exist %s = %d\r\n", key, data); |
masakjm | 0:28fb3e9ef81a | 63 | return data; |
masakjm | 0:28fb3e9ef81a | 64 | } |
masakjm | 0:28fb3e9ef81a | 65 | return init; |
masakjm | 0:28fb3e9ef81a | 66 | } |
masakjm | 0:28fb3e9ef81a | 67 | |
masakjm | 3:b6e9850d3e76 | 68 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 69 | * @brief 不揮発メモリに値を書き込む |
masakjm | 3:b6e9850d3e76 | 70 | * @param storage 不揮発メモリインスタンス |
masakjm | 3:b6e9850d3e76 | 71 | * @param key キー名 |
masakjm | 3:b6e9850d3e76 | 72 | * @param data 値 |
masakjm | 3:b6e9850d3e76 | 73 | * @return int MICROBIT_OK = 0 |
masakjm | 3:b6e9850d3e76 | 74 | * MICROBIT_INVALID_PARAMETER = -1001, |
masakjm | 3:b6e9850d3e76 | 75 | * MICROBIT_NO_RESOURCES = -1005, |
masakjm | 3:b6e9850d3e76 | 76 | */ |
masakjm | 0:28fb3e9ef81a | 77 | static int FlashPut(MicroBitStorage storage, const char* key, int data) |
masakjm | 0:28fb3e9ef81a | 78 | { |
masakjm | 0:28fb3e9ef81a | 79 | int ret = storage.put(key, (uint8_t *)&data, sizeof(int)); |
masakjm | 0:28fb3e9ef81a | 80 | DEBUG("== FlashPut %s %d %d\r\n", key, data, ret); |
masakjm | 0:28fb3e9ef81a | 81 | return ret; |
masakjm | 0:28fb3e9ef81a | 82 | } |
masakjm | 0:28fb3e9ef81a | 83 | |
masakjm | 0:28fb3e9ef81a | 84 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 85 | // Setting |
masakjm | 0:28fb3e9ef81a | 86 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 87 | bool setting_inc; // 設定値を増加 |
masakjm | 0:28fb3e9ef81a | 88 | bool setting_enter; // 設定値を入力 |
masakjm | 0:28fb3e9ef81a | 89 | bool setting_next; // 次の設定値に移動 |
masakjm | 0:28fb3e9ef81a | 90 | |
masakjm | 0:28fb3e9ef81a | 91 | KeyValueInt kviKeyCode1("keycode1",'S', 1, 1, NUM_GROUP1, true); |
masakjm | 0:28fb3e9ef81a | 92 | |
masakjm | 3:b6e9850d3e76 | 93 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 94 | * @brief 1つのパラメータの表示と変更 |
masakjm | 3:b6e9850d3e76 | 95 | * @param storage 不揮発メモリインスタンス |
masakjm | 3:b6e9850d3e76 | 96 | * @param para パラメータのキーと値の組 |
masakjm | 3:b6e9850d3e76 | 97 | * @param change 変更する時 true |
masakjm | 3:b6e9850d3e76 | 98 | * @return bool true : Success false : Failed |
masakjm | 3:b6e9850d3e76 | 99 | */ |
masakjm | 3:b6e9850d3e76 | 100 | static bool paraSettingOne(MicroBitStorage storage, KeyValueInt* para, bool change) |
masakjm | 0:28fb3e9ef81a | 101 | { |
masakjm | 0:28fb3e9ef81a | 102 | display.print(para->disp); // 識別文字をLED表示 |
masakjm | 0:28fb3e9ef81a | 103 | wait(SETTING_DISPLAY_WAIT); |
masakjm | 0:28fb3e9ef81a | 104 | displayNumber(para->value); // 値をLED表示 |
masakjm | 0:28fb3e9ef81a | 105 | if (!change) { |
masakjm | 0:28fb3e9ef81a | 106 | wait(SETTING_DISPLAY_WAIT); |
masakjm | 3:b6e9850d3e76 | 107 | return true; |
masakjm | 0:28fb3e9ef81a | 108 | } |
masakjm | 0:28fb3e9ef81a | 109 | |
masakjm | 0:28fb3e9ef81a | 110 | DEBUG("== paraSetting\r\n"); |
masakjm | 0:28fb3e9ef81a | 111 | setting_inc = false; |
masakjm | 0:28fb3e9ef81a | 112 | setting_next = setting_enter = false; |
masakjm | 0:28fb3e9ef81a | 113 | while( ! setting_next) { // Bボタンが離されるまで |
masakjm | 0:28fb3e9ef81a | 114 | if (setting_inc) { // Aボタンが押されたら |
masakjm | 0:28fb3e9ef81a | 115 | setting_inc = false; |
masakjm | 0:28fb3e9ef81a | 116 | para->inc(); |
masakjm | 0:28fb3e9ef81a | 117 | displayNumber(para->value); |
masakjm | 0:28fb3e9ef81a | 118 | } |
masakjm | 0:28fb3e9ef81a | 119 | wait(0.2); |
masakjm | 0:28fb3e9ef81a | 120 | } |
masakjm | 3:b6e9850d3e76 | 121 | int ret = FlashPut(storage, para->key, para->value); |
masakjm | 3:b6e9850d3e76 | 122 | if (ret) DEBUG("(strage)Error %d\r\n",ret); |
masakjm | 3:b6e9850d3e76 | 123 | return (ret == MICROBIT_OK); |
masakjm | 0:28fb3e9ef81a | 124 | } |
masakjm | 0:28fb3e9ef81a | 125 | |
masakjm | 3:b6e9850d3e76 | 126 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 127 | * @brief パラメータの表示と変更 |
masakjm | 3:b6e9850d3e76 | 128 | * @param change true:変更する時 |
masakjm | 3:b6e9850d3e76 | 129 | */ |
masakjm | 3:b6e9850d3e76 | 130 | static bool paraSetting(bool change=false) |
masakjm | 0:28fb3e9ef81a | 131 | { |
masakjm | 0:28fb3e9ef81a | 132 | MicroBitStorage storage; |
masakjm | 0:28fb3e9ef81a | 133 | |
masakjm | 0:28fb3e9ef81a | 134 | kviKeyCode1.set(FlashGet(storage, kviKeyCode1.key, 1)); |
masakjm | 6:e2074d02065b | 135 | return paraSettingOne(storage, &kviKeyCode1, change); |
masakjm | 0:28fb3e9ef81a | 136 | } |
masakjm | 0:28fb3e9ef81a | 137 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 138 | // BLE & HID |
masakjm | 0:28fb3e9ef81a | 139 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 140 | BLE ble; |
masakjm | 0:28fb3e9ef81a | 141 | KeyboardService *kbdServicePtr; |
masakjm | 3:b6e9850d3e76 | 142 | BLE_MESSAGE bleMessage; |
masakjm | 0:28fb3e9ef81a | 143 | |
masakjm | 3:b6e9850d3e76 | 144 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 145 | * @brief BLE接続が切断された時のコールバック関数 |
masakjm | 3:b6e9850d3e76 | 146 | */ |
masakjm | 0:28fb3e9ef81a | 147 | static void onDisconnect(const Gap::DisconnectionCallbackParams_t *params) |
masakjm | 0:28fb3e9ef81a | 148 | { |
masakjm | 0:28fb3e9ef81a | 149 | DEBUG("(BLE)disconnected\r\n"); |
masakjm | 0:28fb3e9ef81a | 150 | ble.gap().startAdvertising(); // restart advertising |
masakjm | 3:b6e9850d3e76 | 151 | bleMessage = BLE_NO_MESSAGE; |
masakjm | 0:28fb3e9ef81a | 152 | } |
masakjm | 0:28fb3e9ef81a | 153 | |
masakjm | 3:b6e9850d3e76 | 154 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 155 | * @brief BLE接続が接続された時のコールバック関数 |
masakjm | 3:b6e9850d3e76 | 156 | */ |
masakjm | 0:28fb3e9ef81a | 157 | static void onConnect(const Gap::ConnectionCallbackParams_t *params) |
masakjm | 0:28fb3e9ef81a | 158 | { |
masakjm | 0:28fb3e9ef81a | 159 | if(kbdServicePtr->isConnected()) { |
masakjm | 0:28fb3e9ef81a | 160 | DEBUG("(BLE)connected\r\n"); |
masakjm | 3:b6e9850d3e76 | 161 | ble.gap().stopAdvertising(); |
masakjm | 3:b6e9850d3e76 | 162 | bleMessage = BLE_CONNECTED; |
masakjm | 0:28fb3e9ef81a | 163 | } |
masakjm | 0:28fb3e9ef81a | 164 | } |
masakjm | 0:28fb3e9ef81a | 165 | |
masakjm | 3:b6e9850d3e76 | 166 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 167 | * @brief パスキー入力を求められた時のコールバック関数 |
masakjm | 3:b6e9850d3e76 | 168 | */ |
masakjm | 0:28fb3e9ef81a | 169 | static void passkeyDisplayCallback(Gap::Handle_t handle, const SecurityManager::Passkey_t passkey) |
masakjm | 0:28fb3e9ef81a | 170 | { |
masakjm | 0:28fb3e9ef81a | 171 | printf("(BLE)Input passKey: "); |
masakjm | 0:28fb3e9ef81a | 172 | for (unsigned i = 0; i < Gap::ADDR_LEN; i++) { |
masakjm | 0:28fb3e9ef81a | 173 | printf("%c", passkey[i]); |
masakjm | 0:28fb3e9ef81a | 174 | } |
masakjm | 0:28fb3e9ef81a | 175 | printf("\r\n"); |
masakjm | 0:28fb3e9ef81a | 176 | } |
masakjm | 0:28fb3e9ef81a | 177 | |
masakjm | 3:b6e9850d3e76 | 178 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 179 | * @brief セキュリティ設定完了時のコールバック関数 |
masakjm | 3:b6e9850d3e76 | 180 | */ |
masakjm | 0:28fb3e9ef81a | 181 | static void securitySetupCompletedCallback(Gap::Handle_t handle, SecurityManager::SecurityCompletionStatus_t status) |
masakjm | 0:28fb3e9ef81a | 182 | { |
masakjm | 0:28fb3e9ef81a | 183 | if (status == SecurityManager::SEC_STATUS_SUCCESS) { |
masakjm | 0:28fb3e9ef81a | 184 | // DEBUG("(BLE)Security success %d\r\n", status); |
masakjm | 3:b6e9850d3e76 | 185 | bleMessage = BLE_PAIRING_SUCCESS; |
masakjm | 0:28fb3e9ef81a | 186 | |
masakjm | 0:28fb3e9ef81a | 187 | } else { |
masakjm | 0:28fb3e9ef81a | 188 | // DEBUG("(BLE)Security failed %d\r\n", status); |
masakjm | 3:b6e9850d3e76 | 189 | bleMessage = BLE_PAIRING_FAILED; |
masakjm | 0:28fb3e9ef81a | 190 | } |
masakjm | 0:28fb3e9ef81a | 191 | } |
masakjm | 0:28fb3e9ef81a | 192 | |
masakjm | 3:b6e9850d3e76 | 193 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 194 | * @brief セキュリティ初期化 |
masakjm | 3:b6e9850d3e76 | 195 | * @para _ble BLEインスタンス |
masakjm | 3:b6e9850d3e76 | 196 | */ |
masakjm | 3:b6e9850d3e76 | 197 | static void initializeSecurity(BLE &_ble) |
masakjm | 0:28fb3e9ef81a | 198 | { |
masakjm | 0:28fb3e9ef81a | 199 | bool enableBonding = true; |
masakjm | 0:28fb3e9ef81a | 200 | bool requireMITM = HID_SECURITY_REQUIRE_MITM; |
masakjm | 0:28fb3e9ef81a | 201 | |
masakjm | 3:b6e9850d3e76 | 202 | _ble.securityManager().onPasskeyDisplay(passkeyDisplayCallback); |
masakjm | 3:b6e9850d3e76 | 203 | _ble.securityManager().onSecuritySetupCompleted(securitySetupCompletedCallback); |
masakjm | 0:28fb3e9ef81a | 204 | |
masakjm | 3:b6e9850d3e76 | 205 | _ble.securityManager().init(enableBonding, requireMITM, HID_SECURITY_IOCAPS); |
masakjm | 0:28fb3e9ef81a | 206 | } |
masakjm | 0:28fb3e9ef81a | 207 | |
masakjm | 3:b6e9850d3e76 | 208 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 209 | * @brief HOGP (HID Over GATT Profile) 初期化 |
masakjm | 3:b6e9850d3e76 | 210 | * @para _ble BLEインスタンス |
masakjm | 3:b6e9850d3e76 | 211 | */ |
masakjm | 3:b6e9850d3e76 | 212 | static void initializeHOGP(BLE &_ble) |
masakjm | 0:28fb3e9ef81a | 213 | { |
masakjm | 0:28fb3e9ef81a | 214 | static const uint16_t uuid16_list[] = {GattService::UUID_HUMAN_INTERFACE_DEVICE_SERVICE, |
masakjm | 0:28fb3e9ef81a | 215 | GattService::UUID_DEVICE_INFORMATION_SERVICE, |
masakjm | 0:28fb3e9ef81a | 216 | GattService::UUID_BATTERY_SERVICE |
masakjm | 0:28fb3e9ef81a | 217 | }; |
masakjm | 0:28fb3e9ef81a | 218 | |
masakjm | 0:28fb3e9ef81a | 219 | PnPID_t pnpID; |
masakjm | 0:28fb3e9ef81a | 220 | pnpID.vendorID_source = 0x2; // from the USB Implementer's Forum |
masakjm | 0:28fb3e9ef81a | 221 | pnpID.vendorID = 0x0D28; // NXP |
masakjm | 0:28fb3e9ef81a | 222 | pnpID.productID = 0x0204; // CMSIS-DAP (well, it's a keyboard but oh well) |
masakjm | 0:28fb3e9ef81a | 223 | pnpID.productVersion = 0x0100; // v1.0 |
masakjm | 3:b6e9850d3e76 | 224 | HIDDeviceInformationService deviceInfo(_ble, "ARM", "m1", "abc", "def", "ghi", "jkl", &pnpID); |
masakjm | 0:28fb3e9ef81a | 225 | |
masakjm | 3:b6e9850d3e76 | 226 | BatteryService batteryInfo(_ble, 80); |
masakjm | 0:28fb3e9ef81a | 227 | |
masakjm | 3:b6e9850d3e76 | 228 | _ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | |
masakjm | 0:28fb3e9ef81a | 229 | GapAdvertisingData::LE_GENERAL_DISCOVERABLE); |
masakjm | 3:b6e9850d3e76 | 230 | _ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, |
masakjm | 0:28fb3e9ef81a | 231 | (uint8_t *)uuid16_list, sizeof(uuid16_list)); |
masakjm | 0:28fb3e9ef81a | 232 | |
masakjm | 0:28fb3e9ef81a | 233 | // see 5.1.2: HID over GATT Specification (pg. 25) |
masakjm | 3:b6e9850d3e76 | 234 | _ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); |
masakjm | 0:28fb3e9ef81a | 235 | // 30ms to 50ms is recommended (5.1.2) |
masakjm | 3:b6e9850d3e76 | 236 | _ble.gap().setAdvertisingInterval(50); |
masakjm | 0:28fb3e9ef81a | 237 | } |
masakjm | 0:28fb3e9ef81a | 238 | |
masakjm | 3:b6e9850d3e76 | 239 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 240 | * @brief BLE接続のHID(human interface device) の初期化 |
masakjm | 3:b6e9850d3e76 | 241 | */ |
masakjm | 0:28fb3e9ef81a | 242 | static void initialize_BLE_HID() |
masakjm | 0:28fb3e9ef81a | 243 | { |
masakjm | 0:28fb3e9ef81a | 244 | static const char SHORT_DEVICE_NAME[] = "micro:bit"; |
masakjm | 0:28fb3e9ef81a | 245 | static char DeviceName[20]; |
masakjm | 0:28fb3e9ef81a | 246 | |
masakjm | 0:28fb3e9ef81a | 247 | int id = microbit_serial_number()& 0xfff; // シリアル番号の下12桁を4桁の10進で表示 |
masakjm | 0:28fb3e9ef81a | 248 | sprintf(DeviceName, "micro:bit %04d", id); |
masakjm | 0:28fb3e9ef81a | 249 | DEBUG("(BLE)id %s\r\n", DeviceName); |
masakjm | 0:28fb3e9ef81a | 250 | |
masakjm | 0:28fb3e9ef81a | 251 | // DEBUG("(BLE)initialising ble\r\n"); |
masakjm | 0:28fb3e9ef81a | 252 | ble.init(); |
masakjm | 0:28fb3e9ef81a | 253 | |
masakjm | 0:28fb3e9ef81a | 254 | ble.gap().onDisconnection(onDisconnect); |
masakjm | 0:28fb3e9ef81a | 255 | ble.gap().onConnection(onConnect); |
masakjm | 0:28fb3e9ef81a | 256 | |
masakjm | 0:28fb3e9ef81a | 257 | initializeSecurity(ble); |
masakjm | 0:28fb3e9ef81a | 258 | |
masakjm | 0:28fb3e9ef81a | 259 | DEBUG("(BLE)adding hid service\r\n"); |
masakjm | 0:28fb3e9ef81a | 260 | KeyboardService kbdService(ble); |
masakjm | 0:28fb3e9ef81a | 261 | kbdServicePtr = &kbdService; |
masakjm | 0:28fb3e9ef81a | 262 | |
masakjm | 0:28fb3e9ef81a | 263 | DEBUG("(BLE)adding device info and battery service\r\n"); |
masakjm | 0:28fb3e9ef81a | 264 | initializeHOGP(ble); |
masakjm | 0:28fb3e9ef81a | 265 | |
masakjm | 0:28fb3e9ef81a | 266 | DEBUG("(BLE)setting up gap\r\n"); |
masakjm | 0:28fb3e9ef81a | 267 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::KEYBOARD); |
masakjm | 0:28fb3e9ef81a | 268 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, |
masakjm | 0:28fb3e9ef81a | 269 | (uint8_t *)DeviceName, sizeof(DeviceName)); |
masakjm | 0:28fb3e9ef81a | 270 | ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME, |
masakjm | 0:28fb3e9ef81a | 271 | (uint8_t *)SHORT_DEVICE_NAME, sizeof(SHORT_DEVICE_NAME)); |
masakjm | 0:28fb3e9ef81a | 272 | ble.gap().setDeviceName((const uint8_t *)DeviceName); |
masakjm | 0:28fb3e9ef81a | 273 | |
masakjm | 0:28fb3e9ef81a | 274 | DEBUG("(BLE)advertising\r\n"); |
masakjm | 0:28fb3e9ef81a | 275 | ble.gap().startAdvertising(); |
masakjm | 0:28fb3e9ef81a | 276 | } |
masakjm | 0:28fb3e9ef81a | 277 | |
masakjm | 0:28fb3e9ef81a | 278 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 279 | // Button |
masakjm | 0:28fb3e9ef81a | 280 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 281 | MicroBitMessageBus bus; |
masakjm | 0:28fb3e9ef81a | 282 | MicroBitButton buttonA(MICROBIT_PIN_BUTTON_A, MICROBIT_ID_BUTTON_A); |
masakjm | 0:28fb3e9ef81a | 283 | MicroBitButton buttonB(MICROBIT_PIN_BUTTON_B, MICROBIT_ID_BUTTON_B); |
masakjm | 6:e2074d02065b | 284 | //MicroBitPin P0(MICROBIT_ID_IO_P0, MICROBIT_PIN_P0, PIN_CAPABILITY_ALL); |
masakjm | 6:e2074d02065b | 285 | //MicroBitPin P1(MICROBIT_ID_IO_P1, MICROBIT_PIN_P1, PIN_CAPABILITY_ALL); |
masakjm | 6:e2074d02065b | 286 | //MicroBitPin P2(MICROBIT_ID_IO_P2, MICROBIT_PIN_P2, PIN_CAPABILITY_ALL); |
masakjm | 4:4fe5674bf409 | 287 | |
masakjm | 6:e2074d02065b | 288 | MicroBitButton button0(MICROBIT_PIN_P0, MICROBIT_ID_IO_P0, MICROBIT_BUTTON_ALL_EVENTS, PullUp); |
masakjm | 6:e2074d02065b | 289 | MicroBitButton button1(MICROBIT_PIN_P1, MICROBIT_ID_IO_P1, MICROBIT_BUTTON_ALL_EVENTS, PullUp); |
masakjm | 6:e2074d02065b | 290 | MicroBitButton button2(MICROBIT_PIN_P2, MICROBIT_ID_IO_P2, MICROBIT_BUTTON_ALL_EVENTS, PullUp); |
masakjm | 0:28fb3e9ef81a | 291 | |
masakjm | 3:b6e9850d3e76 | 292 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 293 | * @brief キーコードを送信する |
masakjm | 3:b6e9850d3e76 | 294 | * @para code 上位8bit:修飾キー 下位8bit:キーコード |
masakjm | 3:b6e9850d3e76 | 295 | */ |
masakjm | 1:3b9ae1dbcdcf | 296 | static void sendKeyCode(int code) { |
masakjm | 1:3b9ae1dbcdcf | 297 | if (code) { |
masakjm | 1:3b9ae1dbcdcf | 298 | uint8_t key = code & 0xff; |
masakjm | 1:3b9ae1dbcdcf | 299 | uint8_t modif = code >> 8; |
masakjm | 1:3b9ae1dbcdcf | 300 | |
masakjm | 1:3b9ae1dbcdcf | 301 | if (key > KEYMAP_SIZE ) { |
masakjm | 1:3b9ae1dbcdcf | 302 | dispChar ='I'; // キーコード設定間違い |
masakjm | 1:3b9ae1dbcdcf | 303 | } else { |
masakjm | 1:3b9ae1dbcdcf | 304 | ble_error_t ret = kbdServicePtr->keyDownCode(key, modif); |
masakjm | 1:3b9ae1dbcdcf | 305 | // DEBUG(" code=%d modif=%d\r\n",key , modif); |
masakjm | 1:3b9ae1dbcdcf | 306 | if (ret) { |
masakjm | 1:3b9ae1dbcdcf | 307 | dispChar ='E'; |
masakjm | 1:3b9ae1dbcdcf | 308 | dispCharLast =0; // E が続く時に表示 |
masakjm | 1:3b9ae1dbcdcf | 309 | DEBUG("(BLE)Error %d\r\n",ret); |
masakjm | 1:3b9ae1dbcdcf | 310 | } |
masakjm | 1:3b9ae1dbcdcf | 311 | } |
masakjm | 1:3b9ae1dbcdcf | 312 | } |
masakjm | 1:3b9ae1dbcdcf | 313 | } |
masakjm | 3:b6e9850d3e76 | 314 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 315 | * @brief ボタン保持時イベント |
masakjm | 3:b6e9850d3e76 | 316 | * @para e イベント |
masakjm | 3:b6e9850d3e76 | 317 | */ |
masakjm | 1:3b9ae1dbcdcf | 318 | static void onButtonHold(MicroBitEvent e) |
masakjm | 1:3b9ae1dbcdcf | 319 | { |
masakjm | 1:3b9ae1dbcdcf | 320 | if ((e.source == MICROBIT_ID_BUTTON_A && buttonB.isPressed()) || |
masakjm | 1:3b9ae1dbcdcf | 321 | (e.source == MICROBIT_ID_BUTTON_B && buttonA.isPressed()) ) { |
masakjm | 1:3b9ae1dbcdcf | 322 | dispChar = 'H'; |
masakjm | 6:e2074d02065b | 323 | sendKeyCode(keyCodeGroup1[kviKeyCode1.value-1][2]); |
masakjm | 1:3b9ae1dbcdcf | 324 | } |
masakjm | 1:3b9ae1dbcdcf | 325 | } |
masakjm | 1:3b9ae1dbcdcf | 326 | |
masakjm | 3:b6e9850d3e76 | 327 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 328 | * @brief ボタン押下げ時イベント |
masakjm | 3:b6e9850d3e76 | 329 | * @para e イベント |
masakjm | 3:b6e9850d3e76 | 330 | */ |
masakjm | 0:28fb3e9ef81a | 331 | static void onButtonDown(MicroBitEvent e) |
masakjm | 0:28fb3e9ef81a | 332 | { |
masakjm | 4:4fe5674bf409 | 333 | // DEBUG(" Button Down %d state=%d\r\n", e.source, state); |
masakjm | 0:28fb3e9ef81a | 334 | |
masakjm | 0:28fb3e9ef81a | 335 | switch (state) { |
masakjm | 0:28fb3e9ef81a | 336 | case STATE_SETTING : |
masakjm | 0:28fb3e9ef81a | 337 | switch(e.source) { |
masakjm | 0:28fb3e9ef81a | 338 | case MICROBIT_ID_BUTTON_A : |
masakjm | 0:28fb3e9ef81a | 339 | setting_inc = true; |
masakjm | 0:28fb3e9ef81a | 340 | break; |
masakjm | 0:28fb3e9ef81a | 341 | case MICROBIT_ID_BUTTON_B : |
masakjm | 0:28fb3e9ef81a | 342 | setting_enter = true; |
masakjm | 0:28fb3e9ef81a | 343 | break; |
masakjm | 0:28fb3e9ef81a | 344 | } |
masakjm | 0:28fb3e9ef81a | 345 | break; |
masakjm | 0:28fb3e9ef81a | 346 | case STATE_OPERATING : |
masakjm | 1:3b9ae1dbcdcf | 347 | int code = 0; |
masakjm | 0:28fb3e9ef81a | 348 | switch(e.source) { |
masakjm | 0:28fb3e9ef81a | 349 | case MICROBIT_ID_BUTTON_A : |
masakjm | 0:28fb3e9ef81a | 350 | dispChar = 'A'; |
masakjm | 6:e2074d02065b | 351 | code = keyCodeGroup1[kviKeyCode1.value-1][0]; |
masakjm | 0:28fb3e9ef81a | 352 | break; |
masakjm | 0:28fb3e9ef81a | 353 | case MICROBIT_ID_BUTTON_B : |
masakjm | 0:28fb3e9ef81a | 354 | dispChar = 'B'; |
masakjm | 6:e2074d02065b | 355 | code = keyCodeGroup1[kviKeyCode1.value-1][1]; |
masakjm | 0:28fb3e9ef81a | 356 | break; |
masakjm | 6:e2074d02065b | 357 | // case MICROBIT_ID_IO_P0 : |
masakjm | 6:e2074d02065b | 358 | // dispChar = 'X'; |
masakjm | 6:e2074d02065b | 359 | // code = keyCodeGroup1[kviKeyCode1.value-1][X]; |
masakjm | 6:e2074d02065b | 360 | // break; |
masakjm | 6:e2074d02065b | 361 | case MICROBIT_ID_IO_P1 : |
masakjm | 0:28fb3e9ef81a | 362 | dispChar = '1'; |
masakjm | 0:28fb3e9ef81a | 363 | code = keyCodeGroup1[kviKeyCode1.value-1][0]; |
masakjm | 0:28fb3e9ef81a | 364 | break; |
masakjm | 6:e2074d02065b | 365 | case MICROBIT_ID_IO_P2 : |
masakjm | 0:28fb3e9ef81a | 366 | dispChar = '2'; |
masakjm | 0:28fb3e9ef81a | 367 | code = keyCodeGroup1[kviKeyCode1.value-1][1]; |
masakjm | 0:28fb3e9ef81a | 368 | break; |
masakjm | 0:28fb3e9ef81a | 369 | } |
masakjm | 1:3b9ae1dbcdcf | 370 | sendKeyCode(code); |
masakjm | 0:28fb3e9ef81a | 371 | } |
masakjm | 0:28fb3e9ef81a | 372 | } |
masakjm | 0:28fb3e9ef81a | 373 | |
masakjm | 3:b6e9850d3e76 | 374 | /** ---------- |
masakjm | 3:b6e9850d3e76 | 375 | * @brief ボタン離し時イベント |
masakjm | 3:b6e9850d3e76 | 376 | * @para e イベント |
masakjm | 3:b6e9850d3e76 | 377 | */ |
masakjm | 0:28fb3e9ef81a | 378 | static void onButtonUp(MicroBitEvent e) |
masakjm | 0:28fb3e9ef81a | 379 | { |
masakjm | 0:28fb3e9ef81a | 380 | // DEBUG(" Button up %d\r\n", e.source); |
masakjm | 0:28fb3e9ef81a | 381 | switch (state) { |
masakjm | 0:28fb3e9ef81a | 382 | case STATE_SETTING : |
masakjm | 0:28fb3e9ef81a | 383 | if(setting_enter) setting_next = true; // 決定ボタンを離したら次へ |
masakjm | 0:28fb3e9ef81a | 384 | break; |
masakjm | 0:28fb3e9ef81a | 385 | case STATE_OPERATING : |
masakjm | 0:28fb3e9ef81a | 386 | dispChar = 0; |
masakjm | 0:28fb3e9ef81a | 387 | ble_error_t ret = kbdServicePtr->keyUpCode(); |
masakjm | 0:28fb3e9ef81a | 388 | if (ret) { |
masakjm | 0:28fb3e9ef81a | 389 | dispChar ='E'; |
masakjm | 0:28fb3e9ef81a | 390 | dispCharLast =0; // E が続く時に表示 |
masakjm | 0:28fb3e9ef81a | 391 | } |
masakjm | 0:28fb3e9ef81a | 392 | } |
masakjm | 0:28fb3e9ef81a | 393 | } |
masakjm | 0:28fb3e9ef81a | 394 | |
masakjm | 0:28fb3e9ef81a | 395 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 396 | // Main |
masakjm | 0:28fb3e9ef81a | 397 | //--------------------------------- |
masakjm | 0:28fb3e9ef81a | 398 | int main() |
masakjm | 0:28fb3e9ef81a | 399 | { |
masakjm | 3:b6e9850d3e76 | 400 | state = STATE_DESABLE_INPUT; |
masakjm | 0:28fb3e9ef81a | 401 | |
masakjm | 0:28fb3e9ef81a | 402 | wait(0.1); // ボタン状態の更新 |
masakjm | 0:28fb3e9ef81a | 403 | bool bA = buttonA.isPressed(); |
masakjm | 0:28fb3e9ef81a | 404 | bool bB = buttonB.isPressed(); |
masakjm | 0:28fb3e9ef81a | 405 | |
masakjm | 0:28fb3e9ef81a | 406 | if (bA && bB) { // ボタンABを押しながら起動 |
masakjm | 3:b6e9850d3e76 | 407 | for(int i=0;i<3;i++) { |
masakjm | 0:28fb3e9ef81a | 408 | display.scroll(VERSION); |
masakjm | 0:28fb3e9ef81a | 409 | wait(0.5); |
masakjm | 0:28fb3e9ef81a | 410 | } |
masakjm | 0:28fb3e9ef81a | 411 | } else if(bA) // ボタンAを押しながら起動 |
masakjm | 0:28fb3e9ef81a | 412 | state = STATE_SETTING; |
masakjm | 0:28fb3e9ef81a | 413 | |
masakjm | 0:28fb3e9ef81a | 414 | //----- Display |
masakjm | 0:28fb3e9ef81a | 415 | display.setDisplayMode(DISPLAY_MODE_BLACK_AND_WHITE); |
masakjm | 0:28fb3e9ef81a | 416 | display.clear(); |
masakjm | 0:28fb3e9ef81a | 417 | Timer dispTime; // 連続表示タイマー |
masakjm | 0:28fb3e9ef81a | 418 | dispTime.start(); |
masakjm | 0:28fb3e9ef81a | 419 | |
masakjm | 0:28fb3e9ef81a | 420 | //----- Button |
masakjm | 0:28fb3e9ef81a | 421 | bus.listen(MICROBIT_ID_ANY, MICROBIT_BUTTON_EVT_DOWN, onButtonDown); |
masakjm | 0:28fb3e9ef81a | 422 | bus.listen(MICROBIT_ID_ANY, MICROBIT_BUTTON_EVT_UP, onButtonUp); |
masakjm | 1:3b9ae1dbcdcf | 423 | bus.listen(MICROBIT_ID_ANY, MICROBIT_BUTTON_EVT_HOLD, onButtonHold); |
masakjm | 0:28fb3e9ef81a | 424 | |
masakjm | 4:4fe5674bf409 | 425 | // Put the P0, P1 and P2 pins into touch sense mode. |
masakjm | 6:e2074d02065b | 426 | // P0.isTouched(); |
masakjm | 6:e2074d02065b | 427 | // P1.isTouched(); |
masakjm | 6:e2074d02065b | 428 | // P2.isTouched(); |
masakjm | 4:4fe5674bf409 | 429 | |
masakjm | 0:28fb3e9ef81a | 430 | //----- Setting |
masakjm | 3:b6e9850d3e76 | 431 | if (paraSetting(state == STATE_SETTING)) dispChar =0; |
masakjm | 3:b6e9850d3e76 | 432 | else dispChar ='e'; |
masakjm | 0:28fb3e9ef81a | 433 | |
masakjm | 0:28fb3e9ef81a | 434 | //----- BLE & HID |
masakjm | 3:b6e9850d3e76 | 435 | state = STATE_DESABLE_INPUT; |
masakjm | 0:28fb3e9ef81a | 436 | initialize_BLE_HID(); |
masakjm | 0:28fb3e9ef81a | 437 | display.clear(); |
masakjm | 0:28fb3e9ef81a | 438 | |
masakjm | 0:28fb3e9ef81a | 439 | //----- Loop |
masakjm | 3:b6e9850d3e76 | 440 | state = STATE_OPERATING; |
masakjm | 0:28fb3e9ef81a | 441 | while (true) { |
masakjm | 0:28fb3e9ef81a | 442 | ble.waitForEvent(); // BLEイベントを待つ |
masakjm | 0:28fb3e9ef81a | 443 | |
masakjm | 3:b6e9850d3e76 | 444 | if(bleMessage != BLE_NO_MESSAGE) { // BLEの状態を表示する |
masakjm | 3:b6e9850d3e76 | 445 | dispChar = bleDispChar[bleMessage]; |
masakjm | 3:b6e9850d3e76 | 446 | bleMessage = BLE_NO_MESSAGE; |
masakjm | 3:b6e9850d3e76 | 447 | } |
masakjm | 3:b6e9850d3e76 | 448 | |
masakjm | 0:28fb3e9ef81a | 449 | if (dispChar != dispCharLast) { // 表示文字が変更 |
masakjm | 0:28fb3e9ef81a | 450 | turnOffMode = false; |
masakjm | 0:28fb3e9ef81a | 451 | dispTime.reset(); |
masakjm | 0:28fb3e9ef81a | 452 | display.enable(); |
masakjm | 0:28fb3e9ef81a | 453 | if (dispChar) display.printChar(dispChar); |
masakjm | 0:28fb3e9ef81a | 454 | else display.clear(); |
masakjm | 0:28fb3e9ef81a | 455 | } |
masakjm | 0:28fb3e9ef81a | 456 | if (!turnOffMode) { |
masakjm | 0:28fb3e9ef81a | 457 | if (dispTime.read() > TIME_TURN_OFF) { // 長時間表示 |
masakjm | 0:28fb3e9ef81a | 458 | turnOffMode = true; |
masakjm | 0:28fb3e9ef81a | 459 | display.disable(); |
masakjm | 0:28fb3e9ef81a | 460 | } |
masakjm | 0:28fb3e9ef81a | 461 | } |
masakjm | 0:28fb3e9ef81a | 462 | dispCharLast = dispChar; |
masakjm | 0:28fb3e9ef81a | 463 | } |
masakjm | 0:28fb3e9ef81a | 464 | } |