quantum/dynamic_keymap.c

   1 /* Copyright 2017 Jason Williams (Wilba)
   2  *
   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  *
   8  * This program is distributed in the hope that it will be useful,
   9  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  11  * GNU General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16
  17 #include "config.h"
  18 #include "keymap.h" // to get keymaps[][][]
  19 #include "tmk_core/common/eeprom.h"
  20 #include "progmem.h" // to read default from flash
  21
  22 #include "dynamic_keymap.h"
  23
  24 #ifdef DYNAMIC_KEYMAP_ENABLE
  25
  26 #ifndef DYNAMIC_KEYMAP_EEPROM_ADDR
  27 #error DYNAMIC_KEYMAP_EEPROM_ADDR not defined
  28 #endif
  29
  30 #ifndef DYNAMIC_KEYMAP_LAYER_COUNT
  31 #error DYNAMIC_KEYMAP_LAYER_COUNT not defined
  32 #endif
  33
  34 void *dynamic_keymap_key_to_eeprom_address(uint8_t layer, uint8_t row, uint8_t column)
  35 {
  36         // TODO: optimize this with some left shifts
  37         return ((void*)DYNAMIC_KEYMAP_EEPROM_ADDR) + ( layer * MATRIX_ROWS * MATRIX_COLS * 2 ) +
  38                 ( row * MATRIX_COLS * 2 ) + ( column * 2 );
  39 }
  40
  41 uint16_t dynamic_keymap_get_keycode(uint8_t layer, uint8_t row, uint8_t column)
  42 {
  43         void *address = dynamic_keymap_key_to_eeprom_address(layer, row, column);
  44         // Big endian, so we can read/write EEPROM directly from host if we want
  45         uint16_t keycode = eeprom_read_byte(address) << 8;
  46         keycode |= eeprom_read_byte(address + 1);
  47         return keycode;
  48 }
  49
  50 void dynamic_keymap_set_keycode(uint8_t layer, uint8_t row, uint8_t column, uint16_t keycode)
  51 {
  52         void *address = dynamic_keymap_key_to_eeprom_address(layer, row, column);
  53         // Big endian, so we can read/write EEPROM directly from host if we want
  54         eeprom_update_byte(address, (uint8_t)(keycode >> 8));
  55         eeprom_update_byte(address+1, (uint8_t)(keycode & 0xFF));
  56 }
  57
  58 void dynamic_keymap_reset(void)
  59 {
  60         // Reset the keymaps in EEPROM to what is in flash.
  61         // All keyboards using dynamic keymaps should define a layout
  62         // for the same number of layers as DYNAMIC_KEYMAP_LAYER_COUNT.
  63         for ( int layer = 0; layer < DYNAMIC_KEYMAP_LAYER_COUNT; layer++ )      {
  64                 for ( int row = 0; row < MATRIX_ROWS; row++ ) {
  65                         for ( int column = 0; column < MATRIX_COLS; column++ )  {
  66                                 dynamic_keymap_set_keycode(layer, row, column, pgm_read_word(&keymaps[layer][row][column]));
  67                         }
  68                 }
  69         }
  70 }
  71
  72 // This overrides the one in quantum/keymap_common.c
  73 uint16_t keymap_key_to_keycode(uint8_t layer, keypos_t key)
  74 {
  75         if ( layer < DYNAMIC_KEYMAP_LAYER_COUNT &&
  76                         key.row < MATRIX_ROWS &&
  77                         key.col < MATRIX_COLS ) {
  78                 return dynamic_keymap_get_keycode(layer, key.row, key.col);
  79         } else {
  80                 return KC_NO;
  81         }
  82 }
  83
  84 #endif // DYNAMIC_KEYMAP_ENABLE
  85