1 /* 2 * Manage Keyboard Matrices 3 * 4 * Copyright (c) 2012 The Chromium OS Authors. 5 * (C) Copyright 2004 DENX Software Engineering, Wolfgang Denk, wd@denx.de 6 * 7 * SPDX-License-Identifier: GPL-2.0+ 8 */ 9 10 #include <common.h> 11 #include <fdtdec.h> 12 #include <key_matrix.h> 13 #include <malloc.h> 14 #include <linux/input.h> 15 16 /** 17 * Determine if the current keypress configuration can cause key ghosting 18 * 19 * We figure this out by seeing if we have two or more keys in the same 20 * column, as well as two or more keys in the same row. 21 * 22 * @param config Keyboard matrix config 23 * @param keys List of keys to check 24 * @param valid Number of valid keypresses to check 25 * @return 0 if no ghosting is possible, 1 if it is 26 */ 27 static int has_ghosting(struct key_matrix *config, struct key_matrix_key *keys, 28 int valid) 29 { 30 int key_in_same_col = 0, key_in_same_row = 0; 31 int i, j; 32 33 if (!config->ghost_filter || valid < 3) 34 return 0; 35 36 for (i = 0; i < valid; i++) { 37 /* 38 * Find 2 keys such that one key is in the same row 39 * and the other is in the same column as the i-th key. 40 */ 41 for (j = i + 1; j < valid; j++) { 42 if (keys[j].col == keys[i].col) 43 key_in_same_col = 1; 44 if (keys[j].row == keys[i].row) 45 key_in_same_row = 1; 46 } 47 } 48 49 if (key_in_same_col && key_in_same_row) 50 return 1; 51 else 52 return 0; 53 } 54 55 int key_matrix_decode(struct key_matrix *config, struct key_matrix_key keys[], 56 int num_keys, int keycode[], int max_keycodes) 57 { 58 const u8 *keymap; 59 int valid, upto; 60 int pos; 61 62 debug("%s: num_keys = %d\n", __func__, num_keys); 63 keymap = config->plain_keycode; 64 for (valid = upto = 0; upto < num_keys; upto++) { 65 struct key_matrix_key *key = &keys[upto]; 66 67 debug(" valid=%d, row=%d, col=%d\n", key->valid, key->row, 68 key->col); 69 if (!key->valid) 70 continue; 71 pos = key->row * config->num_cols + key->col; 72 if (config->fn_keycode && pos == config->fn_pos) 73 keymap = config->fn_keycode; 74 75 /* Convert the (row, col) values into a keycode */ 76 if (valid < max_keycodes) 77 keycode[valid++] = keymap[pos]; 78 debug(" keycode=%d\n", keymap[pos]); 79 } 80 81 /* For a ghost key config, ignore the keypresses for this iteration. */ 82 if (has_ghosting(config, keys, valid)) { 83 valid = 0; 84 debug(" ghosting detected!\n"); 85 } 86 debug(" %d valid keycodes found\n", valid); 87 88 return valid; 89 } 90 91 /** 92 * Create a new keycode map from some provided data 93 * 94 * This decodes a keycode map in the format used by the fdt, which is one 95 * word per entry, with the row, col and keycode encoded in that word. 96 * 97 * We create a (row x col) size byte array with each entry containing the 98 * keycode for that (row, col). We also search for map_keycode and return 99 * its position if found (this is used for finding the Fn key). 100 * 101 * @param config Key matrix dimensions structure 102 * @param data Keycode data 103 * @param len Number of entries in keycode table 104 * @param map_keycode Key code to find in the map 105 * @param pos Returns position of map_keycode, if found, else -1 106 * @return map Pointer to allocated map 107 */ 108 static uchar *create_keymap(struct key_matrix *config, u32 *data, int len, 109 int map_keycode, int *pos) 110 { 111 uchar *map; 112 113 if (pos) 114 *pos = -1; 115 map = (uchar *)calloc(1, config->key_count); 116 if (!map) { 117 debug("%s: failed to malloc %d bytes\n", __func__, 118 config->key_count); 119 return NULL; 120 } 121 122 for (; len >= sizeof(u32); data++, len -= 4) { 123 u32 tmp = fdt32_to_cpu(*data); 124 int key_code, row, col; 125 int entry; 126 127 row = (tmp >> 24) & 0xff; 128 col = (tmp >> 16) & 0xff; 129 key_code = tmp & 0xffff; 130 entry = row * config->num_cols + col; 131 map[entry] = key_code; 132 debug(" map %d, %d: pos=%d, keycode=%d\n", row, col, 133 entry, key_code); 134 if (pos && map_keycode == key_code) 135 *pos = entry; 136 } 137 138 return map; 139 } 140 141 int key_matrix_decode_fdt(struct key_matrix *config, const void *blob, int node) 142 { 143 const struct fdt_property *prop; 144 int proplen; 145 uchar *plain_keycode; 146 147 prop = fdt_get_property(blob, node, "linux,keymap", &proplen); 148 /* Basic keymap is required */ 149 if (!prop) { 150 debug("%s: cannot find keycode-plain map\n", __func__); 151 return -1; 152 } 153 154 plain_keycode = create_keymap(config, (u32 *)prop->data, 155 proplen, KEY_FN, &config->fn_pos); 156 config->plain_keycode = plain_keycode; 157 /* Conversion error -> fail */ 158 if (!config->plain_keycode) 159 return -1; 160 161 prop = fdt_get_property(blob, node, "linux,fn-keymap", &proplen); 162 /* fn keymap is optional */ 163 if (!prop) 164 goto done; 165 166 config->fn_keycode = create_keymap(config, (u32 *)prop->data, 167 proplen, -1, NULL); 168 /* Conversion error -> fail */ 169 if (!config->fn_keycode) { 170 free(plain_keycode); 171 return -1; 172 } 173 174 done: 175 debug("%s: Decoded key maps %p, %p from fdt\n", __func__, 176 config->plain_keycode, config->fn_keycode); 177 return 0; 178 } 179 180 int key_matrix_init(struct key_matrix *config, int rows, int cols, 181 int ghost_filter) 182 { 183 memset(config, '\0', sizeof(*config)); 184 config->num_rows = rows; 185 config->num_cols = cols; 186 config->key_count = rows * cols; 187 config->ghost_filter = ghost_filter; 188 assert(config->key_count > 0); 189 190 return 0; 191 } 192