[mirror_ubuntu-artful-kernel.git] / drivers / input / keyboard / opencores-kbd.c

/*
 * OpenCores Keyboard Controller Driver
 * http://www.opencores.org/project,keyboardcontroller
 *
 * Copyright 2007-2009 HV Sistemas S.L.
 *
 * Licensed under the GPL-2 or later.
 */

#include <linux/input.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/slab.h>

struct opencores_kbd {
	struct input_dev *input;
	void __iomem *addr;
	int irq;
	unsigned short keycodes[128];
};

static irqreturn_t opencores_kbd_isr(int irq, void *dev_id)
{
	struct opencores_kbd *opencores_kbd = dev_id;
	struct input_dev *input = opencores_kbd->input;
	unsigned char c;

	c = readb(opencores_kbd->addr);
	input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1);
	input_sync(input);

	return IRQ_HANDLED;
}

static int opencores_kbd_probe(struct platform_device *pdev)
{
	struct input_dev *input;
	struct opencores_kbd *opencores_kbd;
	struct resource *res;
	int irq, i, error;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		dev_err(&pdev->dev, "missing board memory resource\n");
		return -EINVAL;
	}

	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
		dev_err(&pdev->dev, "missing board IRQ resource\n");
		return -EINVAL;
	}

	opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd),
				     GFP_KERNEL);
	if (!opencores_kbd)
		return -ENOMEM;

	input = devm_input_allocate_device(&pdev->dev);
	if (!input) {
		dev_err(&pdev->dev, "failed to allocate input device\n");
		return -ENOMEM;
	}

	opencores_kbd->input = input;

	opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(opencores_kbd->addr))
		return PTR_ERR(opencores_kbd->addr);

	input->name = pdev->name;
	input->phys = "opencores-kbd/input0";

	input_set_drvdata(input, opencores_kbd);

	input->id.bustype = BUS_HOST;
	input->id.vendor = 0x0001;
	input->id.product = 0x0001;
	input->id.version = 0x0100;

	input->keycode = opencores_kbd->keycodes;
	input->keycodesize = sizeof(opencores_kbd->keycodes[0]);
	input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes);

	__set_bit(EV_KEY, input->evbit);

	for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) {
		/*
		 * OpenCores controller happens to have scancodes match
		 * our KEY_* definitions.
		 */
		opencores_kbd->keycodes[i] = i;
		__set_bit(opencores_kbd->keycodes[i], input->keybit);
	}
	__clear_bit(KEY_RESERVED, input->keybit);

	error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr,
				 IRQF_TRIGGER_RISING,
				 pdev->name, opencores_kbd);
	if (error) {
		dev_err(&pdev->dev, "unable to claim irq %d\n", irq);
		return error;
	}

	error = input_register_device(input);
	if (error) {
		dev_err(&pdev->dev, "unable to register input device\n");
		return error;
	}

	platform_set_drvdata(pdev, opencores_kbd);

	return 0;
}

static struct platform_driver opencores_kbd_device_driver = {
	.probe    = opencores_kbd_probe,
	.driver   = {
		.name = "opencores-kbd",
	},
};
module_platform_driver(opencores_kbd_device_driver);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>");
MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller");
Commit	Line	Data
422b552d JH	1	/*
	2	* OpenCores Keyboard Controller Driver
	3	* http://www.opencores.org/project,keyboardcontroller
	4	*
	5	* Copyright 2007-2009 HV Sistemas S.L.
	6	*
	7	* Licensed under the GPL-2 or later.
	8	*/
	9
	10	#include <linux/input.h>
	11	#include <linux/interrupt.h>
	12	#include <linux/io.h>
	13	#include <linux/ioport.h>
	14	#include <linux/kernel.h>
	15	#include <linux/module.h>
	16	#include <linux/platform_device.h>
