[linux.git] / drivers / hid / hid-picolcd_core.c

/***************************************************************************
 *   Copyright (C) 2010-2012 by Bruno Prémont <[email protected]>  *
 *                                                                         *
 *   Based on Logitech G13 driver (v0.4)                                   *
 *     Copyright (C) 2009 by Rick L. Vinyard, Jr. <[email protected]>   *
 *                                                                         *
 *   This program is free software: you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation, version 2 of the License.               *
 *                                                                         *
 *   This driver is distributed in the hope that it will be useful, but    *
 *   WITHOUT ANY WARRANTY; without even the implied warranty of            *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU      *
 *   General Public License for more details.                              *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this software. If not see <http://www.gnu.org/licenses/>.  *
 ***************************************************************************/

#include <linux/hid.h>
#include <linux/hid-debug.h>
#include <linux/input.h>
#include "hid-ids.h"

#include <linux/fb.h>
#include <linux/vmalloc.h>

#include <linux/completion.h>
#include <linux/uaccess.h>
#include <linux/module.h>
#include <linux/string.h>

#include "hid-picolcd.h"


/* Input device
 *
 * The PicoLCD has an IR receiver header, a built-in keypad with 5 keys
 * and header for 4x4 key matrix. The built-in keys are part of the matrix.
 */
static const unsigned short def_keymap[PICOLCD_KEYS] = {
	KEY_RESERVED,	/* none */
	KEY_BACK,	/* col 4 + row 1 */
	KEY_HOMEPAGE,	/* col 3 + row 1 */
	KEY_RESERVED,	/* col 2 + row 1 */
	KEY_RESERVED,	/* col 1 + row 1 */
	KEY_SCROLLUP,	/* col 4 + row 2 */
	KEY_OK,		/* col 3 + row 2 */
	KEY_SCROLLDOWN,	/* col 2 + row 2 */
	KEY_RESERVED,	/* col 1 + row 2 */
	KEY_RESERVED,	/* col 4 + row 3 */
	KEY_RESERVED,	/* col 3 + row 3 */
	KEY_RESERVED,	/* col 2 + row 3 */
	KEY_RESERVED,	/* col 1 + row 3 */
	KEY_RESERVED,	/* col 4 + row 4 */
	KEY_RESERVED,	/* col 3 + row 4 */
	KEY_RESERVED,	/* col 2 + row 4 */
	KEY_RESERVED,	/* col 1 + row 4 */
};


/* Find a given report */
struct hid_report *picolcd_report(int id, struct hid_device *hdev, int dir)
{
	struct list_head *feature_report_list = &hdev->report_enum[dir].report_list;
	struct hid_report *report = NULL;

	list_for_each_entry(report, feature_report_list, list) {
		if (report->id == id)
			return report;
	}
	hid_warn(hdev, "No report with id 0x%x found\n", id);
	return NULL;
}

/* Submit a report and wait for a reply from device - if device fades away
 * or does not respond in time, return NULL */
struct picolcd_pending *picolcd_send_and_wait(struct hid_device *hdev,
		int report_id, const u8 *raw_data, int size)
{
	struct picolcd_data *data = hid_get_drvdata(hdev);
	struct picolcd_pending *work;
	struct hid_report *report = picolcd_out_report(report_id, hdev);
	unsigned long flags;
	int i, j, k;

	if (!report || !data)
		return NULL;
	if (data->status & PICOLCD_FAILED)
		return NULL;
	work = kzalloc(sizeof(*work), GFP_KERNEL);
	if (!work)
		return NULL;

	init_completion(&work->ready);
	work->out_report = report;
	work->in_report  = NULL;
	work->raw_size   = 0;

	mutex_lock(&data->mutex);
	spin_lock_irqsave(&data->lock, flags);
	for (i = k = 0; i < report->maxfield; i++)
		for (j = 0; j < report->field[i]->report_count; j++) {
			hid_set_field(report->field[i], j, k < size ? raw_data[k] : 0);
			k++;
		}
	if (data->status & PICOLCD_FAILED) {
		kfree(work);
		work = NULL;
	} else {
		data->pending = work;
		hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
		spin_unlock_irqrestore(&data->lock, flags);
		wait_for_completion_interruptible_timeout(&work->ready, HZ*2);
		spin_lock_irqsave(&data->lock, flags);
		data->pending = NULL;
	}
	spin_unlock_irqrestore(&data->lock, flags);
	mutex_unlock(&data->mutex);
	return work;
}

/*
 * input class device
 */
static int picolcd_raw_keypad(struct picolcd_data *data,
		struct hid_report *report, u8 *raw_data, int size)
{
	/*
	 * Keypad event
	 * First and second data bytes list currently pressed keys,
	 * 0x00 means no key and at most 2 keys may be pressed at same time
	 */
	int i, j;

	/* determine newly pressed keys */
	for (i = 0; i < size; i++) {
		unsigned int key_code;
		if (raw_data[i] == 0)
			continue;
		for (j = 0; j < sizeof(data->pressed_keys); j++)
			if (data->pressed_keys[j] == raw_data[i])
				goto key_already_down;
		for (j = 0; j < sizeof(data->pressed_keys); j++)
			if (data->pressed_keys[j] == 0) {
				data->pressed_keys[j] = raw_data[i];
				break;
			}
		input_event(data->input_keys, EV_MSC, MSC_SCAN, raw_data[i]);
		if (raw_data[i] < PICOLCD_KEYS)
			key_code = data->keycode[raw_data[i]];
		else
			key_code = KEY_UNKNOWN;
		if (key_code != KEY_UNKNOWN) {
			dbg_hid(PICOLCD_NAME " got key press for %u:%d",
					raw_data[i], key_code);
			input_report_key(data->input_keys, key_code, 1);
		}
		input_sync(data->input_keys);
key_already_down:
		continue;
	}

	/* determine newly released keys */
	for (j = 0; j < sizeof(data->pressed_keys); j++) {
		unsigned int key_code;
		if (data->pressed_keys[j] == 0)
			continue;
		for (i = 0; i < size; i++)
			if (data->pressed_keys[j] == raw_data[i])
				goto key_still_down;
		input_event(data->input_keys, EV_MSC, MSC_SCAN, data->pressed_keys[j]);
		if (data->pressed_keys[j] < PICOLCD_KEYS)
			key_code = data->keycode[data->pressed_keys[j]];
		else
			key_code = KEY_UNKNOWN;
		if (key_code != KEY_UNKNOWN) {
			dbg_hid(PICOLCD_NAME " got key release for %u:%d",
					data->pressed_keys[j], key_code);
			input_report_key(data->input_keys, key_code, 0);
		}
		input_sync(data->input_keys);
		data->pressed_keys[j] = 0;
key_still_down:
		continue;
	}
	return 1;
}

