Blame view
drivers/input/tegra-kbc.c
9.71 KB
6642a681e tegra: Add tegra ... |
1 2 3 4 |
/* * (C) Copyright 2011 * NVIDIA Corporation <www.nvidia.com> * |
1a4596601 Add GPL-2.0+ SPDX... |
5 |
* SPDX-License-Identifier: GPL-2.0+ |
6642a681e tegra: Add tegra ... |
6 7 8 9 10 11 12 13 14 15 16 |
*/ #include <common.h> #include <fdtdec.h> #include <input.h> #include <key_matrix.h> #include <stdio_dev.h> #include <tegra-kbc.h> #include <asm/io.h> #include <asm/arch/clock.h> #include <asm/arch/funcmux.h> |
150c24936 Tegra20: Move som... |
17 |
#include <asm/arch-tegra/timer.h> |
6642a681e tegra: Add tegra ... |
18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 |
#include <linux/input.h> DECLARE_GLOBAL_DATA_PTR; enum { KBC_MAX_GPIO = 24, KBC_MAX_KPENT = 8, /* size of keypress entry queue */ }; #define KBC_FIFO_TH_CNT_SHIFT 14 #define KBC_DEBOUNCE_CNT_SHIFT 4 #define KBC_CONTROL_FIFO_CNT_INT_EN (1 << 3) #define KBC_CONTROL_KBC_EN (1 << 0) #define KBC_INT_FIFO_CNT_INT_STATUS (1 << 2) #define KBC_KPENT_VALID (1 << 7) #define KBC_ST_STATUS (1 << 3) enum { KBC_DEBOUNCE_COUNT = 2, KBC_REPEAT_RATE_MS = 30, KBC_REPEAT_DELAY_MS = 240, KBC_CLOCK_KHZ = 32, /* Keyboard uses a 32KHz clock */ }; /* keyboard controller config and state */ static struct keyb { struct input_config input; /* The input layer */ struct key_matrix matrix; /* The key matrix layer */ struct kbc_tegra *kbc; /* tegra keyboard controller */ unsigned char inited; /* 1 if keyboard has been inited */ unsigned char first_scan; /* 1 if this is our first key scan */ |
1ed0b51b7 tegra: add CONSOL... |
50 |
unsigned char created; /* 1 if driver has been created */ |
6642a681e tegra: Add tegra ... |
51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 |
/* * After init we must wait a short time before polling the keyboard. * This gives the tegra keyboard controller time to react after reset * and lets us grab keys pressed during reset. */ unsigned int init_dly_ms; /* Delay before we can read keyboard */ unsigned int start_time_ms; /* Time that we inited (in ms) */ unsigned int last_poll_ms; /* Time we should last polled */ unsigned int next_repeat_ms; /* Next time we repeat a key */ } config; /** * reads the keyboard fifo for current keypresses * * @param config Keyboard config * @param fifo Place to put fifo results * @param max_keycodes Maximum number of key codes to put in the fifo * @return number of items put into fifo */ static int tegra_kbc_find_keys(struct keyb *config, int *fifo, int max_keycodes) { struct key_matrix_key keys[KBC_MAX_KPENT], *key; u32 kp_ent = 0; int i; for (key = keys, i = 0; i < KBC_MAX_KPENT; i++, key++) { /* Get next word */ if (!(i & 3)) kp_ent = readl(&config->kbc->kp_ent[i / 4]); key->valid = (kp_ent & KBC_KPENT_VALID) != 0; key->row = (kp_ent >> 3) & 0xf; key->col = kp_ent & 0x7; /* Shift to get next entry */ kp_ent >>= 8; } return key_matrix_decode(&config->matrix, keys, KBC_MAX_KPENT, fifo, max_keycodes); } /** * Process all the keypress sequences in fifo and send key codes * * The fifo contains zero or more keypress sets. Each set * consists of from 1-8 keycodes, representing the keycodes which * were simultaneously pressed during that scan. * * This function works through each set and generates ASCII characters * for each. Not that one set may produce more than one ASCII characters - * for example holding down 'd' and 'f' at the same time will generate * two ASCII characters. * * Note: if fifo_cnt is 0, we will tell the input layer that no keys are * pressed. * * @param config Keyboard config * @param fifo_cnt Number of entries in the keyboard fifo */ static void process_fifo(struct keyb *config, int fifo_cnt) { int fifo[KBC_MAX_KPENT]; int cnt = 0; /* Always call input_send_keycodes() at least once */ do { if (fifo_cnt) cnt = tegra_kbc_find_keys(config, fifo, KBC_MAX_KPENT); input_send_keycodes(&config->input, fifo, cnt); } while (--fifo_cnt > 0); } /** * Check the keyboard controller and emit ASCII characters for any keys that * are pressed. * * @param config Keyboard config */ static void check_for_keys(struct keyb *config) { int fifo_cnt; if (!config->first_scan && get_timer(config->last_poll_ms) < KBC_REPEAT_RATE_MS) return; config->last_poll_ms = get_timer(0); config->first_scan = 0; /* * Once we get here we know the keyboard has been scanned. So if there * scan waiting for us, we know that nothing is held down. */ fifo_cnt = (readl(&config->kbc->interrupt) >> 4) & 0xf; process_fifo(config, fifo_cnt); } /** * In order to detect keys pressed on boot, wait for the hardware to * complete scanning the keys. This includes time to transition from * Wkup mode to Continous polling mode and the repoll time. We can * deduct the time that's already elapsed. * * @param config Keyboard config */ static void kbd_wait_for_fifo_init(struct keyb *config) { if (!config->inited) { unsigned long elapsed_time; long delay_ms; elapsed_time = get_timer(config->start_time_ms); delay_ms = config->init_dly_ms - elapsed_time; if (delay_ms > 0) { udelay(delay_ms * 1000); debug("%s: delay %ldms ", __func__, delay_ms); } config->inited = 1; } } /** * Check the tegra keyboard, and send any keys that are pressed. * * This is called by input_tstc() and input_getc() when they need more * characters * * @param input Input configuration * @return 1, to indicate that we have something to look at */ int tegra_kbc_check(struct input_config *input) { kbd_wait_for_fifo_init(&config); check_for_keys(&config); return 1; } /** * Test if keys are available to be read * * @return 0 if no keys available, 1 if keys are available */ static int kbd_tstc(void) { /* Just get input to do this for us */ return input_tstc(&config.input); } /** * Read a key * * TODO: U-Boot wants 0 for no key, but Ctrl-@ is a valid key... * * @return ASCII key code, or 0 if no key, or -1 if error */ static int kbd_getc(void) { /* Just get input to do this for us */ return input_getc(&config.input); } /* configures keyboard GPIO registers to use the rows and columns */ static void config_kbc_gpio(struct kbc_tegra *kbc) { int i; for (i = 0; i < KBC_MAX_GPIO; i++) { u32 row_cfg, col_cfg; u32 r_shift = 5 * (i % 6); u32 c_shift = 4 * (i % 8); u32 r_mask = 0x1f << r_shift; u32 c_mask = 0xf << c_shift; u32 r_offs = i / 6; u32 c_offs = i / 8; row_cfg = readl(&kbc->row_cfg[r_offs]); col_cfg = readl(&kbc->col_cfg[c_offs]); row_cfg &= ~r_mask; col_cfg &= ~c_mask; if (i < config.matrix.num_rows) { row_cfg |= ((i << 1) | 1) << r_shift; } else { col_cfg |= (((i - config.matrix.num_rows) << 1) | 1) << c_shift; } writel(row_cfg, &kbc->row_cfg[r_offs]); writel(col_cfg, &kbc->col_cfg[c_offs]); } } /** * Start up the keyboard device */ static void tegra_kbc_open(void) { struct kbc_tegra *kbc = config.kbc; unsigned int scan_period; u32 val; /* * We will scan at twice the keyboard repeat rate, so that there is * always a scan ready when we check it in check_for_keys(). */ scan_period = KBC_REPEAT_RATE_MS / 2; writel(scan_period * KBC_CLOCK_KHZ, &kbc->rpt_dly); writel(scan_period * KBC_CLOCK_KHZ, &kbc->init_dly); /* * Before reading from the keyboard we must wait for the init_dly * plus the rpt_delay, plus 2ms for the row scan time. */ config.init_dly_ms = scan_period * 2 + 2; val = KBC_DEBOUNCE_COUNT << KBC_DEBOUNCE_CNT_SHIFT; val |= 1 << KBC_FIFO_TH_CNT_SHIFT; /* fifo interrupt threshold */ val |= KBC_CONTROL_KBC_EN; /* enable */ writel(val, &kbc->control); config.start_time_ms = get_timer(0); config.last_poll_ms = config.next_repeat_ms = get_timer(0); config.first_scan = 1; } /** * Set up the tegra keyboard. This is called by the stdio device handler * * We want to do this init when the keyboard is actually used rather than * at start-up, since keyboard input may not currently be selected. * * Once the keyboard starts there will be a period during which we must * wait for the keyboard to init. We do this only when a key is first * read - see kbd_wait_for_fifo_init(). * * @return 0 if ok, -ve on error */ static int init_tegra_keyboard(void) { |
1ed0b51b7 tegra: add CONSOL... |
295 296 297 |
/* check if already created */ if (config.created) return 0; |
6642a681e tegra: Add tegra ... |
298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 |
#ifdef CONFIG_OF_CONTROL int node; node = fdtdec_next_compatible(gd->fdt_blob, 0, COMPAT_NVIDIA_TEGRA20_KBC); if (node < 0) { debug("%s: cannot locate keyboard node ", __func__); return node; } config.kbc = (struct kbc_tegra *)fdtdec_get_addr(gd->fdt_blob, node, "reg"); if ((fdt_addr_t)config.kbc == FDT_ADDR_T_NONE) { debug("%s: No keyboard register found ", __func__); return -1; } |
1b1d3e646 input: Separate o... |
315 316 |
input_set_delays(&config.input, KBC_REPEAT_DELAY_MS, KBC_REPEAT_RATE_MS); |
6642a681e tegra: Add tegra ... |
317 318 |
/* Decode the keyboard matrix information (16 rows, 8 columns) */ |
71dc6bca4 input: Allow key ... |
319 |
if (key_matrix_init(&config.matrix, 16, 8, 1)) { |
6642a681e tegra: Add tegra ... |
320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 |
debug("%s: Could not init key matrix ", __func__); return -1; } if (key_matrix_decode_fdt(&config.matrix, gd->fdt_blob, node)) { debug("%s: Could not decode key matrix from fdt ", __func__); return -1; } if (config.matrix.fn_keycode) { if (input_add_table(&config.input, KEY_FN, -1, config.matrix.fn_keycode, config.matrix.key_count)) return -1; } #else #error "Tegra keyboard driver requires FDT definitions" #endif /* Set up pin mux and enable the clock */ funcmux_select(PERIPH_ID_KBC, FUNCMUX_DEFAULT); clock_enable(PERIPH_ID_KBC); config_kbc_gpio(config.kbc); tegra_kbc_open(); |
1ed0b51b7 tegra: add CONSOL... |
345 |
config.created = 1; |
6642a681e tegra: Add tegra ... |
346 347 348 349 350 351 352 353 354 |
debug("%s: Tegra keyboard ready ", __func__); return 0; } int drv_keyboard_init(void) { struct stdio_dev dev; |
1ed0b51b7 tegra: add CONSOL... |
355 356 |
char *stdinname = getenv("stdin"); int error; |
6642a681e tegra: Add tegra ... |
357 |
|
1b1d3e646 input: Separate o... |
358 |
if (input_init(&config.input, 0)) { |
6642a681e tegra: Add tegra ... |
359 360 361 362 363 364 365 366 367 368 369 370 371 372 |
debug("%s: Cannot set up input ", __func__); return -1; } config.input.read_keys = tegra_kbc_check; memset(&dev, '\0', sizeof(dev)); strcpy(dev.name, "tegra-kbc"); dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM; dev.getc = kbd_getc; dev.tstc = kbd_tstc; dev.start = init_tegra_keyboard; /* Register the device. init_tegra_keyboard() will be called soon */ |
1ed0b51b7 tegra: add CONSOL... |
373 374 375 376 377 378 379 380 381 |
error = input_stdio_register(&dev); if (error) return error; #ifdef CONFIG_CONSOLE_MUX error = iomux_doenv(stdin, stdinname); if (error) return error; #endif return 0; |
6642a681e tegra: Add tegra ... |
382 |
} |