diff options
Diffstat (limited to 'drivers/hid/hid-rmi.c')
| -rw-r--r-- | drivers/hid/hid-rmi.c | 973 | 
1 files changed, 141 insertions, 832 deletions
diff --git a/drivers/hid/hid-rmi.c b/drivers/hid/hid-rmi.c index be89bcbf6a71..5b40c2614599 100644 --- a/drivers/hid/hid-rmi.c +++ b/drivers/hid/hid-rmi.c @@ -14,11 +14,14 @@  #include <linux/hid.h>  #include <linux/input.h>  #include <linux/input/mt.h> +#include <linux/irq.h> +#include <linux/irqdomain.h>  #include <linux/module.h>  #include <linux/pm.h>  #include <linux/slab.h>  #include <linux/wait.h>  #include <linux/sched.h> +#include <linux/rmi.h>  #include "hid-ids.h"  #define RMI_MOUSE_REPORT_ID		0x01 /* Mouse emulation Report */ @@ -33,9 +36,6 @@  #define RMI_READ_DATA_PENDING		1  #define RMI_STARTED			2 -#define RMI_SLEEP_NORMAL		0x0 -#define RMI_SLEEP_DEEP_SLEEP		0x1 -  /* device flags */  #define RMI_DEVICE			BIT(0)  #define RMI_DEVICE_HAS_PHYS_BUTTONS	BIT(1) @@ -54,25 +54,12 @@ enum rmi_mode_type {  	RMI_MODE_NO_PACKED_ATTN_REPORTS	= 2,  }; -struct rmi_function { -	unsigned page;			/* page of the function */ -	u16 query_base_addr;		/* base address for queries */ -	u16 command_base_addr;		/* base address for commands */ -	u16 control_base_addr;		/* base address for controls */ -	u16 data_base_addr;		/* base address for datas */ -	unsigned int interrupt_base;	/* cross-function interrupt number -					 * (uniq in the device)*/ -	unsigned int interrupt_count;	/* number of interrupts */ -	unsigned int report_size;	/* size of a report */ -	unsigned long irq_mask;		/* mask of the interrupts -					 * (to be applied against ATTN IRQ) */ -}; -  /**   * struct rmi_data - stores information for hid communication   *   * @page_mutex: Locks current page to avoid changing pages in unexpected ways.   * @page: Keeps track of the current virtual page + * @xport: transport device to be registered with the RMI4 core.   *   * @wait: Used for waiting for read data   * @@ -84,26 +71,18 @@ struct rmi_function {   *   * @flags: flags for the current device (started, reading, etc...)   * - * @f11: placeholder of internal RMI function F11 description - * @f30: placeholder of internal RMI function F30 description - * - * @max_fingers: maximum finger count reported by the device - * @max_x: maximum x value reported by the device - * @max_y: maximum y value reported by the device - * - * @gpio_led_count: count of GPIOs + LEDs reported by F30 - * @button_count: actual physical buttons count - * @button_mask: button mask used to decode GPIO ATTN reports - * @button_state_mask: pull state of the buttons - * - * @input: pointer to the kernel input device - *   * @reset_work: worker which will be called in case of a mouse report   * @hdev: pointer to the struct hid_device + * + * @device_flags: flags which describe the device + * + * @domain: the IRQ domain allocated for this RMI4 device + * @rmi_irq: the irq that will be used to generate events to rmi-core   */  struct rmi_data {  	struct mutex page_mutex;  	int page; +	struct rmi_transport_dev xport;  	wait_queue_head_t wait; @@ -115,34 +94,13 @@ struct rmi_data {  	unsigned long flags; -	struct rmi_function f01; -	struct rmi_function f11; -	struct rmi_function f30; - -	unsigned int max_fingers; -	unsigned int max_x; -	unsigned int max_y; -	unsigned int x_size_mm; -	unsigned int y_size_mm; -	bool read_f11_ctrl_regs; -	u8 f11_ctrl_regs[RMI_F11_CTRL_REG_COUNT]; - -	unsigned int gpio_led_count; -	unsigned int button_count; -	unsigned long button_mask; -	unsigned long button_state_mask; - -	struct input_dev *input; -  	struct work_struct reset_work;  	struct hid_device *hdev;  	unsigned long device_flags; -	unsigned long firmware_id; -	u8 f01_ctrl0; -	u8 interrupt_enable_mask; -	bool restore_interrupt_mask; +	struct irq_domain *domain; +	int rmi_irq;  };  #define RMI_PAGE(addr) (((addr) >> 8) & 0xff) @@ -220,10 +178,11 @@ static int rmi_write_report(struct hid_device *hdev, u8 *report, int len)  	return ret;  } -static int rmi_read_block(struct hid_device *hdev, u16 addr, void *buf, -		const int len) +static int rmi_hid_read_block(struct rmi_transport_dev *xport, u16 addr, +		void *buf, size_t len)  { -	struct rmi_data *data = hid_get_drvdata(hdev); +	struct rmi_data *data = container_of(xport, struct rmi_data, xport); +	struct hid_device *hdev = data->hdev;  	int ret;  	int bytes_read;  	int bytes_needed; @@ -292,15 +251,11 @@ exit:  	return ret;  } -static inline int rmi_read(struct hid_device *hdev, u16 addr, void *buf) -{ -	return rmi_read_block(hdev, addr, buf, 1); -} - -static int rmi_write_block(struct hid_device *hdev, u16 addr, void *buf, -		const int len) +static int rmi_hid_write_block(struct rmi_transport_dev *xport, u16 addr, +		const void *buf, size_t len)  { -	struct rmi_data *data = hid_get_drvdata(hdev); +	struct rmi_data *data = container_of(xport, struct rmi_data, xport); +	struct hid_device *hdev = data->hdev;  	int ret;  	mutex_lock(&data->page_mutex); @@ -332,62 +287,20 @@ exit:  	return ret;  } -static inline int rmi_write(struct hid_device *hdev, u16 addr, void *buf) -{ -	return rmi_write_block(hdev, addr, buf, 1); -} - -static void rmi_f11_process_touch(struct rmi_data *hdata, int slot, -		u8 finger_state, u8 *touch_data) -{ -	int x, y, wx, wy; -	int wide, major, minor; -	int z; - -	input_mt_slot(hdata->input, slot); -	input_mt_report_slot_state(hdata->input, MT_TOOL_FINGER, -			finger_state == 0x01); -	if (finger_state == 0x01) { -		x = (touch_data[0] << 4) | (touch_data[2] & 0x0F); -		y = (touch_data[1] << 4) | (touch_data[2] >> 4); -		wx = touch_data[3] & 0x0F; -		wy = touch_data[3] >> 4; -		wide = (wx > wy); -		major = max(wx, wy); -		minor = min(wx, wy); -		z = touch_data[4]; - -		/* y is inverted */ -		y = hdata->max_y - y; - -		input_event(hdata->input, EV_ABS, ABS_MT_POSITION_X, x); -		input_event(hdata->input, EV_ABS, ABS_MT_POSITION_Y, y); -		input_event(hdata->input, EV_ABS, ABS_MT_ORIENTATION, wide); -		input_event(hdata->input, EV_ABS, ABS_MT_PRESSURE, z); -		input_event(hdata->input, EV_ABS, ABS_MT_TOUCH_MAJOR, major); -		input_event(hdata->input, EV_ABS, ABS_MT_TOUCH_MINOR, minor); -	} -} -  static int rmi_reset_attn_mode(struct hid_device *hdev)  {  	struct rmi_data *data = hid_get_drvdata(hdev); +	struct rmi_device *rmi_dev = data->xport.rmi_dev;  	int ret;  	ret = rmi_set_mode(hdev, RMI_MODE_ATTN_REPORTS);  	if (ret)  		return ret; -	if (data->restore_interrupt_mask) { -		ret = rmi_write(hdev, data->f01.control_base_addr + 1, -				&data->interrupt_enable_mask); -		if (ret) { -			hid_err(hdev, "can not write F01 control register\n"); -			return ret; -		} -	} +	if (test_bit(RMI_STARTED, &data->flags)) +		ret = rmi_dev->driver->reset_handler(rmi_dev); -	return 0; +	return ret;  }  static void rmi_reset_work(struct work_struct *work) @@ -399,102 +312,22 @@ static void rmi_reset_work(struct work_struct *work)  	rmi_reset_attn_mode(hdata->hdev);  } -static inline int rmi_schedule_reset(struct hid_device *hdev) -{ -	struct rmi_data *hdata = hid_get_drvdata(hdev); -	return schedule_work(&hdata->reset_work); -} - -static int rmi_f11_input_event(struct hid_device *hdev, u8 irq, u8 *data, -		int size) -{ -	struct rmi_data *hdata = hid_get_drvdata(hdev); -	int offset; -	int i; - -	if (!(irq & hdata->f11.irq_mask) || size <= 0) -		return 0; - -	offset = (hdata->max_fingers >> 2) + 1; -	for (i = 0; i < hdata->max_fingers; i++) { -		int fs_byte_position = i >> 2; -		int fs_bit_position = (i & 0x3) << 1; -		int finger_state = (data[fs_byte_position] >> fs_bit_position) & -					0x03; -		int position = offset + 5 * i; - -		if (position + 5 > size) { -			/* partial report, go on with what we received */ -			printk_once(KERN_WARNING -				"%s %s: Detected incomplete finger report. Finger reports may occasionally get dropped on this platform.\n", -				 dev_driver_string(&hdev->dev), -				 dev_name(&hdev->dev)); -			hid_dbg(hdev, "Incomplete finger report\n"); -			break; -		} - -		rmi_f11_process_touch(hdata, i, finger_state, &data[position]); -	} -	input_mt_sync_frame(hdata->input); -	input_sync(hdata->input); -	return hdata->f11.report_size; -} - -static int rmi_f30_input_event(struct hid_device *hdev, u8 irq, u8 *data, -		int size) -{ -	struct rmi_data *hdata = hid_get_drvdata(hdev); -	int i; -	int button = 0; -	bool value; - -	if (!(irq & hdata->f30.irq_mask)) -		return 0; - -	if (size < (int)hdata->f30.report_size) { -		hid_warn(hdev, "Click Button pressed, but the click data is missing\n"); -		return 0; -	} - -	for (i = 0; i < hdata->gpio_led_count; i++) { -		if (test_bit(i, &hdata->button_mask)) { -			value = (data[i / 8] >> (i & 0x07)) & BIT(0); -			if (test_bit(i, &hdata->button_state_mask)) -				value = !value; -			input_event(hdata->input, EV_KEY, BTN_LEFT + button++, -					value); -		} -	} -	return hdata->f30.report_size; -} -  static int rmi_input_event(struct hid_device *hdev, u8 *data, int size)  {  	struct rmi_data *hdata = hid_get_drvdata(hdev); -	unsigned long irq_mask = 0; -	unsigned index = 2; +	struct rmi_device *rmi_dev = hdata->xport.rmi_dev; +	unsigned long flags;  	if (!(test_bit(RMI_STARTED, &hdata->flags)))  		return 0; -	irq_mask |= hdata->f11.irq_mask; -	irq_mask |= hdata->f30.irq_mask; +	local_irq_save(flags); -	if (data[1] & ~irq_mask) -		hid_dbg(hdev, "unknown intr source:%02lx %s:%d\n", -			data[1] & ~irq_mask, __FILE__, __LINE__); +	rmi_set_attn_data(rmi_dev, data[1], &data[2], size - 2); -	if (hdata->f11.interrupt_base < hdata->f30.interrupt_base) { -		index += rmi_f11_input_event(hdev, data[1], &data[index], -				size - index); -		index += rmi_f30_input_event(hdev, data[1], &data[index], -				size - index); -	} else { -		index += rmi_f30_input_event(hdev, data[1], &data[index], -				size - index); -		index += rmi_f11_input_event(hdev, data[1], &data[index], -				size - index); -	} +	generic_handle_irq(hdata->rmi_irq); + +	local_irq_restore(flags);  	return 1;  } @@ -568,7 +401,7 @@ static int rmi_event(struct hid_device *hdev, struct hid_field *field,  				return 1;  		} -		rmi_schedule_reset(hdev); +		schedule_work(&data->reset_work);  		return 1;  	} @@ -576,637 +409,71 @@ static int rmi_event(struct hid_device *hdev, struct hid_field *field,  }  #ifdef CONFIG_PM -static int rmi_set_sleep_mode(struct hid_device *hdev, int sleep_mode) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	int ret; -	u8 f01_ctrl0; - -	f01_ctrl0 = (data->f01_ctrl0 & ~0x3) | sleep_mode; - -	ret = rmi_write(hdev, data->f01.control_base_addr, -			&f01_ctrl0); -	if (ret) { -		hid_err(hdev, "can not write sleep mode\n"); -		return ret; -	} - -	return 0; -} -  static int rmi_suspend(struct hid_device *hdev, pm_message_t message)  {  	struct rmi_data *data = hid_get_drvdata(hdev); +	struct rmi_device *rmi_dev = data->xport.rmi_dev;  	int ret; -	u8 buf[RMI_F11_CTRL_REG_COUNT];  	if (!(data->device_flags & RMI_DEVICE))  		return 0; -	ret = rmi_read_block(hdev, data->f11.control_base_addr, buf, -				RMI_F11_CTRL_REG_COUNT); -	if (ret) -		hid_warn(hdev, "can not read F11 control registers\n"); -	else -		memcpy(data->f11_ctrl_regs, buf, RMI_F11_CTRL_REG_COUNT); - - -	if (!device_may_wakeup(hdev->dev.parent)) -		return rmi_set_sleep_mode(hdev, RMI_SLEEP_DEEP_SLEEP); - -	return 0; -} - -static int rmi_post_reset(struct hid_device *hdev) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	int ret; - -	if (!(data->device_flags & RMI_DEVICE)) -		return 0; - -	ret = rmi_reset_attn_mode(hdev); +	ret = rmi_driver_suspend(rmi_dev, false);  	if (ret) { -		hid_err(hdev, "can not set rmi mode\n"); +		hid_warn(hdev, "Failed to suspend device: %d\n", ret);  		return ret;  	} -	if (data->read_f11_ctrl_regs) { -		ret = rmi_write_block(hdev, data->f11.control_base_addr, -				data->f11_ctrl_regs, RMI_F11_CTRL_REG_COUNT); -		if (ret) -			hid_warn(hdev, -				"can not write F11 control registers after reset\n"); -	} - -	if (!device_may_wakeup(hdev->dev.parent)) { -		ret = rmi_set_sleep_mode(hdev, RMI_SLEEP_NORMAL); -		if (ret) { -			hid_err(hdev, "can not write sleep mode\n"); -			return ret; -		} -	} - -	return ret; +	return 0;  }  static int rmi_post_resume(struct hid_device *hdev)  {  	struct rmi_data *data = hid_get_drvdata(hdev); +	struct rmi_device *rmi_dev = data->xport.rmi_dev; +	int ret;  	if (!(data->device_flags & RMI_DEVICE))  		return 0; -	return rmi_reset_attn_mode(hdev); -} -#endif /* CONFIG_PM */ - -#define RMI4_MAX_PAGE 0xff -#define RMI4_PAGE_SIZE 0x0100 - -#define PDT_START_SCAN_LOCATION 0x00e9 -#define PDT_END_SCAN_LOCATION	0x0005 -#define RMI4_END_OF_PDT(id) ((id) == 0x00 || (id) == 0xff) - -struct pdt_entry { -	u8 query_base_addr:8; -	u8 command_base_addr:8; -	u8 control_base_addr:8; -	u8 data_base_addr:8; -	u8 interrupt_source_count:3; -	u8 bits3and4:2; -	u8 function_version:2; -	u8 bit7:1; -	u8 function_number:8; -} __attribute__((__packed__)); - -static inline unsigned long rmi_gen_mask(unsigned irq_base, unsigned irq_count) -{ -	return GENMASK(irq_count + irq_base - 1, irq_base); -} - -static void rmi_register_function(struct rmi_data *data, -	struct pdt_entry *pdt_entry, int page, unsigned interrupt_count) -{ -	struct rmi_function *f = NULL; -	u16 page_base = page << 8; - -	switch (pdt_entry->function_number) { -	case 0x01: -		f = &data->f01; -		break; -	case 0x11: -		f = &data->f11; -		break; -	case 0x30: -		f = &data->f30; -		break; -	} - -	if (f) { -		f->page = page; -		f->query_base_addr = page_base | pdt_entry->query_base_addr; -		f->command_base_addr = page_base | pdt_entry->command_base_addr; -		f->control_base_addr = page_base | pdt_entry->control_base_addr; -		f->data_base_addr = page_base | pdt_entry->data_base_addr; -		f->interrupt_base = interrupt_count; -		f->interrupt_count = pdt_entry->interrupt_source_count; -		f->irq_mask = rmi_gen_mask(f->interrupt_base, -						f->interrupt_count); -		data->interrupt_enable_mask |= f->irq_mask; -	} -} - -static int rmi_scan_pdt(struct hid_device *hdev) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	struct pdt_entry entry; -	int page; -	bool page_has_function; -	int i; -	int retval; -	int interrupt = 0; -	u16 page_start, pdt_start , pdt_end; - -	hid_info(hdev, "Scanning PDT...\n"); - -	for (page = 0; (page <= RMI4_MAX_PAGE); page++) { -		page_start = RMI4_PAGE_SIZE * page; -		pdt_start = page_start + PDT_START_SCAN_LOCATION; -		pdt_end = page_start + PDT_END_SCAN_LOCATION; - -		page_has_function = false; -		for (i = pdt_start; i >= pdt_end; i -= sizeof(entry)) { -			retval = rmi_read_block(hdev, i, &entry, sizeof(entry)); -			if (retval) { -				hid_err(hdev, -					"Read of PDT entry at %#06x failed.\n", -					i); -				goto error_exit; -			} - -			if (RMI4_END_OF_PDT(entry.function_number)) -				break; - -			page_has_function = true; - -			hid_info(hdev, "Found F%02X on page %#04x\n", -					entry.function_number, page); - -			rmi_register_function(data, &entry, page, interrupt); -			interrupt += entry.interrupt_source_count; -		} - -		if (!page_has_function) -			break; -	} - -	hid_info(hdev, "%s: Done with PDT scan.\n", __func__); -	retval = 0; - -error_exit: -	return retval; -} - -#define RMI_DEVICE_F01_BASIC_QUERY_LEN	11 - -static int rmi_populate_f01(struct hid_device *hdev) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	u8 basic_queries[RMI_DEVICE_F01_BASIC_QUERY_LEN]; -	u8 info[3]; -	int ret; -	bool has_query42; -	bool has_lts; -	bool has_sensor_id; -	bool has_ds4_queries = false; -	bool has_build_id_query = false; -	bool has_package_id_query = false; -	u16 query_offset = data->f01.query_base_addr; -	u16 prod_info_addr; -	u8 ds4_query_len; - -	ret = rmi_read_block(hdev, query_offset, basic_queries, -				RMI_DEVICE_F01_BASIC_QUERY_LEN); -	if (ret) { -		hid_err(hdev, "Can not read basic queries from Function 0x1.\n"); -		return ret; -	} - -	has_lts = !!(basic_queries[0] & BIT(2)); -	has_sensor_id = !!(basic_queries[1] & BIT(3)); -	has_query42 = !!(basic_queries[1] & BIT(7)); - -	query_offset += 11; -	prod_info_addr = query_offset + 6; -	query_offset += 10; - -	if (has_lts) -		query_offset += 20; - -	if (has_sensor_id) -		query_offset++; - -	if (has_query42) { -		ret = rmi_read(hdev, query_offset, info); -		if (ret) { -			hid_err(hdev, "Can not read query42.\n"); -			return ret; -		} -		has_ds4_queries = !!(info[0] & BIT(0)); -		query_offset++; -	} - -	if (has_ds4_queries) { -		ret = rmi_read(hdev, query_offset, &ds4_query_len); -		if (ret) { -			hid_err(hdev, "Can not read DS4 Query length.\n"); -			return ret; -		} -		query_offset++; - -		if (ds4_query_len > 0) { -			ret = rmi_read(hdev, query_offset, info); -			if (ret) { -				hid_err(hdev, "Can not read DS4 query.\n"); -				return ret; -			} - -			has_package_id_query = !!(info[0] & BIT(0)); -			has_build_id_query = !!(info[0] & BIT(1)); -		} -	} - -	if (has_package_id_query) -		prod_info_addr++; - -	if (has_build_id_query) { -		ret = rmi_read_block(hdev, prod_info_addr, info, 3); -		if (ret) { -			hid_err(hdev, "Can not read product info.\n"); -			return ret; -		} - -		data->firmware_id = info[1] << 8 | info[0]; -		data->firmware_id += info[2] * 65536; -	} - -	ret = rmi_read_block(hdev, data->f01.control_base_addr, info, -				2); - -	if (ret) { -		hid_err(hdev, "can not read f01 ctrl registers\n"); -		return ret; -	} - -	data->f01_ctrl0 = info[0]; - -	if (!info[1]) { -		/* -		 * Do to a firmware bug in some touchpads the F01 interrupt -		 * enable control register will be cleared on reset. -		 * This will stop the touchpad from reporting data, so -		 * if F01 CTRL1 is 0 then we need to explicitly enable -		 * interrupts for the functions we want data for. -		 */ -		data->restore_interrupt_mask = true; - -		ret = rmi_write(hdev, data->f01.control_base_addr + 1, -				&data->interrupt_enable_mask); -		if (ret) { -			hid_err(hdev, "can not write to control reg 1: %d.\n", -				ret); -			return ret; -		} -	} - -	return 0; -} - -static int rmi_populate_f11(struct hid_device *hdev) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	u8 buf[20]; -	int ret; -	bool has_query9; -	bool has_query10 = false; -	bool has_query11; -	bool has_query12; -	bool has_query27; -	bool has_query28; -	bool has_query36 = false; -	bool has_physical_props; -	bool has_gestures; -	bool has_rel; -	bool has_data40 = false; -	bool has_dribble = false; -	bool has_palm_detect = false; -	unsigned x_size, y_size; -	u16 query_offset; - -	if (!data->f11.query_base_addr) { -		hid_err(hdev, "No 2D sensor found, giving up.\n"); -		return -ENODEV; -	} - -	/* query 0 contains some useful information */ -	ret = rmi_read(hdev, data->f11.query_base_addr, buf); -	if (ret) { -		hid_err(hdev, "can not get query 0: %d.\n", ret); -		return ret; -	} -	has_query9 = !!(buf[0] & BIT(3)); -	has_query11 = !!(buf[0] & BIT(4)); -	has_query12 = !!(buf[0] & BIT(5)); -	has_query27 = !!(buf[0] & BIT(6)); -	has_query28 = !!(buf[0] & BIT(7)); - -	/* query 1 to get the max number of fingers */ -	ret = rmi_read(hdev, data->f11.query_base_addr + 1, buf); -	if (ret) { -		hid_err(hdev, "can not get NumberOfFingers: %d.\n", ret); -		return ret; -	} -	data->max_fingers = (buf[0] & 0x07) + 1; -	if (data->max_fingers > 5) -		data->max_fingers = 10; - -	data->f11.report_size = data->max_fingers * 5 + -				DIV_ROUND_UP(data->max_fingers, 4); - -	if (!(buf[0] & BIT(4))) { -		hid_err(hdev, "No absolute events, giving up.\n"); -		return -ENODEV; -	} - -	has_rel = !!(buf[0] & BIT(3)); -	has_gestures = !!(buf[0] & BIT(5)); - -	ret = rmi_read(hdev, data->f11.query_base_addr + 5, buf); -	if (ret) { -		hid_err(hdev, "can not get absolute data sources: %d.\n", ret); -		return ret; -	} - -	has_dribble = !!(buf[0] & BIT(4)); - -	/* -	 * At least 4 queries are guaranteed to be present in F11 -	 * +1 for query 5 which is present since absolute events are -	 * reported and +1 for query 12. -	 */ -	query_offset = 6; - -	if (has_rel) -		++query_offset; /* query 6 is present */ - -	if (has_gestures) { -		/* query 8 to find out if query 10 exists */ -		ret = rmi_read(hdev, -			data->f11.query_base_addr + query_offset + 1, buf); -		if (ret) { -			hid_err(hdev, "can not read gesture information: %d.\n", -				ret); -			return ret; -		} -		has_palm_detect = !!(buf[0] & BIT(0)); -		has_query10 = !!(buf[0] & BIT(2)); - -		query_offset += 2; /* query 7 and 8 are present */ -	} - -	if (has_query9) -		++query_offset; - -	if (has_query10) -		++query_offset; - -	if (has_query11) -		++query_offset; - -	/* query 12 to know if the physical properties are reported */ -	if (has_query12) { -		ret = rmi_read(hdev, data->f11.query_base_addr -				+ query_offset, buf); -		if (ret) { -			hid_err(hdev, "can not get query 12: %d.\n", ret); -			return ret; -		} -		has_physical_props = !!(buf[0] & BIT(5)); - -		if (has_physical_props) { -			query_offset += 1; -			ret = rmi_read_block(hdev, -					data->f11.query_base_addr -						+ query_offset, buf, 4); -			if (ret) { -				hid_err(hdev, "can not read query 15-18: %d.\n", -					ret); -				return ret; -			} - -			x_size = buf[0] | (buf[1] << 8); -			y_size = buf[2] | (buf[3] << 8); - -			data->x_size_mm = DIV_ROUND_CLOSEST(x_size, 10); -			data->y_size_mm = DIV_ROUND_CLOSEST(y_size, 10); - -			hid_info(hdev, "%s: size in mm: %d x %d\n", -				 __func__, data->x_size_mm, data->y_size_mm); - -			/* -			 * query 15 - 18 contain the size of the sensor -			 * and query 19 - 26 contain bezel dimensions -			 */ -			query_offset += 12; -		} -	} - -	if (has_query27) -		++query_offset; - -	if (has_query28) { -		ret = rmi_read(hdev, data->f11.query_base_addr -				+ query_offset, buf); -		if (ret) { -			hid_err(hdev, "can not get query 28: %d.\n", ret); -			return ret; -		} - -		has_query36 = !!(buf[0] & BIT(6)); -	} - -	if (has_query36) { -		query_offset += 2; -		ret = rmi_read(hdev, data->f11.query_base_addr -				+ query_offset, buf); -		if (ret) { -			hid_err(hdev, "can not get query 36: %d.\n", ret); -			return ret; -		} - -		has_data40 = !!(buf[0] & BIT(5)); -	} - - -	if (has_data40) -		data->f11.report_size += data->max_fingers * 2; - -	ret = rmi_read_block(hdev, data->f11.control_base_addr, -			data->f11_ctrl_regs, RMI_F11_CTRL_REG_COUNT); -	if (ret) { -		hid_err(hdev, "can not read ctrl block of size 11: %d.\n", ret); -		return ret; -	} - -	/* data->f11_ctrl_regs now contains valid register data */ -	data->read_f11_ctrl_regs = true; - -	data->max_x = data->f11_ctrl_regs[6] | (data->f11_ctrl_regs[7] << 8); -	data->max_y = data->f11_ctrl_regs[8] | (data->f11_ctrl_regs[9] << 8); - -	if (has_dribble) { -		data->f11_ctrl_regs[0] = data->f11_ctrl_regs[0] & ~BIT(6); -		ret = rmi_write(hdev, data->f11.control_base_addr, -				data->f11_ctrl_regs); -		if (ret) { -			hid_err(hdev, "can not write to control reg 0: %d.\n", -				ret); -			return ret; -		} -	} - -	if (has_palm_detect) { -		data->f11_ctrl_regs[11] = data->f11_ctrl_regs[11] & ~BIT(0); -		ret = rmi_write(hdev, data->f11.control_base_addr + 11, -				&data->f11_ctrl_regs[11]); -		if (ret) { -			hid_err(hdev, "can not write to control reg 11: %d.\n", -				ret); -			return ret; -		} -	} - -	return 0; -} - -static int rmi_populate_f30(struct hid_device *hdev) -{ -	struct rmi_data *data = hid_get_drvdata(hdev); -	u8 buf[20]; -	int ret; -	bool has_gpio, has_led; -	unsigned bytes_per_ctrl; -	u8 ctrl2_addr; -	int ctrl2_3_length; -	int i; - -	/* function F30 is for physical buttons */ -	if (!data->f30.query_base_addr) { -		hid_err(hdev, "No GPIO/LEDs found, giving up.\n"); -		return -ENODEV; -	} - -	ret = rmi_read_block(hdev, data->f30.query_base_addr, buf, 2); -	if (ret) { -		hid_err(hdev, "can not get F30 query registers: %d.\n", ret); +	ret = rmi_reset_attn_mode(hdev); +	if (ret)  		return ret; -	} -	has_gpio = !!(buf[0] & BIT(3)); -	has_led = !!(buf[0] & BIT(2)); -	data->gpio_led_count = buf[1] & 0x1f; - -	/* retrieve ctrl 2 & 3 registers */ -	bytes_per_ctrl = (data->gpio_led_count + 7) / 8; -	/* Ctrl0 is present only if both has_gpio and has_led are set*/ -	ctrl2_addr = (has_gpio && has_led) ? bytes_per_ctrl : 0; -	/* Ctrl1 is always be present */ -	ctrl2_addr += bytes_per_ctrl; -	ctrl2_3_length = 2 * bytes_per_ctrl; - -	data->f30.report_size = bytes_per_ctrl; - -	ret = rmi_read_block(hdev, data->f30.control_base_addr + ctrl2_addr, -				buf, ctrl2_3_length); +	ret = rmi_driver_resume(rmi_dev, false);  	if (ret) { -		hid_err(hdev, "can not read ctrl 2&3 block of size %d: %d.\n", -			ctrl2_3_length, ret); +		hid_warn(hdev, "Failed to resume device: %d\n", ret);  		return ret;  	} -	for (i = 0; i < data->gpio_led_count; i++) { -		int byte_position = i >> 3; -		int bit_position = i & 0x07; -		u8 dir_byte = buf[byte_position]; -		u8 data_byte = buf[byte_position + bytes_per_ctrl]; -		bool dir = (dir_byte >> bit_position) & BIT(0); -		bool dat = (data_byte >> bit_position) & BIT(0); - -		if (dir == 0) { -			/* input mode */ -			if (dat) { -				/* actual buttons have pull up resistor */ -				data->button_count++; -				set_bit(i, &data->button_mask); -				set_bit(i, &data->button_state_mask); -			} -		} - -	} -  	return 0;  } +#endif /* CONFIG_PM */ -static int rmi_populate(struct hid_device *hdev) +static int rmi_hid_reset(struct rmi_transport_dev *xport, u16 reset_addr)  { -	struct rmi_data *data = hid_get_drvdata(hdev); -	int ret; - -	ret = rmi_scan_pdt(hdev); -	if (ret) { -		hid_err(hdev, "PDT scan failed with code %d.\n", ret); -		return ret; -	} - -	ret = rmi_populate_f01(hdev); -	if (ret) { -		hid_err(hdev, "Error while initializing F01 (%d).\n", ret); -		return ret; -	} - -	ret = rmi_populate_f11(hdev); -	if (ret) { -		hid_err(hdev, "Error while initializing F11 (%d).\n", ret); -		return ret; -	} - -	if (!(data->device_flags & RMI_DEVICE_HAS_PHYS_BUTTONS)) { -		ret = rmi_populate_f30(hdev); -		if (ret) -			hid_warn(hdev, "Error while initializing F30 (%d).\n", ret); -	} +	struct rmi_data *data = container_of(xport, struct rmi_data, xport); +	struct hid_device *hdev = data->hdev; -	return 0; +	return rmi_reset_attn_mode(hdev);  }  static int rmi_input_configured(struct hid_device *hdev, struct hid_input *hi)  {  	struct rmi_data *data = hid_get_drvdata(hdev);  	struct input_dev *input = hi->input; -	int ret; -	int res_x, res_y, i; +	int ret = 0; -	data->input = input; +	if (!(data->device_flags & RMI_DEVICE)) +		return 0; + +	data->xport.input = input;  	hid_dbg(hdev, "Opening low level driver\n");  	ret = hid_hw_open(hdev);  	if (ret)  		return ret; -	if (!(data->device_flags & RMI_DEVICE)) -		return 0; -  	/* Allow incoming hid reports */  	hid_device_io_start(hdev); @@ -1222,40 +489,10 @@ static int rmi_input_configured(struct hid_device *hdev, struct hid_input *hi)  		goto exit;  	} -	ret = rmi_populate(hdev); -	if (ret) -		goto exit; - -	hid_info(hdev, "firmware id: %ld\n", data->firmware_id); - -	__set_bit(EV_ABS, input->evbit); -	input_set_abs_params(input, ABS_MT_POSITION_X, 1, data->max_x, 0, 0); -	input_set_abs_params(input, ABS_MT_POSITION_Y, 1, data->max_y, 0, 0); - -	if (data->x_size_mm && data->y_size_mm) { -		res_x = (data->max_x - 1) / data->x_size_mm; -		res_y = (data->max_y - 1) / data->y_size_mm; - -		input_abs_set_res(input, ABS_MT_POSITION_X, res_x); -		input_abs_set_res(input, ABS_MT_POSITION_Y, res_y); -	} - -	input_set_abs_params(input, ABS_MT_ORIENTATION, 0, 1, 0, 0); -	input_set_abs_params(input, ABS_MT_PRESSURE, 0, 0xff, 0, 0); -	input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 0x0f, 0, 0); -	input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 0x0f, 0, 0); - -	ret = input_mt_init_slots(input, data->max_fingers, INPUT_MT_POINTER); -	if (ret < 0) +	ret = rmi_register_transport_device(&data->xport); +	if (ret < 0) { +		dev_err(&hdev->dev, "failed to register transport driver\n");  		goto exit; - -	if (data->button_count) { -		__set_bit(EV_KEY, input->evbit); -		for (i = 0; i < data->button_count; i++) -			__set_bit(BTN_LEFT + i, input->keybit); - -		if (data->button_count == 1) -			__set_bit(INPUT_PROP_BUTTONPAD, input->propbit);  	}  	set_bit(RMI_STARTED, &data->flags); @@ -1304,6 +541,71 @@ static int rmi_check_valid_report_id(struct hid_device *hdev, unsigned type,  	return 0;  } +static struct rmi_device_platform_data rmi_hid_pdata = { +	.sensor_pdata = { +		.sensor_type = rmi_sensor_touchpad, +		.axis_align.flip_y = true, +		.dribble = RMI_REG_STATE_ON, +		.palm_detect = RMI_REG_STATE_OFF, +	}, +}; + +static const struct rmi_transport_ops hid_rmi_ops = { +	.write_block	= rmi_hid_write_block, +	.read_block	= rmi_hid_read_block, +	.reset		= rmi_hid_reset, +}; + +static void rmi_irq_teardown(void *data) +{ +	struct rmi_data *hdata = data; +	struct irq_domain *domain = hdata->domain; + +	if (!domain) +		return; + +	irq_dispose_mapping(irq_find_mapping(domain, 0)); + +	irq_domain_remove(domain); +	hdata->domain = NULL; +	hdata->rmi_irq = 0; +} + +static int rmi_irq_map(struct irq_domain *h, unsigned int virq, +		       irq_hw_number_t hw_irq_num) +{ +	irq_set_chip_and_handler(virq, &dummy_irq_chip, handle_simple_irq); + +	return 0; +} + +static const struct irq_domain_ops rmi_irq_ops = { +	.map = rmi_irq_map, +}; + +static int rmi_setup_irq_domain(struct hid_device *hdev) +{ +	struct rmi_data *hdata = hid_get_drvdata(hdev); +	int ret; + +	hdata->domain = irq_domain_create_linear(hdev->dev.fwnode, 1, +						 &rmi_irq_ops, hdata); +	if (!hdata->domain) +		return -ENOMEM; + +	ret = devm_add_action_or_reset(&hdev->dev, &rmi_irq_teardown, hdata); +	if (ret) +		return ret; + +	hdata->rmi_irq = irq_create_mapping(hdata->domain, 0); +	if (hdata->rmi_irq <= 0) { +		hid_err(hdev, "Can't allocate an IRQ\n"); +		return hdata->rmi_irq < 0 ? hdata->rmi_irq : -ENXIO; +	} + +	return 0; +} +  static int rmi_probe(struct hid_device *hdev, const struct hid_device_id *id)  {  	struct rmi_data *data = NULL; @@ -1365,8 +667,8 @@ static int rmi_probe(struct hid_device *hdev, const struct hid_device_id *id)  	data->writeReport = devm_kzalloc(&hdev->dev, alloc_size, GFP_KERNEL);  	if (!data->writeReport) { -		ret = -ENOMEM; -		return ret; +		hid_err(hdev, "failed to allocate buffer for HID reports\n"); +		return -ENOMEM;  	}  	data->readReport = data->writeReport + data->output_report_size; @@ -1375,6 +677,21 @@ static int rmi_probe(struct hid_device *hdev, const struct hid_device_id *id)  	mutex_init(&data->page_mutex); +	ret = rmi_setup_irq_domain(hdev); +	if (ret) { +		hid_err(hdev, "failed to allocate IRQ domain\n"); +		return ret; +	} + +	if (data->device_flags & RMI_DEVICE_HAS_PHYS_BUTTONS) +		rmi_hid_pdata.f30_data.disable = true; + +	data->xport.dev = hdev->dev.parent; +	data->xport.pdata = rmi_hid_pdata; +	data->xport.pdata.irq = data->rmi_irq; +	data->xport.proto_name = "hid"; +	data->xport.ops = &hid_rmi_ops; +  start:  	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);  	if (ret) { @@ -1382,17 +699,6 @@ start:  		return ret;  	} -	if ((data->device_flags & RMI_DEVICE) && -	    !test_bit(RMI_STARTED, &data->flags)) -		/* -		 * The device maybe in the bootloader if rmi_input_configured -		 * failed to find F11 in the PDT. Print an error, but don't -		 * return an error from rmi_probe so that hidraw will be -		 * accessible from userspace. That way a userspace tool -		 * can be used to reload working firmware on the touchpad. -		 */ -		hid_err(hdev, "Device failed to be properly configured\n"); -  	return 0;  } @@ -1401,6 +707,8 @@ static void rmi_remove(struct hid_device *hdev)  	struct rmi_data *hdata = hid_get_drvdata(hdev);  	clear_bit(RMI_STARTED, &hdata->flags); +	cancel_work_sync(&hdata->reset_work); +	rmi_unregister_transport_device(&hdata->xport);  	hid_hw_stop(hdev);  } @@ -1408,6 +716,7 @@ static void rmi_remove(struct hid_device *hdev)  static const struct hid_device_id rmi_id[] = {  	{ HID_USB_DEVICE(USB_VENDOR_ID_RAZER, USB_DEVICE_ID_RAZER_BLADE_14),  		.driver_data = RMI_DEVICE_HAS_PHYS_BUTTONS }, +	{ HID_USB_DEVICE(USB_VENDOR_ID_LENOVO, USB_DEVICE_ID_LENOVO_X1_COVER) },  	{ HID_DEVICE(HID_BUS_ANY, HID_GROUP_RMI, HID_ANY_ID, HID_ANY_ID) },  	{ }  }; @@ -1425,7 +734,7 @@ static struct hid_driver rmi_driver = {  #ifdef CONFIG_PM  	.suspend		= rmi_suspend,  	.resume			= rmi_post_resume, -	.reset_resume		= rmi_post_reset, +	.reset_resume		= rmi_post_resume,  #endif  };  | 