static int picolcd_check_version(struct hid_device *hdev)
{
	struct picolcd_data *data = hid_get_drvdata(hdev);
	struct picolcd_pending *verinfo;
	int ret = 0;

	if (!data)
		return -ENODEV;

	verinfo = picolcd_send_and_wait(hdev, REPORT_VERSION, NULL, 0);
	if (!verinfo) {
		hid_err(hdev, "no version response from PicoLCD\n");
		return -ENODEV;
	}

	if (verinfo->raw_size == 2) {
		data->version[0] = verinfo->raw_data[1];
		data->version[1] = verinfo->raw_data[0];
		if (data->status & PICOLCD_BOOTLOADER) {
			hid_info(hdev, "PicoLCD, bootloader version %d.%d\n",
				 verinfo->raw_data[1], verinfo->raw_data[0]);
		} else {
			hid_info(hdev, "PicoLCD, firmware version %d.%d\n",
				 verinfo->raw_data[1], verinfo->raw_data[0]);
		}
	} else {
		hid_err(hdev, "confused, got unexpected version response from PicoLCD\n");
		ret = -EINVAL;
	}
	kfree(verinfo);
	return ret;
}

/*
 * Reset our device and wait for answer to VERSION request
 */
int picolcd_reset(struct hid_device *hdev)
{
	struct picolcd_data *data = hid_get_drvdata(hdev);
	struct hid_report *report = picolcd_out_report(REPORT_RESET, hdev);
	unsigned long flags;
	int error;

	if (!data || !report || report->maxfield != 1)
		return -ENODEV;

	spin_lock_irqsave(&data->lock, flags);
	if (hdev->product == USB_DEVICE_ID_PICOLCD_BOOTLOADER)
		data->status |= PICOLCD_BOOTLOADER;

	/* perform the reset */
	hid_set_field(report->field[0], 0, 1);
	if (data->status & PICOLCD_FAILED) {
		spin_unlock_irqrestore(&data->lock, flags);
		return -ENODEV;
	}
	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
	spin_unlock_irqrestore(&data->lock, flags);

	error = picolcd_check_version(hdev);
	if (error)
		return error;

	picolcd_resume_lcd(data);
	picolcd_resume_backlight(data);
	picolcd_fb_refresh(data);
	picolcd_leds_set(data);
	return 0;
}

/*
 * The "operation_mode" sysfs attribute
 */
static ssize_t picolcd_operation_mode_show(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	struct picolcd_data *data = dev_get_drvdata(dev);

	if (data->status & PICOLCD_BOOTLOADER)
		return snprintf(buf, PAGE_SIZE, "[bootloader] lcd\n");
	else
		return snprintf(buf, PAGE_SIZE, "bootloader [lcd]\n");
}

static ssize_t picolcd_operation_mode_store(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	struct picolcd_data *data = dev_get_drvdata(dev);
	struct hid_report *report = NULL;
	int timeout = data->opmode_delay;
	unsigned long flags;

	if (sysfs_streq(buf, "lcd")) {
		if (data->status & PICOLCD_BOOTLOADER)
			report = picolcd_out_report(REPORT_EXIT_FLASHER, data->hdev);
	} else if (sysfs_streq(buf, "bootloader")) {
		if (!(data->status & PICOLCD_BOOTLOADER))
			report = picolcd_out_report(REPORT_EXIT_KEYBOARD, data->hdev);
	} else {
		return -EINVAL;
	}

	if (!report || report->maxfield != 1)
		return -EINVAL;

	spin_lock_irqsave(&data->lock, flags);
	hid_set_field(report->field[0], 0, timeout & 0xff);
	hid_set_field(report->field[0], 1, (timeout >> 8) & 0xff);
	hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
	spin_unlock_irqrestore(&data->lock, flags);
	return count;
}

static DEVICE_ATTR(operation_mode, 0644, picolcd_operation_mode_show,
		picolcd_operation_mode_store);

/*
 * The "operation_mode_delay" sysfs attribute
 */
static ssize_t picolcd_operation_mode_delay_show(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	struct picolcd_data *data = dev_get_drvdata(dev);

	return snprintf(buf, PAGE_SIZE, "%hu\n", data->opmode_delay);
}

static ssize_t picolcd_operation_mode_delay_store(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	struct picolcd_data *data = dev_get_drvdata(dev);
	unsigned u;
	if (sscanf(buf, "%u", &u) != 1)
		return -EINVAL;
	if (u > 30000)
		return -EINVAL;
	else
		data->opmode_delay = u;
	return count;
}

static DEVICE_ATTR(operation_mode_delay, 0644, picolcd_operation_mode_delay_show,
		picolcd_operation_mode_delay_store);

/*
 * Handle raw report as sent by device
 */
static int picolcd_raw_event(struct hid_device *hdev,
		struct hid_report *report, u8 *raw_data, int size)
{
	struct picolcd_data *data = hid_get_drvdata(hdev);
	unsigned long flags;
	int ret = 0;

	if (!data)
		return 1;

	if (size > 64) {
		hid_warn(hdev, "invalid size value (%d) for picolcd raw event (%d)\n",
				size, report->id);
		return 0;
	}

	if (report->id == REPORT_KEY_STATE) {
		if (data->input_keys)
			ret = picolcd_raw_keypad(data, report, raw_data+1, size-1);
	} else if (report->id == REPORT_IR_DATA) {
		ret = picolcd_raw_cir(data, report, raw_data+1, size-1);
	} else {
		spin_lock_irqsave(&data->lock, flags);
		/*
		 * We let the caller of picolcd_send_and_wait() check if the
		 * report we got is one of the expected ones or not.
		 */
		if (data->pending) {
			memcpy(data->pending->raw_data, raw_data+1, size-1);
			data->pending->raw_size  = size-1;
			data->pending->in_report = report;
			complete(&data->pending->ready);
		}
		spin_unlock_irqrestore(&data->lock, flags);
	}

	picolcd_debug_raw_event(data, hdev, report, raw_data, size);
	return 1;
}

