Hiroh Satoh / keyboard Featured

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   BLE_API mbed-dev nRF51822

main.cpp@31:010a44d53627, 2016-08-24 (annotated)

Committer:
cho45
Date:
Wed Aug 24 13:11:10 2016 +0000
Revision:
31:010a44d53627
Parent:
30:f9ebc769118d
Child:
32:6c0f43fda460
more efficient  sleep

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 31:010a44d53627 261 static volatile bool timer1_interrupted = false;
cho45 31:010a44d53627 262 extern "C" void TIMER1_IRQHandler(void) {
cho45 31:010a44d53627 263 NRF_TIMER1->EVENTS_COMPARE[0] = 0;
cho45 31:010a44d53627 264 NRF_TIMER1->TASKS_CLEAR = 1;
cho45 31:010a44d53627 265 timer1_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 31:010a44d53627 287 // Setup timer for just wakeup from sleep
cho45 31:010a44d53627 288 NRF_TIMER1->TASKS_STOP = 1;
cho45 31:010a44d53627 289 NRF_TIMER1->PRESCALER = 4; // f = HFCLK / 2^N => 1MHz timer
cho45 31:010a44d53627 290 // TIMER1 is 16bit timer
cho45 31:010a44d53627 291 NRF_TIMER1->BITMODE = TIMER_BITMODE_BITMODE_16Bit << TIMER_BITMODE_BITMODE_Pos;
cho45 31:010a44d53627 292 NRF_TIMER1->MODE = TIMER_MODE_MODE_Timer << TIMER_MODE_MODE_Pos;
cho45 31:010a44d53627 293 NVIC_SetPriority(TIMER1_IRQn, 3);
cho45 31:010a44d53627 294 NVIC_ClearPendingIRQ(TIMER1_IRQn);
cho45 31:010a44d53627 295 NVIC_EnableIRQ(TIMER1_IRQn);
cho45 31:010a44d53627 296
cho45 31:010a44d53627 297
cho45 4:54cb552e50c4 298 // 100kHz
cho45 4:54cb552e50c4 299 i2c.frequency(100000);
cho45 4:54cb552e50c4 300
cho45 5:65d4e94735b6 301 buttonInt.mode(PullUp);
cho45 5:65d4e94735b6 302 buttonInt.fall(buttonIntCallback);
cho45 4:54cb552e50c4 303
cho45 5:65d4e94735b6 304 keyboardMatrixController.init();
cho45 5:65d4e94735b6 305 buttonIntCallback();
cho45 4:54cb552e50c4 306
cho45 6:f1c3ea8bc850 307 HIDController::init();
cho45 16:345eebc4f259 308
cho45 16:345eebc4f259 309 // STOP UART RX for power consumption
cho45 21:d801c32231b0 310 NRF_UART0->TASKS_STOPRX = 1;
cho45 16:345eebc4f259 311
cho45 30:f9ebc769118d 312 // Disable TWI by default.
cho45 16:345eebc4f259 313 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 314
cho45 30:f9ebc769118d 315 while (1) {
cho45 23:b31957ce64e9 316 if (pollCount > 0) {
cho45 23:b31957ce64e9 317 printf("scan keys\r\n");
cho45 31:010a44d53627 318
cho45 23:b31957ce64e9 319 while (pollCount -- > 0) {
cho45 23:b31957ce64e9 320 uint8_t (&keysCurr)[COLS] = state ? keysA : keysB;
cho45 23:b31957ce64e9 321 uint8_t (&keysPrev)[COLS] = state ? keysB : keysA;
cho45 23:b31957ce64e9 322
cho45 23:b31957ce64e9 323 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Enabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 324 keyboardMatrixController.scanKeyboard(keysCurr);
cho45 23:b31957ce64e9 325 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 326
cho45 23:b31957ce64e9 327 bool queue = false;
cho45 23:b31957ce64e9 328
cho45 23:b31957ce64e9 329 for (int col = 0; col < COLS; col++) {
cho45 23:b31957ce64e9 330 uint8_t changed = keysPrev[col] ^ keysCurr[col];
cho45 23:b31957ce64e9 331 if (changed) queue = true;
cho45 23:b31957ce64e9 332 for (int row = 0; row < ROWS; row++) {
cho45 23:b31957ce64e9 333 if (changed & (1<<row)) {
cho45 23:b31957ce64e9 334 bool pressed = keysCurr[col] & (1<<row);
cho45 23:b31957ce64e9 335 // printf("changed: col=%d, row=%d / pressed=%d\r\n", col, row, pressed);
cho45 23:b31957ce64e9 336 keymap.execute(col, row, pressed);
cho45 23:b31957ce64e9 337 }
cho45 7:b9270a37345b 338 }
cho45 7:b9270a37345b 339 }
cho45 23:b31957ce64e9 340 state = !state;
cho45 23:b31957ce64e9 341
cho45 23:b31957ce64e9 342
cho45 23:b31957ce64e9 343 if (queue) HIDController::queueCurrentReportData();
cho45 30:f9ebc769118d 344
cho45 31:010a44d53627 345 // wait_ms(5); is busy loop
cho45 31:010a44d53627 346 // use timer1 to use wait 5ms
cho45 31:010a44d53627 347 NRF_TIMER1->CC[0] = 1e6 / 200; // 5ms
cho45 31:010a44d53627 348 NRF_TIMER1->EVENTS_COMPARE[0] = 0;
cho45 31:010a44d53627 349 NRF_TIMER1->TASKS_CLEAR = 1;
cho45 31:010a44d53627 350 NRF_TIMER1->INTENSET = TIMER_INTENSET_COMPARE0_Set << TIMER_INTENSET_COMPARE0_Pos;
cho45 31:010a44d53627 351 NRF_TIMER1->TASKS_START = 1;
cho45 31:010a44d53627 352 while (!timer1_interrupted) sleep();
cho45 31:010a44d53627 353 timer1_interrupted = false;
cho45 31:010a44d53627 354 NRF_TIMER1->INTENCLR = TIMER_INTENCLR_COMPARE0_Clear << TIMER_INTENCLR_COMPARE0_Pos;
cho45 31:010a44d53627 355 NRF_TIMER1->TASKS_STOP = 1;
cho45 7:b9270a37345b 356 }
cho45 30:f9ebc769118d 357
cho45 31:010a44d53627 358 printf("disable int\r\n");
cho45 31:010a44d53627 359 NRF_TIMER1->TASKS_SHUTDOWN = 1;
cho45 8:d684faf04c9a 360 } else {
cho45 29:ec548c473d50 361 printf("[%s] wait for events...\r\n", HIDController::connected() ? "connected" : "disconnected");
cho45 29:ec548c473d50 362
cho45 30:f9ebc769118d 363 // allow printf in some interrupts while connecting
cho45 29:ec548c473d50 364 if (HIDController::connected()) {
cho45 30:f9ebc769118d 365 // disable internal HFCLK RC Clock surely. It consume 1mA constantly
cho45 30:f9ebc769118d 366 // TWI / SPI / UART must be disabled and boot without debug mode
cho45 29:ec548c473d50 367 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 368
cho45 29:ec548c473d50 369 uint32_t tx = NRF_UART0->PSELTXD;
cho45 29:ec548c473d50 370
cho45 29:ec548c473d50 371 NRF_UART0->TASKS_STOPTX = 1;
cho45 29:ec548c473d50 372 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Disabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 373
cho45 29:ec548c473d50 374 HIDController::waitForEvent();
cho45 29:ec548c473d50 375
cho45 29:ec548c473d50 376 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Enabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 377 NRF_UART0->TASKS_STARTTX = 1;
cho45 30:f9ebc769118d 378 // dummy send to wakeup...
cho45 29:ec548c473d50 379 NRF_UART0->PSELTXD = 0xFFFFFFFF;
cho45 29:ec548c473d50 380 NRF_UART0->EVENTS_TXDRDY = 0;
cho45 29:ec548c473d50 381 NRF_UART0->TXD = 0;
cho45 29:ec548c473d50 382 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 383 NRF_UART0->PSELTXD = tx;
cho45 29:ec548c473d50 384 } else {
cho45 29:ec548c473d50 385 HIDController::waitForEvent();
cho45 29:ec548c473d50 386 }
cho45 7:b9270a37345b 387 }
cho45 2:c2e3f240640c 388 }
cho45 31:010a44d53627 389 }