Blame view
drivers/input/tegra-kbc.c
9.43 KB
83d290c56 SPDX: Convert all... |
1 |
// SPDX-License-Identifier: GPL-2.0+ |
6642a681e tegra: Add tegra ... |
2 3 4 |
/* * (C) Copyright 2011 * NVIDIA Corporation <www.nvidia.com> |
6642a681e tegra: Add tegra ... |
5 6 7 |
*/ #include <common.h> |
f77f5e9be dm: tegra: Conver... |
8 |
#include <dm.h> |
6642a681e tegra: Add tegra ... |
9 10 |
#include <fdtdec.h> #include <input.h> |
f77f5e9be dm: tegra: Conver... |
11 |
#include <keyboard.h> |
6642a681e tegra: Add tegra ... |
12 |
#include <key_matrix.h> |
f7ae49fc4 common: Drop log.... |
13 |
#include <log.h> |
6642a681e tegra: Add tegra ... |
14 15 16 17 18 |
#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... |
19 |
#include <asm/arch-tegra/timer.h> |
c05ed00af common: Drop linu... |
20 |
#include <linux/delay.h> |
6642a681e tegra: Add tegra ... |
21 |
#include <linux/input.h> |
6642a681e tegra: Add tegra ... |
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 |
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 */ |
f77f5e9be dm: tegra: Conver... |
43 44 |
struct tegra_kbd_priv { struct input_config *input; /* The input layer */ |
6642a681e tegra: Add tegra ... |
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 |
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 */ /* * 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 */ |
f77f5e9be dm: tegra: Conver... |
60 |
}; |
6642a681e tegra: Add tegra ... |
61 62 63 64 |
/** * reads the keyboard fifo for current keypresses * |
f77f5e9be dm: tegra: Conver... |
65 |
* @param priv Keyboard private data |
6642a681e tegra: Add tegra ... |
66 67 |
* @param fifo Place to put fifo results * @param max_keycodes Maximum number of key codes to put in the fifo |
185f812c4 doc: replace @ret... |
68 |
* Return: number of items put into fifo |
6642a681e tegra: Add tegra ... |
69 |
*/ |
f77f5e9be dm: tegra: Conver... |
70 |
static int tegra_kbc_find_keys(struct tegra_kbd_priv *priv, int *fifo, |
6642a681e tegra: Add tegra ... |
71 72 73 74 75 76 77 78 79 |
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)) |
f77f5e9be dm: tegra: Conver... |
80 |
kp_ent = readl(&priv->kbc->kp_ent[i / 4]); |
6642a681e tegra: Add tegra ... |
81 82 83 84 85 86 87 88 |
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; } |
f77f5e9be dm: tegra: Conver... |
89 |
return key_matrix_decode(&priv->matrix, keys, KBC_MAX_KPENT, fifo, |
6642a681e tegra: Add tegra ... |
90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 |
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. * |
f77f5e9be dm: tegra: Conver... |
108 |
* @param priv Keyboard private data |
6642a681e tegra: Add tegra ... |
109 110 |
* @param fifo_cnt Number of entries in the keyboard fifo */ |
f77f5e9be dm: tegra: Conver... |
111 |
static void process_fifo(struct tegra_kbd_priv *priv, int fifo_cnt) |
6642a681e tegra: Add tegra ... |
112 113 114 115 116 117 118 |
{ int fifo[KBC_MAX_KPENT]; int cnt = 0; /* Always call input_send_keycodes() at least once */ do { if (fifo_cnt) |
f77f5e9be dm: tegra: Conver... |
119 |
cnt = tegra_kbc_find_keys(priv, fifo, KBC_MAX_KPENT); |
6642a681e tegra: Add tegra ... |
120 |
|
f77f5e9be dm: tegra: Conver... |
121 |
input_send_keycodes(priv->input, fifo, cnt); |
6642a681e tegra: Add tegra ... |
122 123 124 125 126 127 128 |
} while (--fifo_cnt > 0); } /** * Check the keyboard controller and emit ASCII characters for any keys that * are pressed. * |
f77f5e9be dm: tegra: Conver... |
129 |
* @param priv Keyboard private data |
6642a681e tegra: Add tegra ... |
130 |
*/ |
f77f5e9be dm: tegra: Conver... |
131 |
static void check_for_keys(struct tegra_kbd_priv *priv) |
6642a681e tegra: Add tegra ... |
132 133 |
{ int fifo_cnt; |
f77f5e9be dm: tegra: Conver... |
134 135 |
if (!priv->first_scan && get_timer(priv->last_poll_ms) < KBC_REPEAT_RATE_MS) |
6642a681e tegra: Add tegra ... |
136 |
return; |
f77f5e9be dm: tegra: Conver... |
137 138 |
priv->last_poll_ms = get_timer(0); priv->first_scan = 0; |
6642a681e tegra: Add tegra ... |
139 140 141 142 143 |
/* * 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. */ |
f77f5e9be dm: tegra: Conver... |
144 145 |
fifo_cnt = (readl(&priv->kbc->interrupt) >> 4) & 0xf; process_fifo(priv, fifo_cnt); |
6642a681e tegra: Add tegra ... |
146 147 148 149 150 151 152 153 |
} /** * 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. * |
f77f5e9be dm: tegra: Conver... |
154 |
* @param priv Keyboard private data |
6642a681e tegra: Add tegra ... |
155 |
*/ |
f77f5e9be dm: tegra: Conver... |
156 |
static void kbd_wait_for_fifo_init(struct tegra_kbd_priv *priv) |
6642a681e tegra: Add tegra ... |
157 |
{ |
f77f5e9be dm: tegra: Conver... |
158 |
if (!priv->inited) { |
6642a681e tegra: Add tegra ... |
159 160 |
unsigned long elapsed_time; long delay_ms; |
f77f5e9be dm: tegra: Conver... |
161 162 |
elapsed_time = get_timer(priv->start_time_ms); delay_ms = priv->init_dly_ms - elapsed_time; |
6642a681e tegra: Add tegra ... |
163 164 165 166 167 |
if (delay_ms > 0) { udelay(delay_ms * 1000); debug("%s: delay %ldms ", __func__, delay_ms); } |
f77f5e9be dm: tegra: Conver... |
168 |
priv->inited = 1; |
6642a681e tegra: Add tegra ... |
169 170 171 172 173 174 175 176 177 178 |
} } /** * 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 |
185f812c4 doc: replace @ret... |
179 |
* Return: 1, to indicate that we have something to look at |
6642a681e tegra: Add tegra ... |
180 |
*/ |
19d7bf3d8 tegra: make local... |
181 |
static int tegra_kbc_check(struct input_config *input) |
6642a681e tegra: Add tegra ... |
182 |
{ |
f77f5e9be dm: tegra: Conver... |
183 |
struct tegra_kbd_priv *priv = dev_get_priv(input->dev); |
6642a681e tegra: Add tegra ... |
184 |
|
f77f5e9be dm: tegra: Conver... |
185 186 |
kbd_wait_for_fifo_init(priv); check_for_keys(priv); |
6642a681e tegra: Add tegra ... |
187 |
|
f77f5e9be dm: tegra: Conver... |
188 |
return 1; |
6642a681e tegra: Add tegra ... |
189 190 191 |
} /* configures keyboard GPIO registers to use the rows and columns */ |
f77f5e9be dm: tegra: Conver... |
192 |
static void config_kbc_gpio(struct tegra_kbd_priv *priv, struct kbc_tegra *kbc) |
6642a681e tegra: Add tegra ... |
193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 |
{ 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; |
f77f5e9be dm: tegra: Conver... |
210 |
if (i < priv->matrix.num_rows) { |
6642a681e tegra: Add tegra ... |
211 212 |
row_cfg |= ((i << 1) | 1) << r_shift; } else { |
f77f5e9be dm: tegra: Conver... |
213 |
col_cfg |= (((i - priv->matrix.num_rows) << 1) | 1) |
6642a681e tegra: Add tegra ... |
214 215 216 217 218 219 220 221 222 223 224 |
<< c_shift; } writel(row_cfg, &kbc->row_cfg[r_offs]); writel(col_cfg, &kbc->col_cfg[c_offs]); } } /** * Start up the keyboard device */ |
f77f5e9be dm: tegra: Conver... |
225 |
static void tegra_kbc_open(struct tegra_kbd_priv *priv) |
6642a681e tegra: Add tegra ... |
226 |
{ |
f77f5e9be dm: tegra: Conver... |
227 |
struct kbc_tegra *kbc = priv->kbc; |
6642a681e tegra: Add tegra ... |
228 229 230 231 232 233 234 235 236 237 238 239 240 241 |
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. */ |
f77f5e9be dm: tegra: Conver... |
242 |
priv->init_dly_ms = scan_period * 2 + 2; |
6642a681e tegra: Add tegra ... |
243 244 245 246 247 |
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); |
f77f5e9be dm: tegra: Conver... |
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 |
priv->start_time_ms = get_timer(0); priv->last_poll_ms = get_timer(0); priv->next_repeat_ms = priv->last_poll_ms; priv->first_scan = 1; } static int tegra_kbd_start(struct udevice *dev) { struct tegra_kbd_priv *priv = dev_get_priv(dev); /* Set up pin mux and enable the clock */ funcmux_select(PERIPH_ID_KBC, FUNCMUX_DEFAULT); clock_enable(PERIPH_ID_KBC); config_kbc_gpio(priv, priv->kbc); tegra_kbc_open(priv); debug("%s: Tegra keyboard ready ", __func__); return 0; |
6642a681e tegra: Add tegra ... |
268 269 270 271 272 273 274 275 276 277 278 279 |
} /** * 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(). * |
185f812c4 doc: replace @ret... |
280 |
* Return: 0 if ok, -ve on error |
6642a681e tegra: Add tegra ... |
281 |
*/ |
f77f5e9be dm: tegra: Conver... |
282 |
static int tegra_kbd_probe(struct udevice *dev) |
6642a681e tegra: Add tegra ... |
283 |
{ |
f77f5e9be dm: tegra: Conver... |
284 285 286 287 |
struct tegra_kbd_priv *priv = dev_get_priv(dev); struct keyboard_priv *uc_priv = dev_get_uclass_priv(dev); struct stdio_dev *sdev = &uc_priv->sdev; struct input_config *input = &uc_priv->input; |
f77f5e9be dm: tegra: Conver... |
288 |
int ret; |
8613c8d89 treewide: convert... |
289 |
priv->kbc = dev_read_addr_ptr(dev); |
f77f5e9be dm: tegra: Conver... |
290 |
if ((fdt_addr_t)priv->kbc == FDT_ADDR_T_NONE) { |
6642a681e tegra: Add tegra ... |
291 292 |
debug("%s: No keyboard register found ", __func__); |
f77f5e9be dm: tegra: Conver... |
293 |
return -EINVAL; |
6642a681e tegra: Add tegra ... |
294 |
} |
f77f5e9be dm: tegra: Conver... |
295 |
input_set_delays(input, KBC_REPEAT_DELAY_MS, KBC_REPEAT_RATE_MS); |
6642a681e tegra: Add tegra ... |
296 297 |
/* Decode the keyboard matrix information (16 rows, 8 columns) */ |
f77f5e9be dm: tegra: Conver... |
298 299 300 301 302 |
ret = key_matrix_init(&priv->matrix, 16, 8, 1); if (ret) { debug("%s: Could not init key matrix: %d ", __func__, ret); return ret; |
6642a681e tegra: Add tegra ... |
303 |
} |
8327d41b1 cros_ec: Update t... |
304 |
ret = key_matrix_decode_fdt(dev, &priv->matrix); |
f77f5e9be dm: tegra: Conver... |
305 306 307 308 309 |
if (ret) { debug("%s: Could not decode key matrix from fdt: %d ", __func__, ret); return ret; |
6642a681e tegra: Add tegra ... |
310 |
} |
732484799 tegra: keyboard: ... |
311 |
input_add_tables(input, false); |
f77f5e9be dm: tegra: Conver... |
312 313 314 315 316 317 318 319 320 |
if (priv->matrix.fn_keycode) { ret = input_add_table(input, KEY_FN, -1, priv->matrix.fn_keycode, priv->matrix.key_count); if (ret) { debug("%s: input_add_table() failed ", __func__); return ret; } |
6642a681e tegra: Add tegra ... |
321 |
} |
6642a681e tegra: Add tegra ... |
322 |
|
f77f5e9be dm: tegra: Conver... |
323 324 325 326 |
/* Register the device. init_tegra_keyboard() will be called soon */ priv->input = input; input->dev = dev; input->read_keys = tegra_kbc_check; |
f77f5e9be dm: tegra: Conver... |
327 328 329 330 331 332 333 |
strcpy(sdev->name, "tegra-kbc"); ret = input_stdio_register(sdev); if (ret) { debug("%s: input_stdio_register() failed ", __func__); return ret; } |
6642a681e tegra: Add tegra ... |
334 335 336 |
return 0; } |
f77f5e9be dm: tegra: Conver... |
337 338 339 |
static const struct keyboard_ops tegra_kbd_ops = { .start = tegra_kbd_start, }; |
6642a681e tegra: Add tegra ... |
340 |
|
f77f5e9be dm: tegra: Conver... |
341 342 343 344 |
static const struct udevice_id tegra_kbd_ids[] = { { .compatible = "nvidia,tegra20-kbc" }, { } }; |
6642a681e tegra: Add tegra ... |
345 |
|
f77f5e9be dm: tegra: Conver... |
346 347 348 349 350 351 |
U_BOOT_DRIVER(tegra_kbd) = { .name = "tegra_kbd", .id = UCLASS_KEYBOARD, .of_match = tegra_kbd_ids, .probe = tegra_kbd_probe, .ops = &tegra_kbd_ops, |
41575d8e4 dm: treewide: Ren... |
352 |
.priv_auto = sizeof(struct tegra_kbd_priv), |
f77f5e9be dm: tegra: Conver... |
353 |
}; |