#ifdef CONFIG_PM
static int picolcd_suspend(struct hid_device *hdev, pm_message_t message)
{
	if (PMSG_IS_AUTO(message))
		return 0;

	picolcd_suspend_backlight(hid_get_drvdata(hdev));
	dbg_hid(PICOLCD_NAME " device ready for suspend\n");
	return 0;
}

static int picolcd_resume(struct hid_device *hdev)
{
	int ret;
	ret = picolcd_resume_backlight(hid_get_drvdata(hdev));
	if (ret)
		dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret);
	return 0;
}

static int picolcd_reset_resume(struct hid_device *hdev)
{
	int ret;
	ret = picolcd_reset(hdev);
	if (ret)
		dbg_hid(PICOLCD_NAME " resetting our device failed: %d\n", ret);
	ret = picolcd_fb_reset(hid_get_drvdata(hdev), 0);
	if (ret)
		dbg_hid(PICOLCD_NAME " restoring framebuffer content failed: %d\n", ret);
	ret = picolcd_resume_lcd(hid_get_drvdata(hdev));
	if (ret)
		dbg_hid(PICOLCD_NAME " restoring lcd failed: %d\n", ret);
	ret = picolcd_resume_backlight(hid_get_drvdata(hdev));
	if (ret)
		dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret);
	picolcd_leds_set(hid_get_drvdata(hdev));
	return 0;
}
#endif

/* initialize keypad input device */
static int picolcd_init_keys(struct picolcd_data *data,
		struct hid_report *report)
{
	struct hid_device *hdev = data->hdev;
	struct input_dev *idev;
	int error, i;

	if (!report)
		return -ENODEV;
	if (report->maxfield != 1 || report->field[0]->report_count != 2 ||
			report->field[0]->report_size != 8) {
		hid_err(hdev, "unsupported KEY_STATE report\n");
		return -EINVAL;
	}

	idev = input_allocate_device();
	if (idev == NULL) {
		hid_err(hdev, "failed to allocate input device\n");
		return -ENOMEM;
	}
	input_set_drvdata(idev, hdev);
	memcpy(data->keycode, def_keymap, sizeof(def_keymap));
	idev->name = hdev->name;
	idev->phys = hdev->phys;
	idev->uniq = hdev->uniq;
	idev->id.bustype = hdev->bus;
	idev->id.vendor  = hdev->vendor;
	idev->id.product = hdev->product;
	idev->id.version = hdev->version;
	idev->dev.parent = &hdev->dev;
	idev->keycode     = &data->keycode;
	idev->keycodemax  = PICOLCD_KEYS;
	idev->keycodesize = sizeof(data->keycode[0]);
	input_set_capability(idev, EV_MSC, MSC_SCAN);
	set_bit(EV_REP, idev->evbit);
	for (i = 0; i < PICOLCD_KEYS; i++)
		input_set_capability(idev, EV_KEY, data->keycode[i]);
	error = input_register_device(idev);
	if (error) {
		hid_err(hdev, "error registering the input device\n");
		input_free_device(idev);
		return error;
	}
	data->input_keys = idev;
	return 0;
}

static void picolcd_exit_keys(struct picolcd_data *data)
{
	struct input_dev *idev = data->input_keys;

	data->input_keys = NULL;
	if (idev)
		input_unregister_device(idev);
}

static int picolcd_probe_lcd(struct hid_device *hdev, struct picolcd_data *data)
{
	int error;

	/* Setup keypad input device */
	error = picolcd_init_keys(data, picolcd_in_report(REPORT_KEY_STATE, hdev));
	if (error)
		goto err;

	/* Setup CIR input device */
	error = picolcd_init_cir(data, picolcd_in_report(REPORT_IR_DATA, hdev));
	if (error)
		goto err;

	/* Set up the framebuffer device */
	error = picolcd_init_framebuffer(data);
	if (error)
		goto err;

	/* Setup lcd class device */
	error = picolcd_init_lcd(data, picolcd_out_report(REPORT_CONTRAST, hdev));
	if (error)
		goto err;

	/* Setup backlight class device */
	error = picolcd_init_backlight(data, picolcd_out_report(REPORT_BRIGHTNESS, hdev));
	if (error)
		goto err;

	/* Setup the LED class devices */
	error = picolcd_init_leds(data, picolcd_out_report(REPORT_LED_STATE, hdev));
	if (error)
		goto err;

	picolcd_init_devfs(data, picolcd_out_report(REPORT_EE_READ, hdev),
			picolcd_out_report(REPORT_EE_WRITE, hdev),
			picolcd_out_report(REPORT_READ_MEMORY, hdev),
			picolcd_out_report(REPORT_WRITE_MEMORY, hdev),
			picolcd_out_report(REPORT_RESET, hdev));
	return 0;
err:
	picolcd_exit_leds(data);
	picolcd_exit_backlight(data);
	picolcd_exit_lcd(data);
	picolcd_exit_framebuffer(data);
	picolcd_exit_cir(data);
	picolcd_exit_keys(data);
	return error;
}

static int picolcd_probe_bootloader(struct hid_device *hdev, struct picolcd_data *data)
{
	picolcd_init_devfs(data, NULL, NULL,
			picolcd_out_report(REPORT_BL_READ_MEMORY, hdev),
			picolcd_out_report(REPORT_BL_WRITE_MEMORY, hdev), NULL);
	return 0;
}

