[u-boot.git] / drivers / input / tegra-kbc.c

// SPDX-License-Identifier: GPL-2.0+
/*
 *  (C) Copyright 2011
 *  NVIDIA Corporation <www.nvidia.com>
 */

#include <common.h>
#include <dm.h>
#include <fdtdec.h>
#include <input.h>
#include <keyboard.h>
#include <key_matrix.h>
#include <log.h>
#include <stdio_dev.h>
#include <tegra-kbc.h>
#include <asm/io.h>
#include <asm/arch/clock.h>
#include <asm/arch/funcmux.h>
#include <asm/arch-tegra/timer.h>
#include <linux/delay.h>
#include <linux/input.h>

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 */
struct tegra_kbd_priv {
	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 */

	/*
	 * 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 */
};

/**
 * reads the keyboard fifo for current keypresses
 *
 * @param priv		Keyboard private data
 * @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 tegra_kbd_priv *priv, 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(&priv->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(&priv->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 priv		Keyboard private data
 * @param fifo_cnt	Number of entries in the keyboard fifo
 */
static void process_fifo(struct tegra_kbd_priv *priv, 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(priv, fifo, KBC_MAX_KPENT);

		input_send_keycodes(priv->input, fifo, cnt);
	} while (--fifo_cnt > 0);
}

/**
 * Check the keyboard controller and emit ASCII characters for any keys that
 * are pressed.
 *
 * @param priv		Keyboard private data
 */
static void check_for_keys(struct tegra_kbd_priv *priv)
{
	int fifo_cnt;

	if (!priv->first_scan &&
	    get_timer(priv->last_poll_ms) < KBC_REPEAT_RATE_MS)
		return;
	priv->last_poll_ms = get_timer(0);
	priv->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(&priv->kbc->interrupt) >> 4) & 0xf;
	process_fifo(priv, 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 priv		Keyboard private data
 */
static void kbd_wait_for_fifo_init(struct tegra_kbd_priv *priv)
{
	if (!priv->inited) {
		unsigned long elapsed_time;
		long delay_ms;

		elapsed_time = get_timer(priv->start_time_ms);
		delay_ms = priv->init_dly_ms - elapsed_time;
		if (delay_ms > 0) {
			udelay(delay_ms * 1000);
			debug("%s: delay %ldms\n", __func__, delay_ms);
		}

		priv->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
 */
static int tegra_kbc_check(struct input_config *input)
{
	struct tegra_kbd_priv *priv = dev_get_priv(input->dev);

	kbd_wait_for_fifo_init(priv);
	check_for_keys(priv);

	return 1;
}

/* configures keyboard GPIO registers to use the rows and columns */
static void config_kbc_gpio(struct tegra_kbd_priv *priv, 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 < priv->matrix.num_rows) {
			row_cfg |= ((i << 1) | 1) << r_shift;
		} else {
			col_cfg |= (((i - priv->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(struct tegra_kbd_priv *priv)
{
	struct kbc_tegra *kbc = priv->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.
	 */
	priv->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);

	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\n", __func__);

	return 0;
}

/**
 * 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 tegra_kbd_probe(struct udevice *dev)
{
	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;
	int ret;

	priv->kbc = (struct kbc_tegra *)devfdt_get_addr(dev);
	if ((fdt_addr_t)priv->kbc == FDT_ADDR_T_NONE) {
		debug("%s: No keyboard register found\n", __func__);
		return -EINVAL;
	}
	input_set_delays(input, KBC_REPEAT_DELAY_MS, KBC_REPEAT_RATE_MS);

	/* Decode the keyboard matrix information (16 rows, 8 columns) */
	ret = key_matrix_init(&priv->matrix, 16, 8, 1);
	if (ret) {
		debug("%s: Could not init key matrix: %d\n", __func__, ret);
		return ret;
	}
	ret = key_matrix_decode_fdt(dev, &priv->matrix);
	if (ret) {
		debug("%s: Could not decode key matrix from fdt: %d\n",
		      __func__, ret);
		return ret;
	}
	input_add_tables(input, false);
	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\n", __func__);
			return ret;
		}
	}

	/* Register the device. init_tegra_keyboard() will be called soon */
	priv->input = input;
	input->dev = dev;
	input->read_keys = tegra_kbc_check;
	strcpy(sdev->name, "tegra-kbc");
	ret = input_stdio_register(sdev);
	if (ret) {
		debug("%s: input_stdio_register() failed\n", __func__);
		return ret;
	}

	return 0;
}

static const struct keyboard_ops tegra_kbd_ops = {
	.start	= tegra_kbd_start,
};

static const struct udevice_id tegra_kbd_ids[] = {
	{ .compatible = "nvidia,tegra20-kbc" },
	{ }
};

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