Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Copyright (C) 2015-2016 Red Hat
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * Copyright (C) 2015 Lyude Paul <thatslyude@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/serio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/notifier.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include "rmi_driver.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #define RMI_F03_RX_DATA_OFB		0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #define RMI_F03_OB_SIZE			2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #define RMI_F03_OB_OFFSET		2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #define RMI_F03_OB_DATA_OFFSET		1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #define RMI_F03_OB_FLAG_TIMEOUT		BIT(6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define RMI_F03_OB_FLAG_PARITY		BIT(7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #define RMI_F03_DEVICE_COUNT		0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define RMI_F03_BYTES_PER_DEVICE	0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define RMI_F03_BYTES_PER_DEVICE_SHIFT	4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #define RMI_F03_QUEUE_LENGTH		0x0F
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #define PSMOUSE_OOB_EXTRA_BTNS		0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) struct f03_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	struct rmi_function *fn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	struct serio *serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	bool serio_registered;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	unsigned int overwrite_buttons;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	u8 device_count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	u8 rx_queue_length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) int rmi_f03_overwrite_button(struct rmi_function *fn, unsigned int button,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 			     int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 	struct f03_data *f03 = dev_get_drvdata(&fn->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 	unsigned int bit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	if (button < BTN_LEFT || button > BTN_MIDDLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	bit = BIT(button - BTN_LEFT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 		f03->overwrite_buttons |= bit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 		f03->overwrite_buttons &= ~bit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) void rmi_f03_commit_buttons(struct rmi_function *fn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	struct f03_data *f03 = dev_get_drvdata(&fn->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	struct serio *serio = f03->serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	serio_pause_rx(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	if (serio->drv) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 		serio->drv->interrupt(serio, PSMOUSE_OOB_EXTRA_BTNS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 				      SERIO_OOB_DATA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 		serio->drv->interrupt(serio, f03->overwrite_buttons,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 				      SERIO_OOB_DATA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	serio_continue_rx(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) static int rmi_f03_pt_write(struct serio *id, unsigned char val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	struct f03_data *f03 = id->port_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	rmi_dbg(RMI_DEBUG_FN, &f03->fn->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		"%s: Wrote %.2hhx to PS/2 passthrough address",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		__func__, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	error = rmi_write(f03->fn->rmi_dev, f03->fn->fd.data_base_addr, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		dev_err(&f03->fn->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 			"%s: Failed to write to F03 TX register (%d).\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 			__func__, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) static int rmi_f03_initialize(struct f03_data *f03)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	struct rmi_function *fn = f03->fn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	struct device *dev = &fn->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	u8 bytes_per_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	u8 query1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	u8 query2[RMI_F03_DEVICE_COUNT * RMI_F03_BYTES_PER_DEVICE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	size_t query2_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	error = rmi_read(fn->rmi_dev, fn->fd.query_base_addr, &query1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		dev_err(dev, "Failed to read query register (%d).\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	f03->device_count = query1 & RMI_F03_DEVICE_COUNT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 	bytes_per_device = (query1 >> RMI_F03_BYTES_PER_DEVICE_SHIFT) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 				RMI_F03_BYTES_PER_DEVICE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	query2_len = f03->device_count * bytes_per_device;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	 * The first generation of image sensors don't have a second part to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	 * their f03 query, as such we have to set some of these values manually
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	if (query2_len < 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		f03->device_count = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		f03->rx_queue_length = 7;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		error = rmi_read_block(fn->rmi_dev, fn->fd.query_base_addr + 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 				       query2, query2_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 		if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 			dev_err(dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 				"Failed to read second set of query registers (%d).\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 				error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 			return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 		f03->rx_queue_length = query2[0] & RMI_F03_QUEUE_LENGTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) static int rmi_f03_pt_open(struct serio *serio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	struct f03_data *f03 = serio->port_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	struct rmi_function *fn = f03->fn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	const u8 ob_len = f03->rx_queue_length * RMI_F03_OB_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	const u16 data_addr = fn->fd.data_base_addr + RMI_F03_OB_OFFSET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	u8 obs[RMI_F03_QUEUE_LENGTH * RMI_F03_OB_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	 * Consume any pending data. Some devices like to spam with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	 * 0xaa 0x00 announcements which may confuse us as we try to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	 * probe the device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	error = rmi_read_block(fn->rmi_dev, data_addr, &obs, ob_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 		rmi_dbg(RMI_DEBUG_FN, &fn->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 			"%s: Consumed %*ph (%d) from PS2 guest\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 			__func__, ob_len, obs, ob_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	return fn->rmi_dev->driver->set_irq_bits(fn->rmi_dev, fn->irq_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) static void rmi_f03_pt_close(struct serio *serio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	struct f03_data *f03 = serio->port_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	struct rmi_function *fn = f03->fn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	fn->rmi_dev->driver->clear_irq_bits(fn->rmi_dev, fn->irq_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) static int rmi_f03_register_pt(struct f03_data *f03)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	struct serio *serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	serio = kzalloc(sizeof(struct serio), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	if (!serio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	serio->id.type = SERIO_PS_PSTHRU;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	serio->write = rmi_f03_pt_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	serio->open = rmi_f03_pt_open;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	serio->close = rmi_f03_pt_close;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	serio->port_data = f03;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	strlcpy(serio->name, "RMI4 PS/2 pass-through", sizeof(serio->name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	snprintf(serio->phys, sizeof(serio->phys), "%s/serio0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 		 dev_name(&f03->fn->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	serio->dev.parent = &f03->fn->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	f03->serio = serio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	printk(KERN_INFO "serio: %s port at %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		serio->name, dev_name(&f03->fn->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	serio_register_port(serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) static int rmi_f03_probe(struct rmi_function *fn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	struct device *dev = &fn->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	struct f03_data *f03;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	f03 = devm_kzalloc(dev, sizeof(struct f03_data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	if (!f03)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	f03->fn = fn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	error = rmi_f03_initialize(f03);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	if (error < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	if (f03->device_count != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 		dev_warn(dev, "found %d devices on PS/2 passthrough",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 			 f03->device_count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	dev_set_drvdata(dev, f03);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) static int rmi_f03_config(struct rmi_function *fn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	struct f03_data *f03 = dev_get_drvdata(&fn->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	if (!f03->serio_registered) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		error = rmi_f03_register_pt(f03);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 		if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 			return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		f03->serio_registered = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		 * We must be re-configuring the sensor, just enable
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 		 * interrupts for this function.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 		fn->rmi_dev->driver->set_irq_bits(fn->rmi_dev, fn->irq_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) static irqreturn_t rmi_f03_attention(int irq, void *ctx)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	struct rmi_function *fn = ctx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	struct rmi_device *rmi_dev = fn->rmi_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	struct rmi_driver_data *drvdata = dev_get_drvdata(&rmi_dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	struct f03_data *f03 = dev_get_drvdata(&fn->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	const u16 data_addr = fn->fd.data_base_addr + RMI_F03_OB_OFFSET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	const u8 ob_len = f03->rx_queue_length * RMI_F03_OB_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	u8 obs[RMI_F03_QUEUE_LENGTH * RMI_F03_OB_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	u8 ob_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	u8 ob_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	unsigned int serio_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	if (drvdata->attn_data.data) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		/* First grab the data passed by the transport device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 		if (drvdata->attn_data.size < ob_len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 			dev_warn(&fn->dev, "F03 interrupted, but data is missing!\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 			return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 		memcpy(obs, drvdata->attn_data.data, ob_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		drvdata->attn_data.data += ob_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		drvdata->attn_data.size -= ob_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		/* Grab all of the data registers, and check them for data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 		error = rmi_read_block(fn->rmi_dev, data_addr, &obs, ob_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 			dev_err(&fn->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 				"%s: Failed to read F03 output buffers: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 				__func__, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 			serio_interrupt(f03->serio, 0, SERIO_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 			return IRQ_RETVAL(error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	for (i = 0; i < ob_len; i += RMI_F03_OB_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		ob_status = obs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 		ob_data = obs[i + RMI_F03_OB_DATA_OFFSET];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 		serio_flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		if (!(ob_status & RMI_F03_RX_DATA_OFB))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		if (ob_status & RMI_F03_OB_FLAG_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 			serio_flags |= SERIO_TIMEOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 		if (ob_status & RMI_F03_OB_FLAG_PARITY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 			serio_flags |= SERIO_PARITY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 		rmi_dbg(RMI_DEBUG_FN, &fn->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 			"%s: Received %.2hhx from PS2 guest T: %c P: %c\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 			__func__, ob_data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 			serio_flags & SERIO_TIMEOUT ?  'Y' : 'N',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 			serio_flags & SERIO_PARITY ? 'Y' : 'N');
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		serio_interrupt(f03->serio, ob_data, serio_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) static void rmi_f03_remove(struct rmi_function *fn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	struct f03_data *f03 = dev_get_drvdata(&fn->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	if (f03->serio_registered)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 		serio_unregister_port(f03->serio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) struct rmi_function_handler rmi_f03_handler = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 		.name = "rmi4_f03",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	.func = 0x03,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	.probe = rmi_f03_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	.config = rmi_f03_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	.attention = rmi_f03_attention,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	.remove = rmi_f03_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) MODULE_AUTHOR("Lyude Paul <thatslyude@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) MODULE_DESCRIPTION("RMI F03 module");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) MODULE_LICENSE("GPL");