static int picolcd_probe(struct hid_device *hdev,
		     const struct hid_device_id *id)
{
	struct picolcd_data *data;
	int error = -ENOMEM;

	dbg_hid(PICOLCD_NAME " hardware probe...\n");

	/*
	 * Let's allocate the picolcd data structure, set some reasonable
	 * defaults, and associate it with the device
	 */
	data = kzalloc(sizeof(struct picolcd_data), GFP_KERNEL);
	if (data == NULL) {
		hid_err(hdev, "can't allocate space for Minibox PicoLCD device data\n");
		error = -ENOMEM;
		goto err_no_cleanup;
	}

	spin_lock_init(&data->lock);
	mutex_init(&data->mutex);
	data->hdev = hdev;
	data->opmode_delay = 5000;
	if (hdev->product == USB_DEVICE_ID_PICOLCD_BOOTLOADER)
		data->status |= PICOLCD_BOOTLOADER;
	hid_set_drvdata(hdev, data);

	/* Parse the device reports and start it up */
	error = hid_parse(hdev);
	if (error) {
		hid_err(hdev, "device report parse failed\n");
		goto err_cleanup_data;
	}

	error = hid_hw_start(hdev, 0);
	if (error) {
		hid_err(hdev, "hardware start failed\n");
		goto err_cleanup_data;
	}

	error = hid_hw_open(hdev);
	if (error) {
		hid_err(hdev, "failed to open input interrupt pipe for key and IR events\n");
		goto err_cleanup_hid_hw;
	}

	error = device_create_file(&hdev->dev, &dev_attr_operation_mode_delay);
	if (error) {
		hid_err(hdev, "failed to create sysfs attributes\n");
		goto err_cleanup_hid_ll;
	}

	error = device_create_file(&hdev->dev, &dev_attr_operation_mode);
	if (error) {
		hid_err(hdev, "failed to create sysfs attributes\n");
		goto err_cleanup_sysfs1;
	}

	if (data->status & PICOLCD_BOOTLOADER)
		error = picolcd_probe_bootloader(hdev, data);
	else
		error = picolcd_probe_lcd(hdev, data);
	if (error)
		goto err_cleanup_sysfs2;

	dbg_hid(PICOLCD_NAME " activated and initialized\n");
	return 0;

err_cleanup_sysfs2:
	device_remove_file(&hdev->dev, &dev_attr_operation_mode);
err_cleanup_sysfs1:
	device_remove_file(&hdev->dev, &dev_attr_operation_mode_delay);
err_cleanup_hid_ll:
	hid_hw_close(hdev);
err_cleanup_hid_hw:
	hid_hw_stop(hdev);
err_cleanup_data:
	kfree(data);
err_no_cleanup:
	hid_set_drvdata(hdev, NULL);

	return error;
}

static void picolcd_remove(struct hid_device *hdev)
{
	struct picolcd_data *data = hid_get_drvdata(hdev);
	unsigned long flags;

	dbg_hid(PICOLCD_NAME " hardware remove...\n");
	spin_lock_irqsave(&data->lock, flags);
	data->status |= PICOLCD_FAILED;
	spin_unlock_irqrestore(&data->lock, flags);

	picolcd_exit_devfs(data);
	device_remove_file(&hdev->dev, &dev_attr_operation_mode);
	device_remove_file(&hdev->dev, &dev_attr_operation_mode_delay);
	hid_hw_close(hdev);
	hid_hw_stop(hdev);

	/* Shortcut potential pending reply that will never arrive */
	spin_lock_irqsave(&data->lock, flags);
	if (data->pending)
		complete(&data->pending->ready);
	spin_unlock_irqrestore(&data->lock, flags);

	/* Cleanup LED */
	picolcd_exit_leds(data);
	/* Clean up the framebuffer */
	picolcd_exit_backlight(data);
	picolcd_exit_lcd(data);
	picolcd_exit_framebuffer(data);
	/* Cleanup input */
	picolcd_exit_cir(data);
	picolcd_exit_keys(data);

	hid_set_drvdata(hdev, NULL);
	mutex_destroy(&data->mutex);
	/* Finally, clean up the picolcd data itself */
	kfree(data);
}

static const struct hid_device_id picolcd_devices[] = {
	{ HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICOLCD) },
	{ HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICOLCD_BOOTLOADER) },
	{ }
};
MODULE_DEVICE_TABLE(hid, picolcd_devices);

static struct hid_driver picolcd_driver = {
	.name =          "hid-picolcd",
	.id_table =      picolcd_devices,
	.probe =         picolcd_probe,
	.remove =        picolcd_remove,
	.raw_event =     picolcd_raw_event,
#ifdef CONFIG_PM
	.suspend =       picolcd_suspend,
	.resume =        picolcd_resume,
	.reset_resume =  picolcd_reset_resume,
#endif
};
module_hid_driver(picolcd_driver);

