1422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero/* 2422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * OpenCores Keyboard Controller Driver 3422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * http://www.opencores.org/project,keyboardcontroller 4422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * 5422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * Copyright 2007-2009 HV Sistemas S.L. 6422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * 7422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * Licensed under the GPL-2 or later. 8422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero */ 9422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 10422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/input.h> 11422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/interrupt.h> 12422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/io.h> 13422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/ioport.h> 14422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/kernel.h> 15422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/module.h> 16422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero#include <linux/platform_device.h> 175a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 18422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 19422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrerostruct opencores_kbd { 20422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct input_dev *input; 21422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero void __iomem *addr; 22422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero int irq; 23422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero unsigned short keycodes[128]; 24422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero}; 25422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 26422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrerostatic irqreturn_t opencores_kbd_isr(int irq, void *dev_id) 27422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero{ 28422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct opencores_kbd *opencores_kbd = dev_id; 29422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct input_dev *input = opencores_kbd->input; 30422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero unsigned char c; 31422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 32422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero c = readb(opencores_kbd->addr); 33422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input_report_key(input, c & 0x7f, c & 0x80 ? 0 : 1); 34422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input_sync(input); 35422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 36422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero return IRQ_HANDLED; 37422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero} 38422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 395298cc4cc753bbe4c530b41341834f6ef3344d0dBill Pembertonstatic int opencores_kbd_probe(struct platform_device *pdev) 40422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero{ 41422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct input_dev *input; 42422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct opencores_kbd *opencores_kbd; 43422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero struct resource *res; 44422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero int irq, i, error; 45422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 46422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 47422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero if (!res) { 48422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero dev_err(&pdev->dev, "missing board memory resource\n"); 49422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero return -EINVAL; 50422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 51422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 52422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero irq = platform_get_irq(pdev, 0); 53422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero if (irq < 0) { 54422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero dev_err(&pdev->dev, "missing board IRQ resource\n"); 55422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero return -EINVAL; 56422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 57422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 58848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav opencores_kbd = devm_kzalloc(&pdev->dev, sizeof(*opencores_kbd), 59848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav GFP_KERNEL); 60848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav if (!opencores_kbd) 61848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav return -ENOMEM; 62422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 63848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav input = devm_input_allocate_device(&pdev->dev); 64848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav if (!input) { 65848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav dev_err(&pdev->dev, "failed to allocate input device\n"); 66848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav return -ENOMEM; 67422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 68422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 69422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero opencores_kbd->input = input; 70848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav 71848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav opencores_kbd->addr = devm_ioremap_resource(&pdev->dev, res); 72848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav if (IS_ERR(opencores_kbd->addr)) 7342b63e603e69e1a27da80dda28b18f171aac49d1Dmitry Torokhov return PTR_ERR(opencores_kbd->addr); 74422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 75422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->name = pdev->name; 76422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->phys = "opencores-kbd/input0"; 77422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 78422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input_set_drvdata(input, opencores_kbd); 79422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 80422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->id.bustype = BUS_HOST; 81422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->id.vendor = 0x0001; 82422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->id.product = 0x0001; 83422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->id.version = 0x0100; 84422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 85422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->keycode = opencores_kbd->keycodes; 86422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->keycodesize = sizeof(opencores_kbd->keycodes[0]); 87422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero input->keycodemax = ARRAY_SIZE(opencores_kbd->keycodes); 88422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 89422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero __set_bit(EV_KEY, input->evbit); 90422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 91422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero for (i = 0; i < ARRAY_SIZE(opencores_kbd->keycodes); i++) { 92422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero /* 93422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * OpenCores controller happens to have scancodes match 94422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero * our KEY_* definitions. 95422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero */ 96422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero opencores_kbd->keycodes[i] = i; 97422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero __set_bit(opencores_kbd->keycodes[i], input->keybit); 98422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 99422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero __clear_bit(KEY_RESERVED, input->keybit); 100422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 101848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav error = devm_request_irq(&pdev->dev, irq, &opencores_kbd_isr, 102848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav IRQF_TRIGGER_RISING, 103848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav pdev->name, opencores_kbd); 104422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero if (error) { 105422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero dev_err(&pdev->dev, "unable to claim irq %d\n", irq); 106848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav return error; 107422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 108422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 109422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero error = input_register_device(input); 110422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero if (error) { 111422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero dev_err(&pdev->dev, "unable to register input device\n"); 112848d479361793edb79aa68140cb64d4ec9032d88Pramod Gurav return error; 113422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero } 114422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 115422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero platform_set_drvdata(pdev, opencores_kbd); 116422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 117422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero return 0; 118422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero} 119422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 120422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrerostatic struct platform_driver opencores_kbd_device_driver = { 121422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero .probe = opencores_kbd_probe, 122422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero .driver = { 123422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero .name = "opencores-kbd", 124422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero }, 125422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero}; 1265146c84f87c8aa3d115cea0d77ed3553df426752JJ Dingmodule_platform_driver(opencores_kbd_device_driver); 127422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier Herrero 128422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier HerreroMODULE_LICENSE("GPL"); 129422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier HerreroMODULE_AUTHOR("Javier Herrero <jherrero@hvsistemas.es>"); 130422b552debae59b4bebc0ea5fbb9c809d3dfd057Javier HerreroMODULE_DESCRIPTION("Keyboard driver for OpenCores Keyboard Controller"); 131