Mercurial > louis > kiibohd-controller
annotate Scan/MatrixARM/matrix_scan.c @ 299:c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
By default:
DebounceThrottleDiv = 0;
This is the default infinity behaviour right now (may be changed in the future).
Increasing DebounceThrottleDiv will increase the scan rate divider.
DebounceThrottleDiv = 1; # Scans half as much
DebounceThrottleDiv = 2; # Scans a quarter as much
DebounceThrottleDiv = 3; # Scans an eigth as much
etc.
For ARM based uCs (like the Infinity) the maximum divider is 32.
author | Jacob Alexander <haata@kiibohd.com> |
---|---|
date | Fri, 06 Mar 2015 22:18:15 -0800 |
parents | 57f40871c726 |
children | e464aaa4730f |
rev | line source |
---|---|
293
57f40871c726
Adding configurable DebounceDivThreshold
Jacob Alexander <haata@kiibohd.com>
parents:
239
diff
changeset
|
1 /* Copyright (C) 2014-2015 by Jacob Alexander |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
2 * |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
3 * Permission is hereby granted, free of charge, to any person obtaining a copy |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
4 * of this software and associated documentation files (the "Software"), to deal |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
5 * in the Software without restriction, including without limitation the rights |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
6 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
7 * copies of the Software, and to permit persons to whom the Software is |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
8 * furnished to do so, subject to the following conditions: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
9 * |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
10 * The above copyright notice and this permission notice shall be included in |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
11 * all copies or substantial portions of the Software. |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
12 * |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
13 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
14 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
15 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
16 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
17 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
18 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
19 * THE SOFTWARE. |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
20 */ |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
21 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
22 // ----- Includes ----- |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
23 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
24 // Compiler Includes |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
25 #include <Lib/ScanLib.h> |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
26 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
27 // Project Includes |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
28 #include <cli.h> |
299
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
29 #include <kll.h> |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
30 #include <led.h> |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
31 #include <print.h> |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
32 #include <macro.h> |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
33 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
34 // Local Includes |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
35 #include "matrix_scan.h" |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
36 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
37 // Matrix Configuration |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
38 #include <matrix.h> |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
39 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
40 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
41 |
299
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
42 // ----- Defines ----- |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
43 |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
44 #if ( DebounceThrottleDiv_define > 0 ) |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
45 nat_ptr_t Matrix_divCounter = 0; |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
46 #endif |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
47 |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
48 |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
49 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
50 // ----- Function Declarations ----- |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
51 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
52 // CLI Functions |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
53 void cliFunc_matrixDebug( char* args ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
54 void cliFunc_matrixState( char* args ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
55 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
56 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
57 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
58 // ----- Variables ----- |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
59 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
60 // Scan Module command dictionary |
239
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
61 CLIDict_Entry( matrixDebug, "Enables matrix debug mode, prints out each scan code." NL "\t\tIf argument \033[35mT\033[0m is given, prints out each scan code state transition." ); |
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
62 CLIDict_Entry( matrixState, "Prints out the current scan table N times." NL "\t\t \033[1mO\033[0m - Off, \033[1;33mP\033[0m - Press, \033[1;32mH\033[0m - Hold, \033[1;35mR\033[0m - Release, \033[1;31mI\033[0m - Invalid" ); |
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
63 |
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
64 CLIDict_Def( matrixCLIDict, "Matrix Module Commands" ) = { |
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
65 CLIDict_Item( matrixDebug ), |
2a4c99da1276
HUGE AVR RAM optimization (~28%).
Jacob Alexander <haata@kiibohd.com>
parents:
195
diff
changeset
|
66 CLIDict_Item( matrixState ), |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
67 { 0, 0, 0 } // Null entry for dictionary end |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
68 }; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
69 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
70 // Debounce Array |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
71 KeyState Matrix_scanArray[ Matrix_colsNum * Matrix_rowsNum ]; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
72 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
73 // Matrix debug flag - If set to 1, for each keypress the scan code is displayed in hex |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
74 // If set to 2, for each key state change, the scan code is displayed along with the state |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
75 uint8_t matrixDebugMode = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
76 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
77 // Matrix State Table Debug Counter - If non-zero display state table after every matrix scan |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
78 uint16_t matrixDebugStateCounter = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
79 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
80 // Matrix Scan Counters |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
81 uint16_t matrixMaxScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
82 uint16_t matrixCurScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
83 uint16_t matrixPrevScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
84 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
85 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
86 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
87 // ----- Functions ----- |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
88 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
89 // Pin action (Strobe, Sense, Strobe Setup, Sense Setup) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
90 // NOTE: This function is highly dependent upon the organization of the register map |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
91 // Only guaranteed to work with Freescale MK20 series uCs |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
92 uint8_t Matrix_pin( GPIO_Pin gpio, Type type ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
93 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
94 // Register width is defined as size of a pointer |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
95 unsigned int gpio_offset = gpio.port * 0x40 / sizeof(unsigned int*); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
96 unsigned int port_offset = gpio.port * 0x1000 / sizeof(unsigned int*) + gpio.pin; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
97 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
98 // Assumes 0x40 between GPIO Port registers and 0x1000 between PORT pin registers |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
99 // See Lib/mk20dx.h |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
100 volatile unsigned int *GPIO_PDDR = (unsigned int*)(&GPIOA_PDDR) + gpio_offset; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
101 volatile unsigned int *GPIO_PSOR = (unsigned int*)(&GPIOA_PSOR) + gpio_offset; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
102 volatile unsigned int *GPIO_PCOR = (unsigned int*)(&GPIOA_PCOR) + gpio_offset; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
103 volatile unsigned int *GPIO_PDIR = (unsigned int*)(&GPIOA_PDIR) + gpio_offset; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
104 volatile unsigned int *PORT_PCR = (unsigned int*)(&PORTA_PCR0) + port_offset; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
105 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
106 // Operation depends on Type |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
107 switch ( type ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
108 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
109 case Type_StrobeOn: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
110 *GPIO_PSOR |= (1 << gpio.pin); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
111 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
112 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
113 case Type_StrobeOff: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
114 *GPIO_PCOR |= (1 << gpio.pin); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
115 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
116 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
117 case Type_StrobeSetup: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
118 // Set as output pin |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
119 *GPIO_PDDR |= (1 << gpio.pin); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
120 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
121 // Configure pin with slow slew, high drive strength and GPIO mux |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
122 *PORT_PCR = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
123 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
124 // Enabling open-drain if specified |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
125 switch ( Matrix_type ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
126 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
127 case Config_Opendrain: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
128 *PORT_PCR |= PORT_PCR_ODE; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
129 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
130 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
131 // Do nothing otherwise |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
132 default: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
133 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
134 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
135 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
136 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
137 case Type_Sense: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
138 return *GPIO_PDIR & (1 << gpio.pin) ? 1 : 0; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
139 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
140 case Type_SenseSetup: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
141 // Set as input pin |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
142 *GPIO_PDDR &= ~(1 << gpio.pin); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
143 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
144 // Configure pin with passive filter and GPIO mux |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
145 *PORT_PCR = PORT_PCR_PFE | PORT_PCR_MUX(1); |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
146 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
147 // Pull resistor config |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
148 switch ( Matrix_type ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
149 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
150 case Config_Pullup: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
151 *PORT_PCR |= PORT_PCR_PE | PORT_PCR_PS; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
152 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
153 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
154 case Config_Pulldown: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
155 *PORT_PCR |= PORT_PCR_PE; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
156 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
157 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
158 // Do nothing otherwise |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
159 default: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
160 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
161 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
162 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
163 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
164 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
165 return 0; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
166 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
167 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
168 // Setup GPIO pins for matrix scanning |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
169 void Matrix_setup() |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
170 { |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
171 // Register Matrix CLI dictionary |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
172 CLI_registerDictionary( matrixCLIDict, matrixCLIDictName ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
173 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
174 info_msg("Columns: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
175 printHex( Matrix_colsNum ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
176 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
177 // Setup Strobe Pins |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
178 for ( uint8_t pin = 0; pin < Matrix_colsNum; pin++ ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
179 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
180 Matrix_pin( Matrix_cols[ pin ], Type_StrobeSetup ); |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
181 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
182 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
183 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
184 info_msg("Rows: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
185 printHex( Matrix_rowsNum ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
186 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
187 // Setup Sense Pins |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
188 for ( uint8_t pin = 0; pin < Matrix_rowsNum; pin++ ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
189 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
190 Matrix_pin( Matrix_rows[ pin ], Type_SenseSetup ); |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
191 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
192 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
193 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
194 info_msg("Max Keys: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
195 printHex( Matrix_maxKeys ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
196 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
197 // Clear out Debounce Array |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
198 for ( uint8_t item = 0; item < Matrix_maxKeys; item++ ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
199 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
200 Matrix_scanArray[ item ].prevState = KeyState_Off; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
201 Matrix_scanArray[ item ].curState = KeyState_Off; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
202 Matrix_scanArray[ item ].activeCount = 0; |
293
57f40871c726
Adding configurable DebounceDivThreshold
Jacob Alexander <haata@kiibohd.com>
parents:
239
diff
changeset
|
203 Matrix_scanArray[ item ].inactiveCount = DebounceDivThreshold_define; // Start at 'off' steady state |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
204 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
205 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
206 // Clear scan stats counters |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
207 matrixMaxScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
208 matrixPrevScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
209 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
210 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
211 void Matrix_keyPositionDebug( KeyPosition pos ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
212 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
213 // Depending on the state, use a different flag + color |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
214 switch ( pos ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
215 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
216 case KeyState_Off: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
217 print("\033[1mO\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
218 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
219 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
220 case KeyState_Press: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
221 print("\033[1;33mP\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
222 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
223 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
224 case KeyState_Hold: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
225 print("\033[1;32mH\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
226 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
227 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
228 case KeyState_Release: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
229 print("\033[1;35mR\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
230 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
231 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
232 case KeyState_Invalid: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
233 default: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
234 print("\033[1;31mI\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
235 break; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
236 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
237 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
238 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
239 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
240 // Scan the matrix for keypresses |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
241 // NOTE: scanNum should be reset to 0 after a USB send (to reset all the counters) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
242 void Matrix_scan( uint16_t scanNum ) |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
243 { |
299
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
244 #if ( DebounceThrottleDiv_define > 0 ) |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
245 // Scan-rate throttling |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
246 // By scanning using a divider, the scan rate slowed down |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
247 // DebounceThrottleDiv_define == 1 means -> /2 or half scan rate |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
248 // This helps with bouncy switches on fast uCs |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
249 if ( !( Matrix_divCounter++ & (1 << ( DebounceThrottleDiv_define - 1 )) ) ) |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
250 return; |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
251 #endif |
c856f826bd49
Adding DebounceThrottleDiv define to slow down the debounce rate.
Jacob Alexander <haata@kiibohd.com>
parents:
293
diff
changeset
|
252 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
253 // Increment stats counters |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
254 if ( scanNum > matrixMaxScans ) matrixMaxScans = scanNum; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
255 if ( scanNum == 0 ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
256 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
257 matrixPrevScans = matrixCurScans; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
258 matrixCurScans = 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
259 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
260 else |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
261 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
262 matrixCurScans++; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
263 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
264 |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
265 // For each strobe, scan each of the sense pins |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
266 for ( uint8_t strobe = 0; strobe < Matrix_colsNum; strobe++ ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
267 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
268 // Strobe Pin |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
269 Matrix_pin( Matrix_cols[ strobe ], Type_StrobeOn ); |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
270 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
271 // Scan each of the sense pins |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
272 for ( uint8_t sense = 0; sense < Matrix_rowsNum; sense++ ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
273 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
274 // Key position |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
275 uint8_t key = Matrix_colsNum * sense + strobe; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
276 KeyState *state = &Matrix_scanArray[ key ]; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
277 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
278 // If first scan, reset state |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
279 if ( scanNum == 0 ) |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
280 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
281 // Set previous state, and reset current state |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
282 state->prevState = state->curState; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
283 state->curState = KeyState_Invalid; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
284 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
285 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
286 // Signal Detected |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
287 // Increment count and right shift opposing count |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
288 // This means there is a maximum of scan 13 cycles on a perfect off to on transition |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
289 // (coming from a steady state 0xFFFF off scans) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
290 // Somewhat longer with switch bounciness |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
291 // The advantage of this is that the count is ongoing and never needs to be reset |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
292 // State still needs to be kept track of to deal with what to send to the Macro module |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
293 if ( Matrix_pin( Matrix_rows[ sense ], Type_Sense ) ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
294 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
295 // Only update if not going to wrap around |
293
57f40871c726
Adding configurable DebounceDivThreshold
Jacob Alexander <haata@kiibohd.com>
parents:
239
diff
changeset
|
296 if ( state->activeCount < DebounceDivThreshold_define ) state->activeCount += 1; |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
297 state->inactiveCount >>= 1; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
298 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
299 // Signal Not Detected |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
300 else |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
301 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
302 // Only update if not going to wrap around |
293
57f40871c726
Adding configurable DebounceDivThreshold
Jacob Alexander <haata@kiibohd.com>
parents:
239
diff
changeset
|
303 if ( state->inactiveCount < DebounceDivThreshold_define ) state->inactiveCount += 1; |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
304 state->activeCount >>= 1; |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
305 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
306 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
307 // Check for state change if it hasn't been set |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
308 // Only check if the minimum number of scans has been met |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
309 // the current state is invalid |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
310 // and either active or inactive count is over the debounce threshold |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
311 if ( state->curState == KeyState_Invalid ) |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
312 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
313 switch ( state->prevState ) |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
314 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
315 case KeyState_Press: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
316 case KeyState_Hold: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
317 if ( state->activeCount > state->inactiveCount ) |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
318 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
319 state->curState = KeyState_Hold; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
320 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
321 else |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
322 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
323 state->curState = KeyState_Release; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
324 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
325 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
326 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
327 case KeyState_Release: |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
328 case KeyState_Off: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
329 if ( state->activeCount > state->inactiveCount ) |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
330 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
331 state->curState = KeyState_Press; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
332 } |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
333 else |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
334 { |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
335 state->curState = KeyState_Off; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
336 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
337 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
338 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
339 case KeyState_Invalid: |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
340 default: |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
341 erro_print("Matrix scan bug!! Report me!"); |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
342 break; |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
343 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
344 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
345 // Send keystate to macro module |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
346 Macro_keyState( key, state->curState ); |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
347 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
348 // Matrix Debug, only if there is a state change |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
349 if ( matrixDebugMode && state->curState != state->prevState ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
350 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
351 // Basic debug output |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
352 if ( matrixDebugMode == 1 && state->curState == KeyState_Press ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
353 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
354 printHex( key ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
355 print(" "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
356 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
357 // State transition debug output |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
358 else if ( matrixDebugMode == 2 ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
359 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
360 printHex( key ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
361 Matrix_keyPositionDebug( state->curState ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
362 print(" "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
363 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
364 } |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
365 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
366 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
367 |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
368 // Unstrobe Pin |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
369 Matrix_pin( Matrix_cols[ strobe ], Type_StrobeOff ); |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
370 } |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
371 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
372 // State Table Output Debug |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
373 if ( matrixDebugStateCounter > 0 ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
374 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
375 // Decrement counter |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
376 matrixDebugStateCounter--; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
377 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
378 // Output stats on number of scans being done per USB send |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
379 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
380 info_msg("Max scans: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
381 printHex( matrixMaxScans ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
382 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
383 info_msg("Previous scans: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
384 printHex( matrixPrevScans ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
385 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
386 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
387 // Output current scan number |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
388 info_msg("Scan Number: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
389 printHex( scanNum ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
390 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
391 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
392 // Display the state info for each key |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
393 print("<key>:<previous state><current state> <active count> <inactive count>"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
394 for ( uint8_t key = 0; key < Matrix_maxKeys; key++ ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
395 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
396 // Every 4 keys, put a newline |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
397 if ( key % 4 == 0 ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
398 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
399 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
400 print("\033[1m0x"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
401 printHex_op( key, 2 ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
402 print("\033[0m"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
403 print(":"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
404 Matrix_keyPositionDebug( Matrix_scanArray[ key ].prevState ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
405 Matrix_keyPositionDebug( Matrix_scanArray[ key ].curState ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
406 print(" 0x"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
407 printHex_op( Matrix_scanArray[ key ].activeCount, 4 ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
408 print(" 0x"); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
409 printHex_op( Matrix_scanArray[ key ].inactiveCount, 4 ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
410 print(" "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
411 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
412 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
413 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
414 } |
186
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
415 } |
50702debf278
Initial MatrixARM implementation
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
416 |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
417 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
418 // ----- CLI Command Functions ----- |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
419 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
420 void cliFunc_matrixDebug ( char* args ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
421 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
422 // Parse number from argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
423 // NOTE: Only first argument is used |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
424 char* arg1Ptr; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
425 char* arg2Ptr; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
426 CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
427 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
428 // Set the matrix debug flag depending on the argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
429 // If no argument, set to scan code only |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
430 // If set to T, set to state transition |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
431 switch ( arg1Ptr[0] ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
432 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
433 // T as argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
434 case 'T': |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
435 case 't': |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
436 matrixDebugMode = matrixDebugMode != 2 ? 2 : 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
437 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
438 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
439 // No argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
440 case '\0': |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
441 matrixDebugMode = matrixDebugMode != 1 ? 1 : 0; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
442 break; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
443 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
444 // Invalid argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
445 default: |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
446 return; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
447 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
448 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
449 print( NL ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
450 info_msg("Matrix Debug Mode: "); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
451 printInt8( matrixDebugMode ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
452 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
453 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
454 void cliFunc_matrixState ( char* args ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
455 { |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
456 // Parse number from argument |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
457 // NOTE: Only first argument is used |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
458 char* arg1Ptr; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
459 char* arg2Ptr; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
460 CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr ); |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
461 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
462 // Default to 1 if no argument is given |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
463 matrixDebugStateCounter = 1; |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
464 |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
465 if ( arg1Ptr[0] != '\0' ) |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
466 { |
195
58cfcb7bac88
Changing decToInt to numToInt (adds support for Hex number interpreter)
Jacob Alexander <haata@kiibohd.com>
parents:
192
diff
changeset
|
467 matrixDebugStateCounter = (uint16_t)numToInt( arg1Ptr ); |
187
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
468 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
469 } |
b250056298df
Matrix scanning for ARM now functional.
Jacob Alexander <haata@kiibohd.com>
parents:
186
diff
changeset
|
470 |