Hiroh Satoh / keyboard Featured

Dependencies:   BLE_API mbed-dev nRF51822

Committer:
cho45
Date:
Thu Aug 25 00:43:55 2016 +0000
Revision:
33:6a2301a89e92
Parent:
32:6c0f43fda460
Child:
34:7da766a8aa96
????????????????????????????????????????????????

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 33:6a2301a89e92 143 wait_us(1);
cho45 13:b0ffdf2012b9 144 keys[i] = gpio1.read8(MCP23017::GPIOB, ok);
cho45 13:b0ffdf2012b9 145 }
cho45 13:b0ffdf2012b9 146
cho45 13:b0ffdf2012b9 147 // set all output to negative for interrupt
cho45 5:65d4e94735b6 148 ok = gpio1.write8(
cho45 5:65d4e94735b6 149 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 150 0b00000000
cho45 5:65d4e94735b6 151 );
cho45 4:54cb552e50c4 152 }
cho45 2:c2e3f240640c 153
cho45 5:65d4e94735b6 154
cho45 13:b0ffdf2012b9 155 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 156 for (int i = 0; i < 8; i++) {
cho45 13:b0ffdf2012b9 157 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 158 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 159 ~(1<<i)
cho45 13:b0ffdf2012b9 160 );
cho45 33:6a2301a89e92 161 wait_us(1);
cho45 13:b0ffdf2012b9 162 keys[i+8] = gpio2.read8(MCP23017::GPIOB, ok);
cho45 13:b0ffdf2012b9 163 }
cho45 13:b0ffdf2012b9 164
cho45 13:b0ffdf2012b9 165 // set all output to negative for interrupt
cho45 13:b0ffdf2012b9 166 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 167 MCP23017::GPIOA,
cho45 13:b0ffdf2012b9 168 0b00000000
cho45 13:b0ffdf2012b9 169 );
cho45 13:b0ffdf2012b9 170 }
cho45 13:b0ffdf2012b9 171
cho45 13:b0ffdf2012b9 172 enableInterrupt();
cho45 7:b9270a37345b 173 }
cho45 13:b0ffdf2012b9 174
cho45 7:b9270a37345b 175 void disableInterrupt() {
cho45 7:b9270a37345b 176 int ok;
cho45 13:b0ffdf2012b9 177 if (gpio1_ready) {
cho45 13:b0ffdf2012b9 178 // Disable interrupt
cho45 13:b0ffdf2012b9 179 ok = gpio1.write8(
cho45 13:b0ffdf2012b9 180 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 181 0b00000000
cho45 13:b0ffdf2012b9 182 );
cho45 13:b0ffdf2012b9 183 }
cho45 13:b0ffdf2012b9 184
cho45 13:b0ffdf2012b9 185 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 186 // Disable interrupt
cho45 13:b0ffdf2012b9 187 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 188 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 189 0b00000000
cho45 13:b0ffdf2012b9 190 );
cho45 13:b0ffdf2012b9 191 }
cho45 33:6a2301a89e92 192
cho45 7:b9270a37345b 193 }
cho45 7:b9270a37345b 194
cho45 7:b9270a37345b 195 void enableInterrupt() {
cho45 7:b9270a37345b 196 int ok;
cho45 13:b0ffdf2012b9 197 if (gpio1_ready) {
cho45 13:b0ffdf2012b9 198 // Enable interrupt
cho45 13:b0ffdf2012b9 199 ok = gpio1.write8(
cho45 13:b0ffdf2012b9 200 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 201 0b11111111
cho45 13:b0ffdf2012b9 202 );
cho45 13:b0ffdf2012b9 203 }
cho45 13:b0ffdf2012b9 204
cho45 13:b0ffdf2012b9 205 if (gpio2_ready) {
cho45 13:b0ffdf2012b9 206 // Enable interrupt
cho45 13:b0ffdf2012b9 207 ok = gpio2.write8(
cho45 13:b0ffdf2012b9 208 MCP23017::GPINTENB,
cho45 13:b0ffdf2012b9 209 0b11111111
cho45 13:b0ffdf2012b9 210 );
cho45 13:b0ffdf2012b9 211 }
cho45 5:65d4e94735b6 212
cho45 5:65d4e94735b6 213 // Clear interrupt
cho45 13:b0ffdf2012b9 214 // gpio1.read8(MCP23017::GPIOB, ok);
cho45 4:54cb552e50c4 215 }
cho45 5:65d4e94735b6 216 };
cho45 4:54cb552e50c4 217
cho45 5:65d4e94735b6 218 I2C i2c(I2C_SDA0, I2C_SCL0);
cho45 16:345eebc4f259 219 // Serial serial(USBTX, USBRX);
cho45 5:65d4e94735b6 220 KeyboardMatrixController keyboardMatrixController(i2c);
cho45 6:f1c3ea8bc850 221 Keymap keymap;
cho45 15:70bf079d3ee1 222
cho45 15:70bf079d3ee1 223 // Interrupt from MCP23017
cho45 15:70bf079d3ee1 224 // (pulled-up and two MCP23017 is configured with open drain INT)
cho45 5:65d4e94735b6 225 InterruptIn buttonInt(P0_5);
cho45 5:65d4e94735b6 226
cho45 28:1f843a3daab0 227 DigitalOut statusLed(P0_4, 0);
cho45 26:78ee13f69ec3 228
cho45 25:094df0d9e95b 229
cho45 15:70bf079d3ee1 230 // Unsed pins. Set to output for power consumption
cho45 20:d8840ac38434 231 DigitalIn unused_p0_7(P0_7, PullUp);
cho45 20:d8840ac38434 232 DigitalIn unused_p0_6(P0_6, PullUp);
cho45 20:d8840ac38434 233 DigitalIn unused_p0_15(P0_15, PullUp);
cho45 20:d8840ac38434 234 DigitalIn unused_p0_29(P0_29, PullUp);
cho45 20:d8840ac38434 235 DigitalIn unused_p0_28(P0_28, PullUp);
cho45 20:d8840ac38434 236 DigitalIn unused_p0_19(P0_19, PullUp); // This is on board LED which connected to VDD
cho45 22:a78f0a91280a 237 DigitalIn unused_p0_11(P0_11, PullUp); // RXD
cho45 15:70bf079d3ee1 238
cho45 5:65d4e94735b6 239 // ROWS=8
cho45 5:65d4e94735b6 240 // COLS=16
cho45 5:65d4e94735b6 241 // 列ごとに1バイトにパックしてキーの状態を保持する
cho45 5:65d4e94735b6 242 static uint8_t keysA[COLS];
cho45 5:65d4e94735b6 243 static uint8_t keysB[COLS];
cho45 5:65d4e94735b6 244 static bool state = 0;
cho45 28:1f843a3daab0 245 #define is_pressed(keys, row, col) (!!(keys[col] & (1<<row)))
cho45 28:1f843a3daab0 246
cho45 9:d1daefbf1fbd 247 // delay for interrupt
cho45 23:b31957ce64e9 248 static volatile int8_t pollCount = 50;
cho45 5:65d4e94735b6 249
cho45 5:65d4e94735b6 250 void buttonIntCallback() {
cho45 8:d684faf04c9a 251 // just for wakeup
cho45 33:6a2301a89e92 252 pollCount = 25;
cho45 2:c2e3f240640c 253 }
cho45 2:c2e3f240640c 254
cho45 23:b31957ce64e9 255 void powerOff() {
cho45 23:b31957ce64e9 256 printf("power off\r\n");
cho45 23:b31957ce64e9 257 NRF_POWER->SYSTEMOFF = 1;
cho45 23:b31957ce64e9 258 }
cho45 23:b31957ce64e9 259
cho45 26:78ee13f69ec3 260 void tickerStatus() {
cho45 28:1f843a3daab0 261 statusLed = !statusLed;
cho45 26:78ee13f69ec3 262 }
cho45 26:78ee13f69ec3 263
cho45 31:010a44d53627 264 static volatile bool timer1_interrupted = false;
cho45 31:010a44d53627 265 extern "C" void TIMER1_IRQHandler(void) {
cho45 31:010a44d53627 266 NRF_TIMER1->EVENTS_COMPARE[0] = 0;
cho45 31:010a44d53627 267 NRF_TIMER1->TASKS_CLEAR = 1;
cho45 31:010a44d53627 268 timer1_interrupted = true;
cho45 30:f9ebc769118d 269 }
cho45 30:f9ebc769118d 270
cho45 32:6c0f43fda460 271 class WatchDog {
cho45 32:6c0f43fda460 272 static const uint32_t RELOAD_VALUE = 0x6E524635;
cho45 33:6a2301a89e92 273 static const uint8_t WDT_TIMEOUT = 5; // sec
cho45 32:6c0f43fda460 274 public:
cho45 32:6c0f43fda460 275 static void init() {
cho45 32:6c0f43fda460 276 // timeout [s] = (CRV + 1) / 32768;
cho45 32:6c0f43fda460 277 // crv = 32768 * timeout - 1
cho45 32:6c0f43fda460 278 NRF_WDT->CRV = 32768 * WDT_TIMEOUT - 1;
cho45 32:6c0f43fda460 279 NRF_WDT->RREN = WDT_RREN_RR0_Enabled << WDT_RREN_RR0_Pos;
cho45 32:6c0f43fda460 280 NRF_WDT->CONFIG = WDT_CONFIG_SLEEP_Pause << WDT_CONFIG_SLEEP_Pos;
cho45 32:6c0f43fda460 281 NRF_WDT->TASKS_START = 1;
cho45 32:6c0f43fda460 282 }
cho45 32:6c0f43fda460 283
cho45 32:6c0f43fda460 284 static void reload() {
cho45 32:6c0f43fda460 285 NRF_WDT->RR[0] = RELOAD_VALUE;
cho45 32:6c0f43fda460 286 }
cho45 32:6c0f43fda460 287 };
cho45 28:1f843a3daab0 288
cho45 0:be89b5fdea09 289 int main(void) {
cho45 33:6a2301a89e92 290 {
cho45 33:6a2301a89e92 291 uint32_t reason = NRF_POWER->RESETREAS;
cho45 33:6a2301a89e92 292 NRF_POWER->RESETREAS = 0xffffffff; // clear reason
cho45 33:6a2301a89e92 293 printf("init [%x]\r\n", reason);
cho45 33:6a2301a89e92 294 }
cho45 33:6a2301a89e92 295
cho45 33:6a2301a89e92 296
cho45 33:6a2301a89e92 297
cho45 29:ec548c473d50 298
cho45 30:f9ebc769118d 299 // Enable Pin-reset on DEBUG mode
cho45 30:f9ebc769118d 300 // This makes possiable booting without normal mode easily.
cho45 30:f9ebc769118d 301 NRF_POWER->RESET = 1;
cho45 30:f9ebc769118d 302 // Disable Internal DC/DC step down converter surely
cho45 29:ec548c473d50 303 NRF_POWER->DCDCEN = 0;
cho45 30:f9ebc769118d 304 // Enable 2.1V brown out detection for avoiding over discharge of NiMH
cho45 29:ec548c473d50 305 NRF_POWER->POFCON =
cho45 29:ec548c473d50 306 POWER_POFCON_POF_Enabled << POWER_POFCON_POF_Pos |
cho45 29:ec548c473d50 307 POWER_POFCON_THRESHOLD_V21 << POWER_POFCON_THRESHOLD_Pos;
cho45 29:ec548c473d50 308
cho45 4:54cb552e50c4 309 // mbed's Serial of TARGET_RBLAB_BLENANO sucks
cho45 30:f9ebc769118d 310 // DO NOT CONNECT RTS/CTS WITHOUT PRIOR CONSENT!
cho45 4:54cb552e50c4 311 NRF_UART0->PSELRTS = 0xFFFFFFFFUL;
cho45 4:54cb552e50c4 312 NRF_UART0->PSELCTS = 0xFFFFFFFFUL;
cho45 16:345eebc4f259 313
cho45 31:010a44d53627 314 // Setup timer for just wakeup from sleep
cho45 31:010a44d53627 315 NRF_TIMER1->TASKS_STOP = 1;
cho45 31:010a44d53627 316 NRF_TIMER1->PRESCALER = 4; // f = HFCLK / 2^N => 1MHz timer
cho45 31:010a44d53627 317 // TIMER1 is 16bit timer
cho45 31:010a44d53627 318 NRF_TIMER1->BITMODE = TIMER_BITMODE_BITMODE_16Bit << TIMER_BITMODE_BITMODE_Pos;
cho45 31:010a44d53627 319 NRF_TIMER1->MODE = TIMER_MODE_MODE_Timer << TIMER_MODE_MODE_Pos;
cho45 31:010a44d53627 320 NVIC_SetPriority(TIMER1_IRQn, 3);
cho45 31:010a44d53627 321 NVIC_ClearPendingIRQ(TIMER1_IRQn);
cho45 31:010a44d53627 322 NVIC_EnableIRQ(TIMER1_IRQn);
cho45 31:010a44d53627 323
cho45 32:6c0f43fda460 324 WatchDog::init();
cho45 31:010a44d53627 325
cho45 4:54cb552e50c4 326 // 100kHz
cho45 4:54cb552e50c4 327 i2c.frequency(100000);
cho45 4:54cb552e50c4 328
cho45 5:65d4e94735b6 329 buttonInt.mode(PullUp);
cho45 5:65d4e94735b6 330 buttonInt.fall(buttonIntCallback);
cho45 4:54cb552e50c4 331
cho45 5:65d4e94735b6 332 keyboardMatrixController.init();
cho45 33:6a2301a89e92 333 pollCount = 10;
cho45 4:54cb552e50c4 334
cho45 6:f1c3ea8bc850 335 HIDController::init();
cho45 16:345eebc4f259 336
cho45 16:345eebc4f259 337 // STOP UART RX for power consumption
cho45 21:d801c32231b0 338 NRF_UART0->TASKS_STOPRX = 1;
cho45 16:345eebc4f259 339
cho45 30:f9ebc769118d 340 // Disable TWI by default.
cho45 16:345eebc4f259 341 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 342
cho45 32:6c0f43fda460 343 while (1) {
cho45 32:6c0f43fda460 344 WatchDog::reload();
cho45 23:b31957ce64e9 345 if (pollCount > 0) {
cho45 23:b31957ce64e9 346 printf("scan keys\r\n");
cho45 31:010a44d53627 347
cho45 33:6a2301a89e92 348 while (pollCount-- > 0) {
cho45 33:6a2301a89e92 349 WatchDog::reload();
cho45 33:6a2301a89e92 350
cho45 23:b31957ce64e9 351 uint8_t (&keysCurr)[COLS] = state ? keysA : keysB;
cho45 23:b31957ce64e9 352 uint8_t (&keysPrev)[COLS] = state ? keysB : keysA;
cho45 23:b31957ce64e9 353
cho45 23:b31957ce64e9 354 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Enabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 355 keyboardMatrixController.scanKeyboard(keysCurr);
cho45 23:b31957ce64e9 356 NRF_TWI0->ENABLE = TWI_ENABLE_ENABLE_Disabled << TWI_ENABLE_ENABLE_Pos;
cho45 23:b31957ce64e9 357
cho45 23:b31957ce64e9 358 bool queue = false;
cho45 23:b31957ce64e9 359
cho45 23:b31957ce64e9 360 for (int col = 0; col < COLS; col++) {
cho45 23:b31957ce64e9 361 uint8_t changed = keysPrev[col] ^ keysCurr[col];
cho45 23:b31957ce64e9 362 if (changed) queue = true;
cho45 23:b31957ce64e9 363 for (int row = 0; row < ROWS; row++) {
cho45 23:b31957ce64e9 364 if (changed & (1<<row)) {
cho45 23:b31957ce64e9 365 bool pressed = keysCurr[col] & (1<<row);
cho45 23:b31957ce64e9 366 // printf("changed: col=%d, row=%d / pressed=%d\r\n", col, row, pressed);
cho45 23:b31957ce64e9 367 keymap.execute(col, row, pressed);
cho45 23:b31957ce64e9 368 }
cho45 7:b9270a37345b 369 }
cho45 7:b9270a37345b 370 }
cho45 23:b31957ce64e9 371 state = !state;
cho45 23:b31957ce64e9 372
cho45 23:b31957ce64e9 373
cho45 23:b31957ce64e9 374 if (queue) HIDController::queueCurrentReportData();
cho45 30:f9ebc769118d 375
cho45 31:010a44d53627 376 // wait_ms(5); is busy loop
cho45 31:010a44d53627 377 // use timer1 to use wait 5ms
cho45 31:010a44d53627 378 NRF_TIMER1->CC[0] = 1e6 / 200; // 5ms
cho45 31:010a44d53627 379 NRF_TIMER1->EVENTS_COMPARE[0] = 0;
cho45 31:010a44d53627 380 NRF_TIMER1->TASKS_CLEAR = 1;
cho45 31:010a44d53627 381 NRF_TIMER1->INTENSET = TIMER_INTENSET_COMPARE0_Set << TIMER_INTENSET_COMPARE0_Pos;
cho45 31:010a44d53627 382 NRF_TIMER1->TASKS_START = 1;
cho45 31:010a44d53627 383 while (!timer1_interrupted) sleep();
cho45 31:010a44d53627 384 timer1_interrupted = false;
cho45 31:010a44d53627 385 NRF_TIMER1->INTENCLR = TIMER_INTENCLR_COMPARE0_Clear << TIMER_INTENCLR_COMPARE0_Pos;
cho45 31:010a44d53627 386 NRF_TIMER1->TASKS_STOP = 1;
cho45 7:b9270a37345b 387 }
cho45 30:f9ebc769118d 388
cho45 31:010a44d53627 389 printf("disable int\r\n");
cho45 31:010a44d53627 390 NRF_TIMER1->TASKS_SHUTDOWN = 1;
cho45 8:d684faf04c9a 391 } else {
cho45 32:6c0f43fda460 392 printf("[%d:%s] wait for events...\r\n", HIDController::status(), HIDController::statusString());
cho45 29:ec548c473d50 393
cho45 30:f9ebc769118d 394 // allow printf in some interrupts while connecting
cho45 29:ec548c473d50 395 if (HIDController::connected()) {
cho45 30:f9ebc769118d 396 // disable internal HFCLK RC Clock surely. It consume 1mA constantly
cho45 30:f9ebc769118d 397 // TWI / SPI / UART must be disabled and boot without debug mode
cho45 29:ec548c473d50 398 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 399
cho45 29:ec548c473d50 400 uint32_t tx = NRF_UART0->PSELTXD;
cho45 29:ec548c473d50 401
cho45 29:ec548c473d50 402 NRF_UART0->TASKS_STOPTX = 1;
cho45 29:ec548c473d50 403 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Disabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 404
cho45 29:ec548c473d50 405 HIDController::waitForEvent();
cho45 29:ec548c473d50 406
cho45 29:ec548c473d50 407 NRF_UART0->ENABLE = (UART_ENABLE_ENABLE_Enabled << UART_ENABLE_ENABLE_Pos);
cho45 29:ec548c473d50 408 NRF_UART0->TASKS_STARTTX = 1;
cho45 30:f9ebc769118d 409 // dummy send to wakeup...
cho45 29:ec548c473d50 410 NRF_UART0->PSELTXD = 0xFFFFFFFF;
cho45 29:ec548c473d50 411 NRF_UART0->EVENTS_TXDRDY = 0;
cho45 29:ec548c473d50 412 NRF_UART0->TXD = 0;
cho45 29:ec548c473d50 413 while (NRF_UART0->EVENTS_TXDRDY != 1);
cho45 29:ec548c473d50 414 NRF_UART0->PSELTXD = tx;
cho45 29:ec548c473d50 415 } else {
cho45 29:ec548c473d50 416 HIDController::waitForEvent();
cho45 29:ec548c473d50 417 }
cho45 7:b9270a37345b 418 }
cho45 2:c2e3f240640c 419 }
cho45 31:010a44d53627 420 }