Scan/MatrixARM/matrix_scan.c

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