Input: aaed2000_kbd - convert to use polldev library
Signed-off-by: Dmitry Torokhov <dtor@mail.ru>
This commit is contained in:
parent
e37a97d440
commit
3f07d87962
|
@ -215,6 +215,7 @@ config KEYBOARD_PXA27x
|
||||||
config KEYBOARD_AAED2000
|
config KEYBOARD_AAED2000
|
||||||
tristate "AAED-2000 keyboard"
|
tristate "AAED-2000 keyboard"
|
||||||
depends on MACH_AAED2000
|
depends on MACH_AAED2000
|
||||||
|
select INPUT_POLLDEV
|
||||||
default y
|
default y
|
||||||
help
|
help
|
||||||
Say Y here to enable the keyboard on the Agilent AAED-2000
|
Say Y here to enable the keyboard on the Agilent AAED-2000
|
||||||
|
|
|
@ -14,12 +14,11 @@
|
||||||
#include <linux/delay.h>
|
#include <linux/delay.h>
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
#include <linux/input.h>
|
#include <linux/input-polldev.h>
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/jiffies.h>
|
#include <linux/jiffies.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
#include <linux/slab.h>
|
#include <linux/slab.h>
|
||||||
#include <linux/workqueue.h>
|
|
||||||
|
|
||||||
#include <asm/arch/hardware.h>
|
#include <asm/arch/hardware.h>
|
||||||
#include <asm/arch/aaed2000.h>
|
#include <asm/arch/aaed2000.h>
|
||||||
|
@ -46,8 +45,7 @@ static unsigned char aaedkbd_keycode[NR_SCANCODES] = {
|
||||||
|
|
||||||
struct aaedkbd {
|
struct aaedkbd {
|
||||||
unsigned char keycode[ARRAY_SIZE(aaedkbd_keycode)];
|
unsigned char keycode[ARRAY_SIZE(aaedkbd_keycode)];
|
||||||
struct input_dev *input;
|
struct input_polled_dev *poll_dev;
|
||||||
struct work_struct workq;
|
|
||||||
int kbdscan_state[KB_COLS];
|
int kbdscan_state[KB_COLS];
|
||||||
int kbdscan_count[KB_COLS];
|
int kbdscan_count[KB_COLS];
|
||||||
};
|
};
|
||||||
|
@ -64,14 +62,15 @@ static void aaedkbd_report_col(struct aaedkbd *aaedkbd,
|
||||||
scancode = SCANCODE(row, col);
|
scancode = SCANCODE(row, col);
|
||||||
pressed = rowd & KB_ROWMASK(row);
|
pressed = rowd & KB_ROWMASK(row);
|
||||||
|
|
||||||
input_report_key(aaedkbd->input, aaedkbd->keycode[scancode], pressed);
|
input_report_key(aaedkbd->poll_dev->input,
|
||||||
|
aaedkbd->keycode[scancode], pressed);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Scan the hardware keyboard and push any changes up through the input layer */
|
/* Scan the hardware keyboard and push any changes up through the input layer */
|
||||||
static void aaedkbd_work(void *data)
|
static void aaedkbd_poll(struct input_polled_dev *dev)
|
||||||
{
|
{
|
||||||
struct aaedkbd *aaedkbd = data;
|
struct aaedkbd *aaedkbd = dev->private;
|
||||||
unsigned int col, rowd;
|
unsigned int col, rowd;
|
||||||
|
|
||||||
col = 0;
|
col = 0;
|
||||||
|
@ -90,51 +89,34 @@ static void aaedkbd_work(void *data)
|
||||||
} while (col < KB_COLS);
|
} while (col < KB_COLS);
|
||||||
|
|
||||||
AAEC_GPIO_KSCAN = 0x07;
|
AAEC_GPIO_KSCAN = 0x07;
|
||||||
input_sync(aaedkbd->input);
|
input_sync(dev->input);
|
||||||
|
|
||||||
schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL));
|
|
||||||
}
|
|
||||||
|
|
||||||
static int aaedkbd_open(struct input_dev *indev)
|
|
||||||
{
|
|
||||||
struct aaedkbd *aaedkbd = input_get_drvdata(indev);
|
|
||||||
|
|
||||||
schedule_delayed_work(&aaedkbd->workq, msecs_to_jiffies(SCAN_INTERVAL));
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void aaedkbd_close(struct input_dev *indev)
|
|
||||||
{
|
|
||||||
struct aaedkbd *aaedkbd = input_get_drvdata(indev);
|
|
||||||
|
|
||||||
cancel_delayed_work(&aaedkbd->workq);
|
|
||||||
flush_scheduled_work();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int __devinit aaedkbd_probe(struct platform_device *pdev)
|
static int __devinit aaedkbd_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct aaedkbd *aaedkbd;
|
struct aaedkbd *aaedkbd;
|
||||||
|
struct input_polled_dev *poll_dev;
|
||||||
struct input_dev *input_dev;
|
struct input_dev *input_dev;
|
||||||
int i;
|
int i;
|
||||||
int error;
|
int error;
|
||||||
|
|
||||||
aaedkbd = kzalloc(sizeof(struct aaedkbd), GFP_KERNEL);
|
aaedkbd = kzalloc(sizeof(struct aaedkbd), GFP_KERNEL);
|
||||||
input_dev = input_allocate_device();
|
poll_dev = input_allocate_polled_device();
|
||||||
if (!aaedkbd || !input_dev) {
|
if (!aaedkbd || !poll_dev) {
|
||||||
error = -ENOMEM;
|
error = -ENOMEM;
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
}
|
||||||
|
|
||||||
platform_set_drvdata(pdev, aaedkbd);
|
platform_set_drvdata(pdev, aaedkbd);
|
||||||
|
|
||||||
aaedkbd->input = input_dev;
|
aaedkbd->poll_dev = poll_dev;
|
||||||
|
|
||||||
/* Init keyboard rescan workqueue */
|
|
||||||
INIT_WORK(&aaedkbd->workq, aaedkbd_work, aaedkbd);
|
|
||||||
|
|
||||||
memcpy(aaedkbd->keycode, aaedkbd_keycode, sizeof(aaedkbd->keycode));
|
memcpy(aaedkbd->keycode, aaedkbd_keycode, sizeof(aaedkbd->keycode));
|
||||||
|
|
||||||
|
poll_dev->private = aaedkbd;
|
||||||
|
poll_dev->poll = aaedkbd_poll;
|
||||||
|
poll_dev->poll_interval = SCAN_INTERVAL;
|
||||||
|
|
||||||
|
input_dev = poll_dev->input;
|
||||||
input_dev->name = "AAED-2000 Keyboard";
|
input_dev->name = "AAED-2000 Keyboard";
|
||||||
input_dev->phys = "aaedkbd/input0";
|
input_dev->phys = "aaedkbd/input0";
|
||||||
input_dev->id.bustype = BUS_HOST;
|
input_dev->id.bustype = BUS_HOST;
|
||||||
|
@ -143,8 +125,6 @@ static int __devinit aaedkbd_probe(struct platform_device *pdev)
|
||||||
input_dev->id.version = 0x0100;
|
input_dev->id.version = 0x0100;
|
||||||
input_dev->dev.parent = &pdev->dev;
|
input_dev->dev.parent = &pdev->dev;
|
||||||
|
|
||||||
input_set_drvdata(input_dev, aaedkbd);
|
|
||||||
|
|
||||||
input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
|
input_dev->evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
|
||||||
input_dev->keycode = aaedkbd->keycode;
|
input_dev->keycode = aaedkbd->keycode;
|
||||||
input_dev->keycodesize = sizeof(unsigned char);
|
input_dev->keycodesize = sizeof(unsigned char);
|
||||||
|
@ -154,17 +134,14 @@ static int __devinit aaedkbd_probe(struct platform_device *pdev)
|
||||||
set_bit(aaedkbd->keycode[i], input_dev->keybit);
|
set_bit(aaedkbd->keycode[i], input_dev->keybit);
|
||||||
clear_bit(0, input_dev->keybit);
|
clear_bit(0, input_dev->keybit);
|
||||||
|
|
||||||
input_dev->open = aaedkbd_open;
|
error = input_register_polled_device(aaedkbd->poll_dev);
|
||||||
input_dev->close = aaedkbd_close;
|
|
||||||
|
|
||||||
error = input_register_device(aaedkbd->input);
|
|
||||||
if (error)
|
if (error)
|
||||||
goto fail;
|
goto fail;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
fail: kfree(aaedkbd);
|
fail: kfree(aaedkbd);
|
||||||
input_free_device(input_dev);
|
input_free_polled_device(poll_dev);
|
||||||
return error;
|
return error;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -172,7 +149,8 @@ static int __devexit aaedkbd_remove(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct aaedkbd *aaedkbd = platform_get_drvdata(pdev);
|
struct aaedkbd *aaedkbd = platform_get_drvdata(pdev);
|
||||||
|
|
||||||
input_unregister_device(aaedkbd->input);
|
input_unregister_polled_device(aaedkbd->poll_dev);
|
||||||
|
input_free_polled_device(aaedkbd->poll_dev);
|
||||||
kfree(aaedkbd);
|
kfree(aaedkbd);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
Loading…
Reference in New Issue