169 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			169 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the GNU General Public License version 2 as
 | |
|  * published by the Free Software Foundation.
 | |
|  *
 | |
|  * h3600 atmel micro companion support, key subdevice
 | |
|  * based on previous kernel 2.4 version
 | |
|  * Author : Alessandro Gardich <gremlin@gremlin.it>
 | |
|  * Author : Linus Walleij <linus.walleij@linaro.org>
 | |
|  *
 | |
|  */
 | |
| #include <linux/module.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/fs.h>
 | |
| #include <linux/interrupt.h>
 | |
| #include <linux/sched.h>
 | |
| #include <linux/pm.h>
 | |
| #include <linux/sysctl.h>
 | |
| #include <linux/proc_fs.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/device.h>
 | |
| #include <linux/input.h>
 | |
| #include <linux/platform_device.h>
 | |
| #include <linux/mfd/ipaq-micro.h>
 | |
| 
 | |
| struct ipaq_micro_keys {
 | |
| 	struct ipaq_micro *micro;
 | |
| 	struct input_dev *input;
 | |
| 	u16 *codes;
 | |
| };
 | |
| 
 | |
| static const u16 micro_keycodes[] = {
 | |
| 	KEY_RECORD,		/* 1:  Record button			*/
 | |
| 	KEY_CALENDAR,		/* 2:  Calendar				*/
 | |
| 	KEY_ADDRESSBOOK,	/* 3:  Contacts (looks like Outlook)	*/
 | |
| 	KEY_MAIL,		/* 4:  Envelope (Q on older iPAQs)	*/
 | |
| 	KEY_HOMEPAGE,		/* 5:  Start (looks like swoopy arrow)	*/
 | |
| 	KEY_UP,			/* 6:  Up				*/
 | |
| 	KEY_RIGHT,		/* 7:  Right				*/
 | |
| 	KEY_LEFT,		/* 8:  Left				*/
 | |
| 	KEY_DOWN,		/* 9:  Down				*/
 | |
| };
 | |
| 
 | |
| static void micro_key_receive(void *data, int len, unsigned char *msg)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys = data;
 | |
| 	int key, down;
 | |
| 
 | |
| 	down = 0x80 & msg[0];
 | |
| 	key  = 0x7f & msg[0];
 | |
| 
 | |
| 	if (key < ARRAY_SIZE(micro_keycodes)) {
 | |
| 		input_report_key(keys->input, keys->codes[key], down);
 | |
| 		input_sync(keys->input);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void micro_key_start(struct ipaq_micro_keys *keys)
 | |
| {
 | |
| 	spin_lock(&keys->micro->lock);
 | |
| 	keys->micro->key = micro_key_receive;
 | |
| 	keys->micro->key_data = keys;
 | |
| 	spin_unlock(&keys->micro->lock);
 | |
| }
 | |
| 
 | |
| static void micro_key_stop(struct ipaq_micro_keys *keys)
 | |
| {
 | |
| 	spin_lock(&keys->micro->lock);
 | |
| 	keys->micro->key = NULL;
 | |
| 	keys->micro->key_data = NULL;
 | |
| 	spin_unlock(&keys->micro->lock);
 | |
| }
 | |
| 
 | |
| static int micro_key_open(struct input_dev *input)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys = input_get_drvdata(input);
 | |
| 
 | |
| 	micro_key_start(keys);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void micro_key_close(struct input_dev *input)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys = input_get_drvdata(input);
 | |
| 
 | |
| 	micro_key_stop(keys);
 | |
| }
 | |
| 
 | |
| static int micro_key_probe(struct platform_device *pdev)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys;
 | |
| 	int error;
 | |
| 	int i;
 | |
| 
 | |
| 	keys = devm_kzalloc(&pdev->dev, sizeof(*keys), GFP_KERNEL);
 | |
| 	if (!keys)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	keys->micro = dev_get_drvdata(pdev->dev.parent);
 | |
| 
 | |
| 	keys->input = devm_input_allocate_device(&pdev->dev);
 | |
| 	if (!keys->input)
 | |
| 		return -ENOMEM;
 | |
| 
 | |
| 	keys->input->keycodesize = sizeof(micro_keycodes[0]);
 | |
| 	keys->input->keycodemax = ARRAY_SIZE(micro_keycodes);
 | |
| 	keys->codes = devm_kmemdup(&pdev->dev, micro_keycodes,
 | |
| 			   keys->input->keycodesize * keys->input->keycodemax,
 | |
| 			   GFP_KERNEL);
 | |
| 	keys->input->keycode = keys->codes;
 | |
| 
 | |
| 	__set_bit(EV_KEY, keys->input->evbit);
 | |
| 	for (i = 0; i < ARRAY_SIZE(micro_keycodes); i++)
 | |
| 		__set_bit(micro_keycodes[i], keys->input->keybit);
 | |
| 
 | |
| 	keys->input->name = "h3600 micro keys";
 | |
| 	keys->input->open = micro_key_open;
 | |
| 	keys->input->close = micro_key_close;
 | |
| 	input_set_drvdata(keys->input, keys);
 | |
| 
 | |
| 	error = input_register_device(keys->input);
 | |
| 	if (error)
 | |
| 		return error;
 | |
| 
 | |
| 	platform_set_drvdata(pdev, keys);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __maybe_unused micro_key_suspend(struct device *dev)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys = dev_get_drvdata(dev);
 | |
| 
 | |
| 	micro_key_stop(keys);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int __maybe_unused micro_key_resume(struct device *dev)
 | |
| {
 | |
| 	struct ipaq_micro_keys *keys = dev_get_drvdata(dev);
 | |
| 	struct input_dev *input = keys->input;
 | |
| 
 | |
| 	mutex_lock(&input->mutex);
 | |
| 
 | |
| 	if (input->users)
 | |
| 		micro_key_start(keys);
 | |
| 
 | |
| 	mutex_unlock(&input->mutex);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static SIMPLE_DEV_PM_OPS(micro_key_dev_pm_ops,
 | |
| 			 micro_key_suspend, micro_key_resume);
 | |
| 
 | |
| static struct platform_driver micro_key_device_driver = {
 | |
| 	.driver = {
 | |
| 		.name    = "ipaq-micro-keys",
 | |
| 		.pm	= µ_key_dev_pm_ops,
 | |
| 	},
 | |
| 	.probe   = micro_key_probe,
 | |
| };
 | |
| module_platform_driver(micro_key_device_driver);
 | |
| 
 | |
| MODULE_LICENSE("GPL");
 | |
| MODULE_DESCRIPTION("driver for iPAQ Atmel micro keys");
 | |
| MODULE_ALIAS("platform:ipaq-micro-keys");
 | 