MODULE_DESCRIPTION("Minibox graphics PicoLCD Driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
fabdbf2f BP	1	/***************************************************************************
	2	* Copyright (C) 2010-2012 by Bruno Prémont <[email protected]> *
	3	* *
	4	* Based on Logitech G13 driver (v0.4) *
	5	* Copyright (C) 2009 by Rick L. Vinyard, Jr. <[email protected]> *
	6	* *
	7	* This program is free software: you can redistribute it and/or modify *
	8	* it under the terms of the GNU General Public License as published by *
	9	* the Free Software Foundation, version 2 of the License. *
	10	* *
	11	* This driver is distributed in the hope that it will be useful, but *
	12	* WITHOUT ANY WARRANTY; without even the implied warranty of *
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU *
	14	* General Public License for more details. *
	15	* *
	16	* You should have received a copy of the GNU General Public License *
	17	* along with this software. If not see <http://www.gnu.org/licenses/>. *
	18	***************************************************************************/
	19
	20	#include <linux/hid.h>
	21	#include <linux/hid-debug.h>
	22	#include <linux/input.h>
	23	#include "hid-ids.h"
fabdbf2f BP	24
	25	#include <linux/fb.h>
	26	#include <linux/vmalloc.h>
	27
	28	#include <linux/completion.h>
	29	#include <linux/uaccess.h>
	30	#include <linux/module.h>
70cd8121	31	#include <linux/string.h>
fabdbf2f BP	32
	33	#include "hid-picolcd.h"
	34
	35
	36	/* Input device
	37	*
	38	* The PicoLCD has an IR receiver header, a built-in keypad with 5 keys
	39	* and header for 4x4 key matrix. The built-in keys are part of the matrix.
	40	*/
	41	static const unsigned short def_keymap[PICOLCD_KEYS] = {
	42	KEY_RESERVED, /* none */
	43	KEY_BACK, /* col 4 + row 1 */
	44	KEY_HOMEPAGE, /* col 3 + row 1 */
	45	KEY_RESERVED, /* col 2 + row 1 */
	46	KEY_RESERVED, /* col 1 + row 1 */
	47	KEY_SCROLLUP, /* col 4 + row 2 */
	48	KEY_OK, /* col 3 + row 2 */
	49	KEY_SCROLLDOWN, /* col 2 + row 2 */
	50	KEY_RESERVED, /* col 1 + row 2 */
	51	KEY_RESERVED, /* col 4 + row 3 */
	52	KEY_RESERVED, /* col 3 + row 3 */
	53	KEY_RESERVED, /* col 2 + row 3 */
	54	KEY_RESERVED, /* col 1 + row 3 */
	55	KEY_RESERVED, /* col 4 + row 4 */
	56	KEY_RESERVED, /* col 3 + row 4 */
	57	KEY_RESERVED, /* col 2 + row 4 */
	58	KEY_RESERVED, /* col 1 + row 4 */
	59	};
	60
	61
	62	/* Find a given report */
	63	struct hid_report picolcd_report(int id, struct hid_device hdev, int dir)
	64	{
	65	struct list_head *feature_report_list = &hdev->report_enum[dir].report_list;
	66	struct hid_report *report = NULL;
	67
	68	list_for_each_entry(report, feature_report_list, list) {
	69	if (report->id == id)
	70	return report;
	71	}
	72	hid_warn(hdev, "No report with id 0x%x found\n", id);
	73	return NULL;
	74	}
	75
	76	/* Submit a report and wait for a reply from device - if device fades away
	77	* or does not respond in time, return NULL */
	78	struct picolcd_pending picolcd_send_and_wait(struct hid_device hdev,
	79	int report_id, const u8 *raw_data, int size)
	80	{
	81	struct picolcd_data *data = hid_get_drvdata(hdev);
	82	struct picolcd_pending *work;
	83	struct hid_report *report = picolcd_out_report(report_id, hdev);
	84	unsigned long flags;
	85	int i, j, k;
	86
	87	if (!report \|\| !data)
	88	return NULL;
	89	if (data->status & PICOLCD_FAILED)
	90	return NULL;
	91	work = kzalloc(sizeof(*work), GFP_KERNEL);
	92	if (!work)
	93	return NULL;
	94
	95	init_completion(&work->ready);
96	work->out_report = report;
97	work->in_report = NULL;
98	work->raw_size = 0;
99
100	mutex_lock(&data->mutex);
101	spin_lock_irqsave(&data->lock, flags);
102	for (i = k = 0; i < report->maxfield; i++)
103	for (j = 0; j < report->field[i]->report_count; j++) {
104	hid_set_field(report->field[i], j, k < size ? raw_data[k] : 0);
105	k++;
106	}
a93ab849 BP	107	if (data->status & PICOLCD_FAILED) {
	108	kfree(work);
	109	work = NULL;
	110	} else {
	111	data->pending = work;
d8814272	112	hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
a93ab849 BP	113	spin_unlock_irqrestore(&data->lock, flags);
	114	wait_for_completion_interruptible_timeout(&work->ready, HZ*2);
	115	spin_lock_irqsave(&data->lock, flags);
	116	data->pending = NULL;
	117	}
fabdbf2f BP	118	spin_unlock_irqrestore(&data->lock, flags);
	119	mutex_unlock(&data->mutex);
	120	return work;
	121	}
	122
	123	/*
	124	* input class device
	125	*/
	126	static int picolcd_raw_keypad(struct picolcd_data *data,
	127	struct hid_report report, u8 raw_data, int size)
	128	{
	129	/*
	130	* Keypad event
	131	* First and second data bytes list currently pressed keys,
	132	* 0x00 means no key and at most 2 keys may be pressed at same time
	133	*/
	134	int i, j;
	135
	136	/* determine newly pressed keys */
	137	for (i = 0; i < size; i++) {
	138	unsigned int key_code;
	139	if (raw_data[i] == 0)
	140	continue;
	141	for (j = 0; j < sizeof(data->pressed_keys); j++)
	142	if (data->pressed_keys[j] == raw_data[i])
	143	goto key_already_down;
	144	for (j = 0; j < sizeof(data->pressed_keys); j++)
	145	if (data->pressed_keys[j] == 0) {
	146	data->pressed_keys[j] = raw_data[i];
	147	break;
	148	}
	149	input_event(data->input_keys, EV_MSC, MSC_SCAN, raw_data[i]);
	150	if (raw_data[i] < PICOLCD_KEYS)
	151	key_code = data->keycode[raw_data[i]];
	152	else
	153	key_code = KEY_UNKNOWN;
	154	if (key_code != KEY_UNKNOWN) {
	155	dbg_hid(PICOLCD_NAME " got key press for %u:%d",
	156	raw_data[i], key_code);
	157	input_report_key(data->input_keys, key_code, 1);
	158	}
	159	input_sync(data->input_keys);
	160	key_already_down:
	161	continue;
	162	}
	163
	164	/* determine newly released keys */
	165	for (j = 0; j < sizeof(data->pressed_keys); j++) {
	166	unsigned int key_code;
	167	if (data->pressed_keys[j] == 0)
	168	continue;
	169	for (i = 0; i < size; i++)
	170	if (data->pressed_keys[j] == raw_data[i])
	171	goto key_still_down;
	172	input_event(data->input_keys, EV_MSC, MSC_SCAN, data->pressed_keys[j]);
	173	if (data->pressed_keys[j] < PICOLCD_KEYS)
	174	key_code = data->keycode[data->pressed_keys[j]];
	175	else
	176	key_code = KEY_UNKNOWN;
	177	if (key_code != KEY_UNKNOWN) {
	178	dbg_hid(PICOLCD_NAME " got key release for %u:%d",
	179	data->pressed_keys[j], key_code);
	180	input_report_key(data->input_keys, key_code, 0);
	181	}
182	input_sync(data->input_keys);
183	data->pressed_keys[j] = 0;
184	key_still_down:
185	continue;
186	}
187	return 1;
188	}
189
190	static int picolcd_check_version(struct hid_device *hdev)
191	{
192	struct picolcd_data *data = hid_get_drvdata(hdev);
193	struct picolcd_pending *verinfo;
194	int ret = 0;
195
196	if (!data)
197	return -ENODEV;
198
199	verinfo = picolcd_send_and_wait(hdev, REPORT_VERSION, NULL, 0);
200	if (!verinfo) {
201	hid_err(hdev, "no version response from PicoLCD\n");
202	return -ENODEV;
203	}
204
205	if (verinfo->raw_size == 2) {
206	data->version[0] = verinfo->raw_data[1];
207	data->version[1] = verinfo->raw_data[0];
208	if (data->status & PICOLCD_BOOTLOADER) {
209	hid_info(hdev, "PicoLCD, bootloader version %d.%d\n",
210	verinfo->raw_data[1], verinfo->raw_data[0]);
211	} else {
212	hid_info(hdev, "PicoLCD, firmware version %d.%d\n",
213	verinfo->raw_data[1], verinfo->raw_data[0]);
214	}
215	} else {
216	hid_err(hdev, "confused, got unexpected version response from PicoLCD\n");
217	ret = -EINVAL;
218	}
219	kfree(verinfo);
220	return ret;
221	}
222
223	/*
224	* Reset our device and wait for answer to VERSION request
225	*/
226	int picolcd_reset(struct hid_device *hdev)
227	{
228	struct picolcd_data *data = hid_get_drvdata(hdev);
229	struct hid_report *report = picolcd_out_report(REPORT_RESET, hdev);
230	unsigned long flags;
231	int error;
232
233	if (!data \|\| !report \|\| report->maxfield != 1)
234	return -ENODEV;
235
236	spin_lock_irqsave(&data->lock, flags);
237	if (hdev->product == USB_DEVICE_ID_PICOLCD_BOOTLOADER)
238	data->status \|= PICOLCD_BOOTLOADER;
239
240	/* perform the reset */
241	hid_set_field(report->field[0], 0, 1);
a93ab849 BP	242	if (data->status & PICOLCD_FAILED) {
	243	spin_unlock_irqrestore(&data->lock, flags);
	244	return -ENODEV;
	245	}
d8814272	246	hid_hw_request(hdev, report, HID_REQ_SET_REPORT);
fabdbf2f BP	247	spin_unlock_irqrestore(&data->lock, flags);
	248
	249	error = picolcd_check_version(hdev);
	250	if (error)
	251	return error;
	252
	253	picolcd_resume_lcd(data);
	254	picolcd_resume_backlight(data);
	255	picolcd_fb_refresh(data);
	256	picolcd_leds_set(data);
	257	return 0;
	258	}
	259
	260	/*
	261	* The "operation_mode" sysfs attribute
	262	*/
	263	static ssize_t picolcd_operation_mode_show(struct device *dev,
	264	struct device_attribute attr, char buf)
	265	{
	266	struct picolcd_data *data = dev_get_drvdata(dev);
	267
	268	if (data->status & PICOLCD_BOOTLOADER)
	269	return snprintf(buf, PAGE_SIZE, "[bootloader] lcd\n");
	270	else
	271	return snprintf(buf, PAGE_SIZE, "bootloader [lcd]\n");
	272	}
	273
	274	static ssize_t picolcd_operation_mode_store(struct device *dev,
	275	struct device_attribute attr, const char buf, size_t count)
	276	{
	277	struct picolcd_data *data = dev_get_drvdata(dev);
	278	struct hid_report *report = NULL;
fabdbf2f BP	279	int timeout = data->opmode_delay;
	280	unsigned long flags;
	281
70cd8121	282	if (sysfs_streq(buf, "lcd")) {
fabdbf2f BP	283	if (data->status & PICOLCD_BOOTLOADER)
fabdbf2f BP	284	report = picolcd_out_report(REPORT_EXIT_FLASHER, data->hdev);
70cd8121	285	} else if (sysfs_streq(buf, "bootloader")) {
fabdbf2f BP	286	if (!(data->status & PICOLCD_BOOTLOADER))
fabdbf2f BP	287	report = picolcd_out_report(REPORT_EXIT_KEYBOARD, data->hdev);
70cd8121	288	} else {
fabdbf2f	289	return -EINVAL;
70cd8121	290	}
fabdbf2f	291
70cd8121	292	if (!report \|\| report->maxfield != 1)
fabdbf2f BP	293	return -EINVAL;
	294
	295	spin_lock_irqsave(&data->lock, flags);
	296	hid_set_field(report->field[0], 0, timeout & 0xff);
	297	hid_set_field(report->field[0], 1, (timeout >> 8) & 0xff);
d8814272	298	hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
fabdbf2f BP	299	spin_unlock_irqrestore(&data->lock, flags);
	300	return count;
	301	}
	302
	303	static DEVICE_ATTR(operation_mode, 0644, picolcd_operation_mode_show,
	304	picolcd_operation_mode_store);
	305
	306	/*
	307	* The "operation_mode_delay" sysfs attribute
	308	*/
	309	static ssize_t picolcd_operation_mode_delay_show(struct device *dev,
	310	struct device_attribute attr, char buf)
	311	{
	312	struct picolcd_data *data = dev_get_drvdata(dev);
	313
	314	return snprintf(buf, PAGE_SIZE, "%hu\n", data->opmode_delay);
	315	}
	316
	317	static ssize_t picolcd_operation_mode_delay_store(struct device *dev,
	318	struct device_attribute attr, const char buf, size_t count)
	319	{
	320	struct picolcd_data *data = dev_get_drvdata(dev);
	321	unsigned u;
	322	if (sscanf(buf, "%u", &u) != 1)
	323	return -EINVAL;
	324	if (u > 30000)
	325	return -EINVAL;
	326	else
	327	data->opmode_delay = u;
	328	return count;
	329	}
	330
	331	static DEVICE_ATTR(operation_mode_delay, 0644, picolcd_operation_mode_delay_show,
	332	picolcd_operation_mode_delay_store);
	333
	334	/*
	335	* Handle raw report as sent by device
	336	*/
	337	static int picolcd_raw_event(struct hid_device *hdev,
	338	struct hid_report report, u8 raw_data, int size)
	339	{
	340	struct picolcd_data *data = hid_get_drvdata(hdev);
	341	unsigned long flags;
	342	int ret = 0;
	343
	344	if (!data)
	345	return 1;
	346
844817e4	347	if (size > 64) {
604b6077 JK	348	hid_warn(hdev, "invalid size value (%d) for picolcd raw event (%d)\n",
604b6077 JK	349	size, report->id);
844817e4 JK	350	return 0;
	351	}
	352
fabdbf2f BP	353	if (report->id == REPORT_KEY_STATE) {
	354	if (data->input_keys)
	355	ret = picolcd_raw_keypad(data, report, raw_data+1, size-1);
	356	} else if (report->id == REPORT_IR_DATA) {
ae08e324	357	ret = picolcd_raw_cir(data, report, raw_data+1, size-1);
fabdbf2f BP	358	} else {
	359	spin_lock_irqsave(&data->lock, flags);
	360	/*
	361	* We let the caller of picolcd_send_and_wait() check if the
	362	* report we got is one of the expected ones or not.
	363	*/
	364	if (data->pending) {
	365	memcpy(data->pending->raw_data, raw_data+1, size-1);
	366	data->pending->raw_size = size-1;
	367	data->pending->in_report = report;
	368	complete(&data->pending->ready);
	369	}
	370	spin_unlock_irqrestore(&data->lock, flags);
	371	}
	372
	373	picolcd_debug_raw_event(data, hdev, report, raw_data, size);
	374	return 1;
	375	}
	376
	377	#ifdef CONFIG_PM
	378	static int picolcd_suspend(struct hid_device *hdev, pm_message_t message)
	379	{
	380	if (PMSG_IS_AUTO(message))
	381	return 0;
	382
	383	picolcd_suspend_backlight(hid_get_drvdata(hdev));
	384	dbg_hid(PICOLCD_NAME " device ready for suspend\n");
	385	return 0;
	386	}
	387
	388	static int picolcd_resume(struct hid_device *hdev)
	389	{
	390	int ret;
	391	ret = picolcd_resume_backlight(hid_get_drvdata(hdev));
	392	if (ret)
	393	dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret);
	394	return 0;
	395	}
	396
	397	static int picolcd_reset_resume(struct hid_device *hdev)
	398	{
	399	int ret;
	400	ret = picolcd_reset(hdev);
	401	if (ret)
	402	dbg_hid(PICOLCD_NAME " resetting our device failed: %d\n", ret);
	403	ret = picolcd_fb_reset(hid_get_drvdata(hdev), 0);
	404	if (ret)
	405	dbg_hid(PICOLCD_NAME " restoring framebuffer content failed: %d\n", ret);
	406	ret = picolcd_resume_lcd(hid_get_drvdata(hdev));
	407	if (ret)
	408	dbg_hid(PICOLCD_NAME " restoring lcd failed: %d\n", ret);
	409	ret = picolcd_resume_backlight(hid_get_drvdata(hdev));
	410	if (ret)
	411	dbg_hid(PICOLCD_NAME " restoring backlight failed: %d\n", ret);
	412	picolcd_leds_set(hid_get_drvdata(hdev));
	413	return 0;
	414	}
	415	#endif
	416
	417	/* initialize keypad input device */
	418	static int picolcd_init_keys(struct picolcd_data *data,
	419	struct hid_report *report)
	420	{
	421	struct hid_device *hdev = data->hdev;
422	struct input_dev *idev;
423	int error, i;
424
425	if (!report)
426	return -ENODEV;
427	if (report->maxfield != 1 \|\| report->field[0]->report_count != 2 \|\|
428	report->field[0]->report_size != 8) {
429	hid_err(hdev, "unsupported KEY_STATE report\n");
430	return -EINVAL;
431	}
432
433	idev = input_allocate_device();
434	if (idev == NULL) {
435	hid_err(hdev, "failed to allocate input device\n");
436	return -ENOMEM;
437	}
438	input_set_drvdata(idev, hdev);
439	memcpy(data->keycode, def_keymap, sizeof(def_keymap));
440	idev->name = hdev->name;
441	idev->phys = hdev->phys;
442	idev->uniq = hdev->uniq;
443	idev->id.bustype = hdev->bus;
444	idev->id.vendor = hdev->vendor;
445	idev->id.product = hdev->product;
446	idev->id.version = hdev->version;
eb9001cd	447	idev->dev.parent = &hdev->dev;
fabdbf2f BP	448	idev->keycode = &data->keycode;
	449	idev->keycodemax = PICOLCD_KEYS;
	450	idev->keycodesize = sizeof(data->keycode[0]);
	451	input_set_capability(idev, EV_MSC, MSC_SCAN);
	452	set_bit(EV_REP, idev->evbit);
	453	for (i = 0; i < PICOLCD_KEYS; i++)
	454	input_set_capability(idev, EV_KEY, data->keycode[i]);
	455	error = input_register_device(idev);
	456	if (error) {
	457	hid_err(hdev, "error registering the input device\n");
	458	input_free_device(idev);
	459	return error;
	460	}
	461	data->input_keys = idev;
	462	return 0;
	463	}
	464
	465	static void picolcd_exit_keys(struct picolcd_data *data)
	466	{
	467	struct input_dev *idev = data->input_keys;
	468
	469	data->input_keys = NULL;
	470	if (idev)
	471	input_unregister_device(idev);
	472	}
	473
	474	static int picolcd_probe_lcd(struct hid_device hdev, struct picolcd_data data)
	475	{
	476	int error;
	477
fabdbf2f BP	478	/* Setup keypad input device */
	479	error = picolcd_init_keys(data, picolcd_in_report(REPORT_KEY_STATE, hdev));
	480	if (error)
	481	goto err;
	482
	483	/* Setup CIR input device */
	484	error = picolcd_init_cir(data, picolcd_in_report(REPORT_IR_DATA, hdev));
	485	if (error)
	486	goto err;
	487
	488	/* Set up the framebuffer device */
	489	error = picolcd_init_framebuffer(data);
	490	if (error)
	491	goto err;
	492
	493	/* Setup lcd class device */
	494	error = picolcd_init_lcd(data, picolcd_out_report(REPORT_CONTRAST, hdev));
	495	if (error)
	496	goto err;
	497
	498	/* Setup backlight class device */
	499	error = picolcd_init_backlight(data, picolcd_out_report(REPORT_BRIGHTNESS, hdev));
	500	if (error)
	501	goto err;
	502
	503	/* Setup the LED class devices */
	504	error = picolcd_init_leds(data, picolcd_out_report(REPORT_LED_STATE, hdev));
	505	if (error)
	506	goto err;
	507
	508	picolcd_init_devfs(data, picolcd_out_report(REPORT_EE_READ, hdev),
	509	picolcd_out_report(REPORT_EE_WRITE, hdev),
	510	picolcd_out_report(REPORT_READ_MEMORY, hdev),
	511	picolcd_out_report(REPORT_WRITE_MEMORY, hdev),
	512	picolcd_out_report(REPORT_RESET, hdev));
	513	return 0;
	514	err:
	515	picolcd_exit_leds(data);
	516	picolcd_exit_backlight(data);
	517	picolcd_exit_lcd(data);
	518	picolcd_exit_framebuffer(data);
	519	picolcd_exit_cir(data);
	520	picolcd_exit_keys(data);
	521	return error;
	522	}
	523
	524	static int picolcd_probe_bootloader(struct hid_device hdev, struct picolcd_data data)
	525	{
fabdbf2f BP	526	picolcd_init_devfs(data, NULL, NULL,
	527	picolcd_out_report(REPORT_BL_READ_MEMORY, hdev),
	528	picolcd_out_report(REPORT_BL_WRITE_MEMORY, hdev), NULL);
	529	return 0;
	530	}
	531
	532	static int picolcd_probe(struct hid_device *hdev,
	533	const struct hid_device_id *id)
	534	{
	535	struct picolcd_data *data;
	536	int error = -ENOMEM;
	537
	538	dbg_hid(PICOLCD_NAME " hardware probe...\n");
	539
	540	/*
	541	* Let's allocate the picolcd data structure, set some reasonable
	542	* defaults, and associate it with the device
	543	*/
	544	data = kzalloc(sizeof(struct picolcd_data), GFP_KERNEL);
	545	if (data == NULL) {
	546	hid_err(hdev, "can't allocate space for Minibox PicoLCD device data\n");
	547	error = -ENOMEM;
	548	goto err_no_cleanup;
	549	}
	550
	551	spin_lock_init(&data->lock);
	552	mutex_init(&data->mutex);
	553	data->hdev = hdev;
	554	data->opmode_delay = 5000;
	555	if (hdev->product == USB_DEVICE_ID_PICOLCD_BOOTLOADER)
	556	data->status \|= PICOLCD_BOOTLOADER;
	557	hid_set_drvdata(hdev, data);
	558
	559	/* Parse the device reports and start it up */
	560	error = hid_parse(hdev);
	561	if (error) {
	562	hid_err(hdev, "device report parse failed\n");
	563	goto err_cleanup_data;
	564	}
	565
fabdbf2f	566	error = hid_hw_start(hdev, 0);
fabdbf2f BP	567	if (error) {
	568	hid_err(hdev, "hardware start failed\n");
	569	goto err_cleanup_data;
	570	}
	571
	572	error = hid_hw_open(hdev);
	573	if (error) {
	574	hid_err(hdev, "failed to open input interrupt pipe for key and IR events\n");
	575	goto err_cleanup_hid_hw;
	576	}
	577
	578	error = device_create_file(&hdev->dev, &dev_attr_operation_mode_delay);
	579	if (error) {
	580	hid_err(hdev, "failed to create sysfs attributes\n");
	581	goto err_cleanup_hid_ll;
	582	}
	583
	584	error = device_create_file(&hdev->dev, &dev_attr_operation_mode);
	585	if (error) {
	586	hid_err(hdev, "failed to create sysfs attributes\n");
	587	goto err_cleanup_sysfs1;
	588	}
	589
	590	if (data->status & PICOLCD_BOOTLOADER)
	591	error = picolcd_probe_bootloader(hdev, data);
	592	else
	593	error = picolcd_probe_lcd(hdev, data);
	594	if (error)
	595	goto err_cleanup_sysfs2;
	596
	597	dbg_hid(PICOLCD_NAME " activated and initialized\n");
	598	return 0;
	599
	600	err_cleanup_sysfs2:
	601	device_remove_file(&hdev->dev, &dev_attr_operation_mode);
	602	err_cleanup_sysfs1:
	603	device_remove_file(&hdev->dev, &dev_attr_operation_mode_delay);
	604	err_cleanup_hid_ll:
	605	hid_hw_close(hdev);
	606	err_cleanup_hid_hw:
	607	hid_hw_stop(hdev);
	608	err_cleanup_data:
	609	kfree(data);
	610	err_no_cleanup:
	611	hid_set_drvdata(hdev, NULL);
	612
	613	return error;
	614	}
	615
	616	static void picolcd_remove(struct hid_device *hdev)
	617	{
	618	struct picolcd_data *data = hid_get_drvdata(hdev);
	619	unsigned long flags;
	620
	621	dbg_hid(PICOLCD_NAME " hardware remove...\n");
	622	spin_lock_irqsave(&data->lock, flags);
	623	data->status \|= PICOLCD_FAILED;
	624	spin_unlock_irqrestore(&data->lock, flags);
	625
	626	picolcd_exit_devfs(data);
	627	device_remove_file(&hdev->dev, &dev_attr_operation_mode);
	628	device_remove_file(&hdev->dev, &dev_attr_operation_mode_delay);
	629	hid_hw_close(hdev);
	630	hid_hw_stop(hdev);
fabdbf2f BP	631
	632	/* Shortcut potential pending reply that will never arrive */
	633	spin_lock_irqsave(&data->lock, flags);
	634	if (data->pending)
	635	complete(&data->pending->ready);
	636	spin_unlock_irqrestore(&data->lock, flags);
	637
	638	/* Cleanup LED */
	639	picolcd_exit_leds(data);
	640	/* Clean up the framebuffer */
	641	picolcd_exit_backlight(data);
	642	picolcd_exit_lcd(data);
	643	picolcd_exit_framebuffer(data);
	644	/* Cleanup input */
	645	picolcd_exit_cir(data);
	646	picolcd_exit_keys(data);
	647
a5785cc0	648	hid_set_drvdata(hdev, NULL);
fabdbf2f BP	649	mutex_destroy(&data->mutex);
	650	/* Finally, clean up the picolcd data itself */
	651	kfree(data);
	652	}
	653
	654	static const struct hid_device_id picolcd_devices[] = {
	655	{ HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICOLCD) },
	656	{ HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICOLCD_BOOTLOADER) },
	657	{ }
	658	};
	659	MODULE_DEVICE_TABLE(hid, picolcd_devices);
	660
	661	static struct hid_driver picolcd_driver = {
	662	.name = "hid-picolcd",
	663	.id_table = picolcd_devices,
	664	.probe = picolcd_probe,
	665	.remove = picolcd_remove,
	666	.raw_event = picolcd_raw_event,
	667	#ifdef CONFIG_PM
	668	.suspend = picolcd_suspend,
	669	.resume = picolcd_resume,
	670	.reset_resume = picolcd_reset_resume,
	671	#endif
	672	};
f425458e	673	module_hid_driver(picolcd_driver);
fabdbf2f	674
fabdbf2f BP	675	MODULE_DESCRIPTION("Minibox graphics PicoLCD Driver");
fabdbf2f BP	676	MODULE_LICENSE("GPL v2");