5a0e3ad6	17	#include <linux/slab.h>
422b552d JH	18
	19	struct opencores_kbd {
	20	struct input_dev *input;
422b552d JH	21	void __iomem *addr;
	22	int irq;
	23	unsigned short keycodes[128];
	24	};
	25
	26	static irqreturn_t opencores_kbd_isr(int irq, void *dev_id)
	27	{
	28	struct opencores_kbd *opencores_kbd = dev_id;
	29	struct input_dev *input = opencores_kbd->input;
	30	unsigned char c;
	31
	32	c = readb(opencores_kbd->addr);
	33	input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1);
	34	input_sync(input);
	35
	36	return IRQ_HANDLED;
	37	}
	38
5298cc4c	39	static int opencores_kbd_probe(struct platform_device *pdev)
422b552d JH	40	{
	41	struct input_dev *input;
	42	struct opencores_kbd *opencores_kbd;
	43	struct resource *res;
	44	int irq, i, error;
	45
	46	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	47	if (!res) {
	48	dev_err(&pdev->dev, "missing board memory resource\n");
	49	return -EINVAL;
	50	}
	51
	52	irq = platform_get_irq(pdev, 0);
	53	if (irq < 0) {
	54	dev_err(&pdev->dev, "missing board IRQ resource\n");
	55	return -EINVAL;
	56	}
	57
848d4793 PG	58	opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd),
	59	GFP_KERNEL);
	60	if (!opencores_kbd)
	61	return -ENOMEM;
422b552d	62
848d4793 PG	63	input = devm_input_allocate_device(&pdev->dev);
	64	if (!input) {
	65	dev_err(&pdev->dev, "failed to allocate input device\n");
	66	return -ENOMEM;
422b552d JH	67	}
	68
	69	opencores_kbd->input = input;
848d4793 PG	70
	71	opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res);
	72	if (IS_ERR(opencores_kbd->addr))
42b63e60	73	return PTR_ERR(opencores_kbd->addr);
422b552d JH	74
	75	input->name = pdev->name;
	76	input->phys = "opencores-kbd/input0";
422b552d JH	77
	78	input_set_drvdata(input, opencores_kbd);
	79
	80	input->id.bustype = BUS_HOST;
	81	input->id.vendor = 0x0001;
	82	input->id.product = 0x0001;
	83	input->id.version = 0x0100;
	84
	85	input->keycode = opencores_kbd->keycodes;
	86	input->keycodesize = sizeof(opencores_kbd->keycodes[0]);
	87	input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes);
	88
	89	__set_bit(EV_KEY, input->evbit);
	90
	91	for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) {
	92	/*
	93	* OpenCores controller happens to have scancodes match
	94	* our KEY_* definitions.
	95	*/
	96	opencores_kbd->keycodes[i] = i;
	97	__set_bit(opencores_kbd->keycodes[i], input->keybit);
	98	}
	99	__clear_bit(KEY_RESERVED, input->keybit);
	100
848d4793 PG	101	error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr,
	102	IRQF_TRIGGER_RISING,
	103	pdev->name, opencores_kbd);
422b552d JH	104	if (error) {
422b552d JH	105	dev_err(&pdev->dev, "unable to claim irq %d\n", irq);
848d4793	106	return error;
422b552d JH	107	}
	108
	109	error = input_register_device(input);
	110	if (error) {
	111	dev_err(&pdev->dev, "unable to register input device\n");
848d4793	112	return error;
422b552d JH	113	}
	114
	115	platform_set_drvdata(pdev, opencores_kbd);
	116
422b552d JH	117	return 0;
	118	}
	119
	120	static struct platform_driver opencores_kbd_device_driver = {
	121	.probe = opencores_kbd_probe,
422b552d JH	122	.driver = {
	123	.name = "opencores-kbd",
	124	},
	125	};
5146c84f	126	module_platform_driver(opencores_kbd_device_driver);
422b552d JH	127
	128	MODULE_LICENSE("GPL");
	129	MODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>");
	130	MODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller");