masatomo kojima / microbit_switch_if_joy

BLE switch interface with GROVE joystic for micro:bit http://mahoro-ba.net/e2073.html

Dependencies:   microbit

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?

UserRevisionLine numberNew 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 }