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