eager_pk.c 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. Copyright 2017 Alex Ong<the.onga@gmail.com>
  3. This program is free software: you can redistribute it and/or modify
  4. it under the terms of the GNU General Public License as published by
  5. the Free Software Foundation, either version 2 of the License, or
  6. (at your option) any later version.
  7. This program is distributed in the hope that it will be useful,
  8. but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. GNU General Public License for more details.
  11. You should have received a copy of the GNU General Public License
  12. along with this program. If not, see <http://www.gnu.org/licenses/>.
  13. */
  14. /*
  15. Basic per-key algorithm. Uses an 8-bit counter per key.
  16. After pressing a key, it immediately changes state, and sets a counter.
  17. No further inputs are accepted until DEBOUNCE milliseconds have occurred.
  18. */
  19. #include "matrix.h"
  20. #include "timer.h"
  21. #include "quantum.h"
  22. #include <stdlib.h>
  23. #ifndef DEBOUNCE
  24. # define DEBOUNCE 5
  25. #endif
  26. #if (MATRIX_COLS <= 8)
  27. # define ROW_SHIFTER ((uint8_t)1)
  28. #elif (MATRIX_COLS <= 16)
  29. # define ROW_SHIFTER ((uint16_t)1)
  30. #elif (MATRIX_COLS <= 32)
  31. # define ROW_SHIFTER ((uint32_t)1)
  32. #endif
  33. #define debounce_counter_t uint8_t
  34. static debounce_counter_t *debounce_counters;
  35. static bool counters_need_update;
  36. static bool matrix_need_update;
  37. #define DEBOUNCE_ELAPSED 251
  38. #define MAX_DEBOUNCE (DEBOUNCE_ELAPSED - 1)
  39. void update_debounce_counters(uint8_t num_rows, uint8_t current_time);
  40. void transfer_matrix_values(matrix_row_t raw[], matrix_row_t cooked[], uint8_t num_rows, uint8_t current_time);
  41. // we use num_rows rather than MATRIX_ROWS to support split keyboards
  42. void debounce_init(uint8_t num_rows) {
  43. debounce_counters = (debounce_counter_t *)malloc(num_rows * MATRIX_COLS * sizeof(debounce_counter_t));
  44. int i = 0;
  45. for (uint8_t r = 0; r < num_rows; r++) {
  46. for (uint8_t c = 0; c < MATRIX_COLS; c++) {
  47. debounce_counters[i++] = DEBOUNCE_ELAPSED;
  48. }
  49. }
  50. }
  51. void debounce(matrix_row_t raw[], matrix_row_t cooked[], uint8_t num_rows, bool changed) {
  52. uint8_t current_time = timer_read() % MAX_DEBOUNCE;
  53. if (counters_need_update) {
  54. update_debounce_counters(num_rows, current_time);
  55. }
  56. if (changed || matrix_need_update) {
  57. transfer_matrix_values(raw, cooked, num_rows, current_time);
  58. }
  59. }
  60. // If the current time is > debounce counter, set the counter to enable input.
  61. void update_debounce_counters(uint8_t num_rows, uint8_t current_time) {
  62. counters_need_update = false;
  63. debounce_counter_t *debounce_pointer = debounce_counters;
  64. for (uint8_t row = 0; row < num_rows; row++) {
  65. for (uint8_t col = 0; col < MATRIX_COLS; col++) {
  66. if (*debounce_pointer != DEBOUNCE_ELAPSED) {
  67. if (TIMER_DIFF(current_time, *debounce_pointer, MAX_DEBOUNCE) >= DEBOUNCE) {
  68. *debounce_pointer = DEBOUNCE_ELAPSED;
  69. } else {
  70. counters_need_update = true;
  71. }
  72. }
  73. debounce_pointer++;
  74. }
  75. }
  76. }
  77. // upload from raw_matrix to final matrix;
  78. void transfer_matrix_values(matrix_row_t raw[], matrix_row_t cooked[], uint8_t num_rows, uint8_t current_time) {
  79. matrix_need_update = false;
  80. debounce_counter_t *debounce_pointer = debounce_counters;
  81. for (uint8_t row = 0; row < num_rows; row++) {
  82. matrix_row_t delta = raw[row] ^ cooked[row];
  83. matrix_row_t existing_row = cooked[row];
  84. for (uint8_t col = 0; col < MATRIX_COLS; col++) {
  85. matrix_row_t col_mask = (ROW_SHIFTER << col);
  86. if (delta & col_mask) {
  87. if (*debounce_pointer == DEBOUNCE_ELAPSED) {
  88. *debounce_pointer = current_time;
  89. counters_need_update = true;
  90. existing_row ^= col_mask; // flip the bit.
  91. } else {
  92. matrix_need_update = true;
  93. }
  94. }
  95. debounce_pointer++;
  96. }
  97. cooked[row] = existing_row;
  98. }
  99. }
  100. bool debounce_active(void) { return true; }