Hiroh Satoh / keyboard Featured

Dependencies:   BLE_API mbed-dev nRF51822

Committer:
cho45
Date:
Wed Aug 24 12:31:15 2016 +0000
Revision:
30:f9ebc769118d
Parent:
29:ec548c473d50
Child:
31:010a44d53627
??????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
cho45 0:be89b5fdea09 1 /* mbed Microcontroller Library
cho45 0:be89b5fdea09 2 * Copyright (c) 2015 ARM Limited
cho45 0:be89b5fdea09 3 *
cho45 0:be89b5fdea09 4 * Licensed under the Apache License, Version 2.0 (the "License");
cho45 0:be89b5fdea09 5 * you may not use this file except in compliance with the License.
cho45 0:be89b5fdea09 6 * You may obtain a copy of the License at
cho45 0:be89b5fdea09 7 *
cho45 0:be89b5fdea09 8 * http://www.apache.org/licenses/LICENSE-2.0
cho45 0:be89b5fdea09 9 *
cho45 0:be89b5fdea09 10 * Unless required by applicable law or agreed to in writing, software
cho45 0:be89b5fdea09 11 * distributed under the License is distributed on an "AS IS" BASIS,
cho45 0:be89b5fdea09 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
cho45 0:be89b5fdea09 13 * See the License for the specific language governing permissions and
cho45 0:be89b5fdea09 14 * limitations under the License.
cho45 0:be89b5fdea09 15 */
cho45 0:be89b5fdea09 16
cho45 30:f9ebc769118d 17 #include <cmath>
cho45 0:be89b5fdea09 18 #include "mbed.h"
cho45 6:f1c3ea8bc850 19
cho45 6:f1c3ea8bc850 20 #include "HIDController_BLE.h"
cho45 6:f1c3ea8bc850 21
cho45 4:54cb552e50c4 22 #include "mcp23017.h"
cho45 5:65d4e94735b6 23 #include "keymap.h"
cho45 0:be89b5fdea09 24
cho45 0:be89b5fdea09 25
cho45 5:65d4e94735b6 26 class KeyboardMatrixController {
cho45 5:65d4e94735b6 27 I2C& i2c;
cho45 5:65d4e94735b6 28 MCP23017 gpio1;
cho45 5:65d4e94735b6 29 MCP23017 gpio2;
cho45 13:b0ffdf2012b9 30 bool gpio1_ready;
cho45 13:b0ffdf2012b9 31 bool gpio2_ready;
cho45 5:65d4e94735b6 32
cho45 5:65d4e94735b6 33 static const uint8_t GPIO1_SLAVE_ADDRESS = 0b0100000;
cho45 14:3a8c126b7834 34 static const uint8_t GPIO2_SLAVE_ADDRESS = 0b0100100;
cho45 5:65d4e94735b6 35
cho45 5:65d4e94735b6 36 /**
cho45 5:65d4e94735b6 37 * COL=GPIOA (output normaly positive)
cho45 5:65d4e94735b6 38 * ROW=GPIOB (input pulled-up)
cho45 5:65d4e94735b6 39 */
cho45 5:65d4e94735b6 40
cho45 13:b0ffdf2012b9 41 bool setupGpio(MCP23017& gpio) {
cho45 5:65d4e94735b6 42 int ok;
cho45 13:b0ffdf2012b9 43 printf("SET IOCON\r\n");
cho45 5:65d4e94735b6 44 ok = gpio.write8(
cho45 5:65d4e94735b6 45 MCP23017::IOCON,
cho45 5:65d4e94735b6 46 0<<MCP23017::BANK |
cho45 5:65d4e94735b6 47 1<<MCP23017::MIRROR |
cho45 5:65d4e94735b6 48 1<<MCP23017::SEQOP |
cho45 5:65d4e94735b6 49 0<<MCP23017::DISSLW |
cho45 5:65d4e94735b6 50 1<<MCP23017::ODR // int pin is open drain
cho45 5:65d4e94735b6 51 );
cho45 13:b0ffdf2012b9 52 if (!ok) return false;
cho45 5:65d4e94735b6 53
cho45 5:65d4e94735b6 54 // IODIR
cho45 5:65d4e94735b6 55 // 1: input
cho45 5:65d4e94735b6 56 // 0: output
cho45 13:b0ffdf2012b9 57 printf("SET IODIRA\r\n");
cho45 5:65d4e94735b6 58 ok = gpio.write16(
cho45 5:65d4e94735b6 59 MCP23017::IODIRA,
cho45 5:65d4e94735b6 60 0b0000000011111111
cho45 5:65d4e94735b6 61 );
cho45 13:b0ffdf2012b9 62 if (!ok) return false;
cho45 4:54cb552e50c4 63
cho45 5:65d4e94735b6 64 // INPUT POLARITY
cho45 5:65d4e94735b6 65 // 1: inverse polarity
cho45 5:65d4e94735b6 66 // 0: raw
cho45 13:b0ffdf2012b9 67 printf("SET IPOLB\r\n");
cho45 5:65d4e94735b6 68 ok = gpio.write8(
cho45 5:65d4e94735b6 69 MCP23017::IPOLB,
cho45 5:65d4e94735b6 70 0b11111111
cho45 5:65d4e94735b6 71 );
cho45 13:b0ffdf2012b9 72 if (!ok) return false;
cho45 5:65d4e94735b6 73
cho45 5:65d4e94735b6 74 // INTERRUPT-ON-CHANGE Enable
cho45 13:b0ffdf2012b9 75 printf("SET GPINTENB\r\n");
cho45 5:65d4e94735b6 76 ok = gpio.write8(
cho45 5:65d4e94735b6 77 MCP23017::GPINTENB,
cho45 5:65d4e94735b6 78 0b11111111
cho45 5:65d4e94735b6 79 );
cho45 13:b0ffdf2012b9 80 if (!ok) return false;
cho45 13:b0ffdf2012b9 81
cho45 5:65d4e94735b6 82 // INTERRUPT-ON-CHANGE Control
cho45 5:65d4e94735b6 83 // 1: compared with DEFVAL
cho45 5:65d4e94735b6 84 // 0: compared to previous value
cho45 13:b0ffdf2012b9 85 printf("SET INTCONB\r\n");
cho45 5:65d4e94735b6 86 ok = gpio.write8(
cho45 5:65d4e94735b6 87 MCP23017::INTCONB,
cho45 5:65d4e94735b6 88 0b00000000
cho45 5:65d4e94735b6 89 );
cho45 13:b0ffdf2012b9 90 if (!ok) return false;
cho45 13:b0ffdf2012b9 91
cho45 5:65d4e94735b6 92 // PULL-UP (for input pin)
cho45 5:65d4e94735b6 93 // 1: pull-up enabled
cho45 5:65d4e94735b6 94 // 0: pull-up disabled
cho45 13:b0ffdf2012b9 95 printf("SET GPPUB\r\n");
cho45 5:65d4e94735b6 96 ok = gpio.write8(
cho45 5:65d4e94735b6 97 MCP23017::GPPUB,
cho45 5:65d4e94735b6 98 0b11111111
cho45 5:65d4e94735b6 99 );
cho45 13:b0ffdf2012b9 100 if (!ok) return false;
cho45 5:65d4e94735b6 101
cho45 13:b0ffdf2012b9 102 printf("SET GPIOA\r\n");
cho45 5:65d4e94735b6 103 ok = gpio1.write8(
cho45 5:65d4e94735b6 104 MCP23017::GPIOA,
cho45 5:65d4e94735b6 105 0b00000000
cho45 5:65d4e94735b6 106 );
cho45 13:b0ffdf2012b9 107 if (!ok) return false;
cho45 5:65d4e94735b6 108
cho45 13:b0ffdf2012b9 109 return true;
cho45 5:65d4e94735b6 110 }
cho45 5:65d4e94735b6 111
cho45 4:54cb552e50c4 112 public:
cho45 5:65d4e94735b6 113 KeyboardMatrixController(I2C& _i2c) :
cho45 5:65d4e94735b6 114 i2c(_i2c),
cho45 5:65d4e94735b6 115 gpio1(i2c, GPIO1_SLAVE_ADDRESS),
cho45 5:65d4e94735b6 116 gpio2(i2c, GPIO2_SLAVE_ADDRESS)
cho45 4:54cb552e50c4 117 {
cho45 4:54cb552e50c4 118 }
cho45 4:54cb552e50c4 119
cho45 5:65d4e94735b6 120 void init() {
cho45 13:b0ffdf2012b9 121 printf("init gpio1\r\n");
cho45 13:b0ffdf2012b9 122 gpio1_ready = setupGpio(gpio1);
cho45 13:b0ffdf2012b9 123 printf("gpio1 initialized: %s\r\n", gpio1_ready ? "success" : "failed");
cho45 13:b0ffdf2012b9 124
cho45 13:b0ffdf2012b9 125 printf("init gpio2\r\n");
cho45 13:b0ffdf2012b9 126 gpio2_ready = setupGpio(gpio2);
cho45 13:b0ffdf2012b9 127 printf("gpio2 initialized: %s\r\n", gpio2_ready ? "success" : "failed");
cho45 13:b0ffdf2012b9 128
cho45 5:65d4e94735b6 129 }
cho45 5:65d4e94735b6 130
cho45 30:f9ebc769118d 131 // __attribute__((used, long_call, section(".data")))
cho45 5:65d4e94735b6 132 void scanKeyboard(uint8_t* keys) {
cho45 5:65d4e94735b6 133 int ok;
cho45 13:b0ffdf2012b9 134
cho45 13:b0ffdf2012b9 135 disableInterrupt();
cho45 5:65d4e94735b6 136
cho45 13:b0ffdf2012b9 137 if (gpio1_ready) {
cho45 13:b0ffdf2012b9 138 for (int i = 0; i < 8; i++) {
cho45 13:b0ffdf2012b9 139 ok = gpio1.write8(
cho45 13:b0ffdf2012b9 140 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 141 ~(1<<i)
cho45 13:b0ffdf2012b9 142 );
cho45 13:b0ffdf2012b9 143 keys[i] = gpio1.read8(MCP23017::GPIOB, ok);
cho45 13:b0ffdf2012b9 144 }
cho45 13:b0ffdf2012b9 145
cho45 13:b0ffdf2012b9 146 // set all output to negative for interrupt
cho45 5:65d4e94735b6 147 ok = gpio1.write8(
cho45 5:65d4e94735b6 148 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 149 0b00000000
cho45 5:65d4e94735b6 150 );
cho45 4:54cb552e50c4 151 }
cho45 2:c2e3f240640c 152
cho45 5:65d4e94735b6 153
cho45 13:b0ffdf2012b9 154 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 155 for (int i = 0; i < 8; i++) {
cho45 13:b0ffdf2012b9 156 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 157 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 158 ~(1<<i)
cho45 13:b0ffdf2012b9 159 );
cho45 13:b0ffdf2012b9 160 keys[i+8] = gpio2.read8(MCP23017::GPIOB, ok);
cho45 13:b0ffdf2012b9 161 }
cho45 13:b0ffdf2012b9 162
cho45 13:b0ffdf2012b9 163 // set all output to negative for interrupt
cho45 13:b0ffdf2012b9 164 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 165 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 166 0b00000000
cho45 13:b0ffdf2012b9 167 );
cho45 13:b0ffdf2012b9 168 }
cho45 13:b0ffdf2012b9 169
cho45 13:b0ffdf2012b9 170 enableInterrupt();
cho45 7:b9270a37345b 171 }
cho45 13:b0ffdf2012b9 172
cho45 7:b9270a37345b 173 void disableInterrupt() {
cho45 7:b9270a37345b 174 int ok;
cho45 13:b0ffdf2012b9 175 if (gpio1_ready) {
cho45 13:b0ffdf2012b9 176 // Disable interrupt
cho45 13:b0ffdf2012b9 177 ok = gpio1.write8(
cho45 13:b0ffdf2012b9 178 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 179 0b00000000
cho45 13:b0ffdf2012b9 180 );
cho45 13:b0ffdf2012b9 181 }
cho45 13:b0ffdf2012b9 182
cho45 13:b0ffdf2012b9 183 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 184 // Disable interrupt
cho45 13:b0ffdf2012b9 185 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 186 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 187 0b00000000
cho45 13:b0ffdf2012b9 188 );
cho45 13:b0ffdf2012b9 189 }
cho45 7:b9270a37345b 190 }
cho45 7:b9270a37345b 191
cho45 7:b9270a37345b 192 void enableInterrupt() {
cho45 7:b9270a37345b 193 int ok;
cho45 13:b0ffdf2012b9 194 if (gpio1_ready) {
cho45 13:b0ffdf2012b9 195 // Enable interrupt
cho45 13:b0ffdf2012b9 196 ok = gpio1.write8(
cho45 13:b0ffdf2012b9 197 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 198 0b11111111
cho45 13:b0ffdf2012b9 199 );
cho45 13:b0ffdf2012b9 200 }
cho45 13:b0ffdf2012b9 201
cho45 13:b0ffdf2012b9 202 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 203 // Enable interrupt
cho45 13:b0ffdf2012b9 204 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 205 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 206 0b11111111
cho45 13:b0ffdf2012b9 207 );
cho45 13:b0ffdf2012b9 208 }
cho45 5:65d4e94735b6 209
cho45 5:65d4e94735b6 210 // Clear interrupt
cho45 13:b0ffdf2012b9 211 // gpio1.read8(MCP23017::GPIOB, ok);
cho45 4:54cb552e50c4 212 }
cho45 5:65d4e94735b6 213 };
cho45 4:54cb552e50c4 214
cho45 5:65d4e94735b6 215 I2C i2c(I2C_SDA0, I2C_SCL0);
cho45 16:345eebc4f259 216 // Serial serial(USBTX, USBRX);
cho45 5:65d4e94735b6 217 KeyboardMatrixController keyboardMatrixController(i2c);
cho45 6:f1c3ea8bc850 218 Keymap keymap;
cho45 15:70bf079d3ee1 219
cho45 15:70bf079d3ee1 220 // Interrupt from MCP23017
cho45 15:70bf079d3ee1 221 // (pulled-up and two MCP23017 is configured with open drain INT)
cho45 5:65d4e94735b6 222 InterruptIn buttonInt(P0_5);
cho45 5:65d4e94735b6 223
cho45 28:1f843a3daab0 224 DigitalOut statusLed(P0_4, 0);
cho45 26:78ee13f69ec3 225
cho45 25:094df0d9e95b 226
cho45 15:70bf079d3ee1 227 // Unsed pins. Set to output for power consumption
cho45 20:d8840ac38434 228 DigitalIn unused_p0_7(P0_7, PullUp);
cho45 20:d8840ac38434 229 DigitalIn unused_p0_6(P0_6, PullUp);
cho45 20:d8840ac38434 230 DigitalIn unused_p0_15(P0_15, PullUp);
cho45 20:d8840ac38434 231 DigitalIn unused_p0_29(P0_29, PullUp);
cho45 20:d8840ac38434 232 DigitalIn unused_p0_28(P0_28, PullUp);
cho45 20:d8840ac38434 233 DigitalIn unused_p0_19(P0_19, PullUp); // This is on board LED which connected to VDD
cho45 22:a78f0a91280a 234 DigitalIn unused_p0_11(P0_11, PullUp); // RXD
cho45 15:70bf079d3ee1 235
cho45 5:65d4e94735b6 236 // ROWS=8
cho45 5:65d4e94735b6 237 // COLS=16
cho45 5:65d4e94735b6 238 // 列ごとに1バイトにパックしてキーの状態を保持する
cho45 5:65d4e94735b6 239 static uint8_t keysA[COLS];
cho45 5:65d4e94735b6 240 static uint8_t keysB[COLS];
cho45 5:65d4e94735b6 241 static bool state = 0;
cho45 28:1f843a3daab0 242 #define is_pressed(keys, row, col) (!!(keys[col] & (1<<row)))
cho45 28:1f843a3daab0 243
cho45 9:d1daefbf1fbd 244 // delay for interrupt
cho45 23:b31957ce64e9 245 static volatile int8_t pollCount = 50;
cho45 5:65d4e94735b6 246
cho45 5:65d4e94735b6 247 void buttonIntCallback() {
cho45 8:d684faf04c9a 248 // just for wakeup
cho45 9:d1daefbf1fbd 249 pollCount = 100;
cho45 2:c2e3f240640c 250 }
cho45 2:c2e3f240640c 251
cho45 23:b31957ce64e9 252 void powerOff() {
cho45 23:b31957ce64e9 253 printf("power off\r\n");
cho45 23:b31957ce64e9 254 NRF_POWER->SYSTEMOFF = 1;
cho45 23:b31957ce64e9 255 }
cho45 23:b31957ce64e9 256
cho45 26:78ee13f69ec3 257 void tickerStatus() {
cho45 28:1f843a3daab0 258 statusLed = !statusLed;
cho45 26:78ee13f69ec3 259 }
cho45 26:78ee13f69ec3 260
cho45 30:f9ebc769118d 261 static volatile bool timer2_interrupted = false;
cho45 30:f9ebc769118d 262 void TIMER2_IRQHandler(void) {
cho45 30:f9ebc769118d 263 NRF_TIMER2->TASKS_CLEAR = 1;
cho45 30:f9ebc769118d 264 NRF_TIMER2->EVENTS_COMPARE[0] = 0;
cho45 30:f9ebc769118d 265 timer2_interrupted = true;
cho45 30:f9ebc769118d 266 }
cho45 30:f9ebc769118d 267
cho45 28:1f843a3daab0 268
cho45 0:be89b5fdea09 269 int main(void) {
cho45 5:65d4e94735b6 270 printf("init\r\n");
cho45 29:ec548c473d50 271
cho45 30:f9ebc769118d 272 // Enable Pin-reset on DEBUG mode
cho45 30:f9ebc769118d 273 // This makes possiable booting without normal mode easily.
cho45 30:f9ebc769118d 274 NRF_POWER->RESET = 1;
cho45 30:f9ebc769118d 275 // Disable Internal DC/DC step down converter surely
cho45 29:ec548c473d50 276 NRF_POWER->DCDCEN = 0;
cho45 30:f9ebc769118d 277 // Enable 2.1V brown out detection for avoiding over discharge of NiMH
cho45 29:ec548c473d50 278 NRF_POWER->POFCON =
cho45 29:ec548c473d50 279 POWER_POFCON_POF_Enabled << POWER_POFCON_POF_Pos |
cho45 29:ec548c473d50 280 POWER_POFCON_THRESHOLD_V21 << POWER_POFCON_THRESHOLD_Pos;
cho45 29:ec548c473d50 281
cho45 4:54cb552e50c4 282 // mbed's Serial of TARGET_RBLAB_BLENANO sucks
cho45 30:f9ebc769118d 283 // DO NOT CONNECT RTS/CTS WITHOUT PRIOR CONSENT!
cho45 4:54cb552e50c4 284 NRF_UART0->PSELRTS = 0xFFFFFFFFUL;
cho45 4:54cb552e50c4 285 NRF_UART0->PSELCTS = 0xFFFFFFFFUL;
cho45 16:345eebc4f259 286
cho45 4:54cb552e50c4 287 // 100kHz
cho45 4:54cb552e50c4 288 i2c.frequency(100000);
cho45 4:54cb552e50c4 289
cho45 5:65d4e94735b6 290 buttonInt.mode(PullUp);
cho45 5:65d4e94735b6 291 buttonInt.fall(buttonIntCallback);
cho45 4:54cb552e50c4 292
cho45 5:65d4e94735b6 293 keyboardMatrixController.init();
cho45 5:65d4e94735b6 294 buttonIntCallback();
cho45 4:54cb552e50c4 295
cho45 6:f1c3ea8bc850 296 HIDController::init();
cho45 16:345eebc4f259 297
cho45 16:345eebc4f259 298 // STOP UART RX for power consumption
cho45 21:d801c32231b0 299 NRF_UART0->TASKS_STOPRX = 1;
cho45 16:345eebc4f259 300
cho45 30:f9ebc769118d 301 // Disable TWI by default.
cho45 16:345eebc4f259 302 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 303
cho45 30:f9ebc769118d 304 while (1) {
cho45 23:b31957ce64e9 305 if (pollCount > 0) {
cho45 23:b31957ce64e9 306 printf("scan keys\r\n");
cho45 30:f9ebc769118d 307
cho45 30:f9ebc769118d 308 /*
cho45 30:f9ebc769118d 309 // Setup timer for just wakeup from sleep
cho45 30:f9ebc769118d 310 NRF_TIMER2->TASKS_STOP = 1;
cho45 30:f9ebc769118d 311 NRF_TIMER2->PRESCALER = 4; // f = HFCLK / 2^N => 1MHz timer
cho45 30:f9ebc769118d 312 // TIMER2 is 16bit timer
cho45 30:f9ebc769118d 313 NRF_TIMER2->BITMODE = TIMER_BITMODE_BITMODE_16Bit << TIMER_BITMODE_BITMODE_Pos;
cho45 30:f9ebc769118d 314 NRF_TIMER2->MODE = TIMER_MODE_MODE_Timer << TIMER_MODE_MODE_Pos;
cho45 30:f9ebc769118d 315 NRF_TIMER2->CC[0] = 1e6 / 200; // 5ms
cho45 30:f9ebc769118d 316 NRF_TIMER2->EVENTS_COMPARE[0] = 0;
cho45 30:f9ebc769118d 317 NRF_TIMER2->TASKS_CLEAR = 1;
cho45 30:f9ebc769118d 318 NRF_TIMER2->INTENSET = 1;
cho45 30:f9ebc769118d 319 NVIC_SetPriority(TIMER2_IRQn, 3);
cho45 30:f9ebc769118d 320 NVIC_ClearPendingIRQ(TIMER2_IRQn);
cho45 30:f9ebc769118d 321 NVIC_EnableIRQ(TIMER2_IRQn);
cho45 30:f9ebc769118d 322 */
cho45 30:f9ebc769118d 323
cho45 23:b31957ce64e9 324 while (pollCount -- > 0) {
cho45 23:b31957ce64e9 325 uint8_t (&keysCurr)[COLS] = state ? keysA : keysB;
cho45 23:b31957ce64e9 326 uint8_t (&keysPrev)[COLS] = state ? keysB : keysA;
cho45 23:b31957ce64e9 327
cho45 23:b31957ce64e9 328 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Enabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 329 keyboardMatrixController.scanKeyboard(keysCurr);
cho45 23:b31957ce64e9 330 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 331
cho45 23:b31957ce64e9 332 bool queue = false;
cho45 23:b31957ce64e9 333
cho45 23:b31957ce64e9 334 for (int col = 0; col < COLS; col++) {
cho45 23:b31957ce64e9 335 uint8_t changed = keysPrev[col] ^ keysCurr[col];
cho45 23:b31957ce64e9 336 if (changed) queue = true;
cho45 23:b31957ce64e9 337 for (int row = 0; row < ROWS; row++) {
cho45 23:b31957ce64e9 338 if (changed & (1<<row)) {
cho45 23:b31957ce64e9 339 bool pressed = keysCurr[col] & (1<<row);
cho45 23:b31957ce64e9 340 // printf("changed: col=%d, row=%d / pressed=%d\r\n", col, row, pressed);
cho45 23:b31957ce64e9 341 keymap.execute(col, row, pressed);
cho45 23:b31957ce64e9 342 }
cho45 7:b9270a37345b 343 }
cho45 7:b9270a37345b 344 }
cho45 23:b31957ce64e9 345 state = !state;
cho45 23:b31957ce64e9 346
cho45 23:b31957ce64e9 347
cho45 23:b31957ce64e9 348 if (queue) HIDController::queueCurrentReportData();
cho45 30:f9ebc769118d 349
cho45 23:b31957ce64e9 350 wait_ms(5);
cho45 30:f9ebc769118d 351
cho45 30:f9ebc769118d 352 /*
cho45 30:f9ebc769118d 353 while (!timer2_interrupted) sleep();
cho45 30:f9ebc769118d 354 timer2_interrupted = false;
cho45 30:f9ebc769118d 355 */
cho45 7:b9270a37345b 356 }
cho45 30:f9ebc769118d 357
cho45 30:f9ebc769118d 358 /*
cho45 30:f9ebc769118d 359 NVIC_DisableIRQ(TIMER2_IRQn);
cho45 30:f9ebc769118d 360 NRF_TIMER2->TASKS_STOP = 1;
cho45 30:f9ebc769118d 361 NRF_TIMER2->TASKS_SHUTDOWN = 1;
cho45 30:f9ebc769118d 362 */
cho45 8:d684faf04c9a 363 } else {
cho45 29:ec548c473d50 364 printf("[%s] wait for events...\r\n", HIDController::connected() ? "connected" : "disconnected");
cho45 29:ec548c473d50 365
cho45 30:f9ebc769118d 366 // allow printf in some interrupts while connecting
cho45 29:ec548c473d50 367 if (HIDController::connected()) {
cho45 30:f9ebc769118d 368 // disable internal HFCLK RC Clock surely. It consume 1mA constantly
cho45 30:f9ebc769118d 369 // TWI / SPI / UART must be disabled and boot without debug mode
cho45 29:ec548c473d50 370 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 371
cho45 29:ec548c473d50 372 uint32_t tx = NRF_UART0->PSELTXD;
cho45 29:ec548c473d50 373
cho45 29:ec548c473d50 374 NRF_UART0->TASKS_STOPTX = 1;
cho45 29:ec548c473d50 375 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Disabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 376
cho45 29:ec548c473d50 377 HIDController::waitForEvent();
cho45 29:ec548c473d50 378
cho45 29:ec548c473d50 379 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Enabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 380 NRF_UART0->TASKS_STARTTX = 1;
cho45 30:f9ebc769118d 381 // dummy send to wakeup...
cho45 29:ec548c473d50 382 NRF_UART0->PSELTXD = 0xFFFFFFFF;
cho45 29:ec548c473d50 383 NRF_UART0->EVENTS_TXDRDY = 0;
cho45 29:ec548c473d50 384 NRF_UART0->TXD = 0;
cho45 29:ec548c473d50 385 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 386 NRF_UART0->PSELTXD = tx;
cho45 29:ec548c473d50 387 } else {
cho45 29:ec548c473d50 388 HIDController::waitForEvent();
cho45 29:ec548c473d50 389 }
cho45 7:b9270a37345b 390 }
cho45 2:c2e3f240640c 391 }
cho45 2:c2e3f240640c 392 }