diff -urN linux-4.0.1/drivers/input/misc/a3g_button.c linux-4.0.1-wd1/drivers/input/misc/a3g_button.c --- linux-4.0.1/drivers/input/misc/a3g_button.c 1970-01-01 03:00:00.000000000 +0300 +++ linux-4.0.1-wd1/drivers/input/misc/a3g_button.c 2015-03-29 21:02:00.000000000 +0300 @@ -0,0 +1,643 @@ +/* + * Button driver to support Apollo 3G board + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include + + +extern void __iomem *led_port; + +#define DRV_NAME "a3g-button" + +#define EV_PRESSED 1 +#define EV_RELEASED 0 +#define RESET_BTN 0 /* reset button */ + +#define _3G_BTN_BIT 0x04 +#define POL_RATE_MSECS 200 +#define MAX_EV_LEN (sizeof(struct input_event)) + +int btn_ev_flag = 0; +struct task_struct * btn_threadptr; + +struct input_event btn_event; + +static struct resource a3g_res = { + .name = "cs2", + .start = 0x4e0100000ULL, + .end = 0x4e0100300ULL, + /*.flags = IORESOURCE_IO,*/ + .flags = IORESOURCE_MEM, + }; + + +static void __iomem *button_port = NULL; + + +struct btndev_hw_data { + int abs_event; + unsigned long buttons; +}; + +struct btndev { + int exist; + int open; + int minor; + struct input_handle handle; + wait_queue_head_t wait; + struct list_head client_list; + spinlock_t client_lock; /* protects client_list */ + struct mutex mutex; + struct device dev; + + struct list_head mixdev_node; + int mixdev_open; + + struct btndev_hw_data packet; + unsigned int pkt_count; +}; + +struct btndev * btndev_ptr; + +#define BTNDEV_MINOR_BASE 31 +#define BTNDEV_MINORS 31 +#define BTNDEV_ZERO 0 + + +struct btndev_motion { + unsigned long buttons; +}; + +#define PACKET_QUEUE_LEN 16 +struct btndev_client { + struct fasync_struct *fasync; + struct btndev *btndev; + struct list_head node; + + struct btndev_motion packets[PACKET_QUEUE_LEN]; + unsigned int head, tail; + spinlock_t packet_lock; + + signed char ps2[6]; + unsigned char ready, buffer, bufsiz; + unsigned char imexseq, impsseq; + unsigned long last_buttons; +}; + + + +struct btndev *btndev_table[BTNDEV_MINORS]; +static DEFINE_MUTEX(btndev_table_mutex); + +static const struct input_device_id btndev_ids[] = { + { + .flags = INPUT_DEVICE_ID_MATCH_EVBIT | + INPUT_DEVICE_ID_MATCH_KEYBIT | + INPUT_DEVICE_ID_MATCH_RELBIT, + .evbit = { BIT_MASK(EV_KEY) | BIT_MASK(EV_REL) }, + }, + {}, +}; + +MODULE_DEVICE_TABLE(input, btndev_ids); +static void btndev_remove_chrdev(struct btndev *btndev) { + mutex_lock(&btndev_table_mutex); + btndev_table[btndev->minor] = NULL; + mutex_unlock(&btndev_table_mutex); +} + + +/*********************************************************/ +static void btndev_mark_dead(struct btndev *btndev) { + mutex_lock(&btndev->mutex); + btndev->exist = 0; + mutex_unlock(&btndev->mutex); +} + +/*********************************************************/ +static void btndev_cleanup(struct btndev *btndev) +{ + struct input_handle *handle = &btndev->handle; + + btndev_mark_dead(btndev); + btndev_remove_chrdev(btndev); + + if (btndev->open) + input_close_device(handle); +} + +/**********************************************************/ +static void btndev_free(struct device * dev) { + struct btndev * btndevptr = container_of( dev, struct btndev, dev); + input_put_device( btndevptr->handle.dev); + kfree(btndevptr); +} +/**********************************************************/ +static int btndev_install_chrdev(struct btndev *btndev) { + btndev_table[btndev->minor] = btndev; + return 0; +} + +/**********************************************************/ +static struct btndev *btndev_create(struct input_dev *dev, + struct input_handler *handler, + int minor) +{ + struct btndev *btndev; + int error; + btndev = kzalloc(sizeof(struct btndev), GFP_KERNEL); + if (!btndev) { + error = -ENOMEM; + goto err_out; + } + + + INIT_LIST_HEAD(&btndev->client_list); + INIT_LIST_HEAD(&btndev->mixdev_node); + spin_lock_init(&btndev->client_lock); + mutex_init(&btndev->mutex); + lockdep_set_subclass(&btndev->mutex, 0); + init_waitqueue_head(&btndev->wait); + + dev_set_name(&btndev->dev, "event%d", minor); + + btndev->minor = minor; + btndev->exist = 1; + btndev->handle.dev = input_get_device(dev); + btndev->handle.name = dev_name(&btndev->dev); + btndev->handle.handler = handler; + btndev->handle.private = btndev; + + btndev->dev.class = &input_class; + if (dev) + btndev->dev.parent = &dev->dev; + btndev->dev.devt = MKDEV(INPUT_MAJOR, BTNDEV_MINOR_BASE + minor); + btndev->dev.release = btndev_free; + device_initialize(&btndev->dev); + + error = input_register_handle(&(btndev->handle)); + if (error) { + goto err_free_btndev; + } + + error = btndev_install_chrdev(btndev); + if (error) + goto err_unregister_handle; + + error = device_add(&btndev->dev); + if (error) + goto err_cleanup_btndev; + + return btndev; + + err_cleanup_btndev: + btndev_cleanup(btndev); + err_unregister_handle: + input_unregister_handle(&btndev->handle); + err_free_btndev: + put_device(&btndev->dev); + err_out: + return ERR_PTR(error); + +} + + +/**********************************************************/ +static void btndev_destroy(struct btndev *btndev) { + device_del(&btndev->dev); + btndev_cleanup(btndev); + input_unregister_handle(&btndev->handle); + put_device(&btndev->dev); +} + + +/**********************************************************/ +static void btndev_event(struct input_handle *handle, + unsigned int type, unsigned int code, int value) { + switch( type ) { + + case EV_KEY: + break; + case EV_REL: + break; + default: + break; + } +} + + +static int btndev_open_device(struct btndev *btndev) { + int retval; + + retval = mutex_lock_interruptible(&btndev->mutex); + if (retval) + return retval; + + if (!btndev->exist) + retval = -ENODEV; + else if (!btndev->open++) { + retval = input_open_device(&btndev->handle); + if (retval) + btndev->open--; + } + + mutex_unlock(&btndev->mutex); + return retval; +} + + +/**********************************************************/ +static void btndev_attach_client(struct btndev *btndev, struct btndev_client *client) { + spin_lock(&btndev->client_lock); + list_add_tail_rcu(&client->node, &btndev->client_list); + spin_unlock(&btndev->client_lock); + synchronize_rcu(); +} + +/**********************************************************/ +static void btndev_detach_client(struct btndev *btndev, + struct btndev_client *client) +{ + spin_lock(&btndev->client_lock); + list_del_rcu(&client->node); + spin_unlock(&btndev->client_lock); + synchronize_rcu(); +} + +static int btndev_release(struct inode *inode, struct file *file) { + return 0; +} + +/**********************************************************/ +static int btndev_open(struct inode *inode, struct file *file) +{ + struct btndev_client *client; + struct btndev *btndev; + int error; + int i; + + i = iminor(inode) - BTNDEV_MINOR_BASE; + + if (i >= BTNDEV_MINORS) { + printk(KERN_ERR "*** error btndev_open()\n"); + return -ENODEV; + } + + error = mutex_lock_interruptible(&btndev_table_mutex); + if (error) { + return error; + } + btndev = btndev_table[i]; + if (btndev) + get_device(&btndev->dev); + mutex_unlock(&btndev_table_mutex); + + if (!btndev) { + return -ENODEV; + } + + client = kzalloc(sizeof(struct btndev_client), GFP_KERNEL); + if (!client) { + error = -ENOMEM; + goto err_put_btndev; + } + + spin_lock_init(&client->packet_lock); + client->btndev = btndev; + btndev_attach_client(btndev, client); + + error = btndev_open_device(btndev); + if (error) + goto err_free_client; + + file->private_data = client; + return 0; + + err_free_client: + btndev_detach_client(btndev, client); + kfree(client); + err_put_btndev: + put_device(&btndev->dev); + return error; +} + +static ssize_t btndev_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos) { + return 0; +} + +static int btndev_fasync(int fd, struct file *file, int on) { + struct btndev_client *client = file->private_data; + + return fasync_helper(fd, file, on, &client->fasync); +} + +static ssize_t btndev_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos) { + struct btndev_client *client = file->private_data; + struct btndev *btndev = client->btndev; + signed char data[MAX_EV_LEN]; + int retval = 0; +/* + if (!client->ready && !client->buffer && btndev->exist && + (file->f_flags & O_NONBLOCK) && !btn_ev_flag) { +*/ + if (file->f_flags & O_NONBLOCK) { + /* + * This read is from VFT, copy data to user buffer anyway. + * + */ + spin_lock_irq(&client->packet_lock); + if (count > MAX_EV_LEN) + count = MAX_EV_LEN; + memcpy(data, (char*)&btn_event, count); + /* client->buffer -= count; */ + spin_unlock_irq(&client->packet_lock); + if (copy_to_user(buffer, data, count)) + return -EFAULT; + + return -EAGAIN; + } + retval = wait_event_interruptible(btndev->wait, + !btndev->exist || + client->ready || + btn_ev_flag ); + if( btn_ev_flag ) { + btn_ev_flag = 0; + } + if (retval) + return retval; + if (!btndev->exist) + return -ENODEV; + spin_lock_irq(&client->packet_lock); + if (count > MAX_EV_LEN) + count = MAX_EV_LEN; + memcpy(data, (char*)&btn_event, count); + client->buffer -= count; + spin_unlock_irq(&client->packet_lock); + if (copy_to_user(buffer, data, count)) + return -EFAULT; + + return MAX_EV_LEN; +} + + +static unsigned int btndev_poll(struct file *file, poll_table *wait) { + + return 0; +} + + + +static int btndev_connect( struct input_handler *handler, + struct input_dev *dev, + const struct input_device_id *id){ + + return 0; + } + + +static void btndev_disconnect(struct input_handle *handle) { + +} + + +static const struct file_operations btndev_fops = { + .owner = THIS_MODULE, + .read = btndev_read, + .write = btndev_write, + .poll = btndev_poll, + .open = btndev_open, + .release = btndev_release, + .fasync = btndev_fasync, +}; + + +static struct input_handler btndev_handler = { + .event = btndev_event, + .connect = btndev_connect, + .disconnect = btndev_disconnect, + .fops = &btndev_fops, + .minor = BTNDEV_MINOR_BASE, + .name = "btndev", + .id_table = btndev_ids, +}; + + + + + + +/**************************************************/ +u8 enable_cs2( void ){ + u8 val, reg; + + reg = readb(led_port); + val = (reg | 0x02); + writeb(val, led_port); + return reg; +} + +/**************************************************/ +void disable_cs2( u8 val ){ + val &= ~0x02; + writeb(val, led_port); +} + +/**************************************************/ +static int is_button_pressed(void) { + u8 saved, val = EV_REL; + + if( led_port ) { + saved = enable_cs2(); + val = readb(button_port); + disable_cs2( saved ); + } + return ((val & _3G_BTN_BIT) == _3G_BTN_BIT) ? EV_REL : EV_KEY ; +} + + +/**************************************************/ + +static struct input_dev * input_dev; + +static int button_dev_init(struct platform_device *parent_pdev) +{ + int error; + + + input_dev = input_allocate_device(); + if( !input_dev ) { + printk(KERN_ERR "*** a3g-button: unable to allocate input_dev\n"); + return -ENOMEM; + } + + input_dev->name = "rst_button"; + input_dev->phys = "a3g/input0"; + input_dev->id.bustype = BUS_HOST; + input_set_capability( input_dev, EV_MSC, MSC_SCAN); + __set_bit( EV_KEY, input_dev->evbit); + __set_bit( EV_REL, input_dev->relbit); + error = input_register_device(input_dev); + + if( error ) { + input_free_device( input_dev ); + printk(KERN_ERR "*** a3g-button: error input_register_device()\n"); + return error; + } + + error = input_register_handler( &btndev_handler); + if( error ) { + printk(KERN_ERR "*** a3g-button: error input_register_handler()\n"); + input_free_device( input_dev ); + /*btndev_destroy(btndev_ptr);*/ + return error; + } + + btndev_ptr = btndev_create( input_dev , &btndev_handler, BTNDEV_ZERO); + if( IS_ERR(btndev_ptr) ) { + input_free_device( input_dev ); + printk(KERN_ERR "*** a3g-button: error btndev_create()\n"); + return PTR_ERR( btndev_ptr ); + } + + return 0; +} + + + +static int btn_thread( void * data ) { + + struct task_struct * tsk = current; + struct sched_param param = { .sched_priority = 1}; + int btn_last_state, btn_cur_state; + btn_cur_state = btn_last_state = EV_REL; + + + sched_setscheduler(tsk, SCHED_FIFO, ¶m); + set_freezable(); + + if( button_port ) { + btn_last_state = is_button_pressed(); + } + while( !kthread_should_stop() ) { + + if( button_port ) { + msleep(POL_RATE_MSECS); + if( button_port ) { + btn_cur_state = is_button_pressed(); + } + if( btn_last_state != btn_cur_state ){ +/* + printk( KERN_INFO "state changed from %d to %d\n", + btn_last_state, btn_cur_state); +*/ + btn_last_state = btn_cur_state; + do_gettimeofday(&btn_event.time); + btn_event.type = RESET_BTN; + btn_event.code = btn_cur_state; + btn_event.value = btn_cur_state; + btn_ev_flag = 1; /* wake up event read */ + if( btndev_ptr ) { + wake_up_interruptible(&(btndev_ptr->wait)); + } + + } + } + } + + return 0; +} + + +/**************************************************/ +static int __init a3g_button_init(void) { + + resource_size_t res_size; + struct resource *phys_res = &a3g_res; + int retval; + + res_size = resource_size(phys_res); + + if( !request_mem_region(phys_res->start, res_size, phys_res->name) ) { + printk(KERN_DEBUG "**** error request_mem_region()\n"); + return -1; + } + + button_port = ioremap(phys_res->start, res_size); + if (button_port == NULL) { + release_mem_region(phys_res->start, res_size); + printk(KERN_DEBUG "*** Error ioremap()"); + return -1; + } + + + retval = button_dev_init(NULL); + if( retval != 0 ) { + printk( KERN_ERR "*** failed button_dev_init() %d\n", retval); + iounmap(button_port); + button_port = NULL; + release_mem_region(a3g_res.start, (a3g_res.end - a3g_res.start + 1)); + return -1; + } + + btn_threadptr = kthread_run( btn_thread, NULL, "btn_t"); + + retval = (btn_threadptr == NULL) ? -1 : 0; + + return retval; + + /* return platform_driver_register( &a3g_button_driver ); */ +} + +/**************************************************/ +static void __exit a3g_button_exit(void) { + /*platform_driver_unregister( &a3g_button_driver);*/ + if( button_port ) { + iounmap(button_port); + button_port = NULL; + release_mem_region(a3g_res.start, (a3g_res.end - a3g_res.start + 1)); + } + + btndev_destroy( btndev_ptr ); + if( btn_threadptr ) { + kthread_stop(btn_threadptr); + btn_threadptr = NULL; + } + + input_unregister_handler( &btndev_handler); + input_unregister_device(input_dev); +} + +module_init( a3g_button_init ); +module_exit( a3g_button_exit ); + +MODULE_AUTHOR("Hai Le"); +MODULE_LICENSE("GPL"); +MODULE_DESCRIPTION("Support for reset button on Apollo3G board"); +MODULE_ALIAS("platform:" DRV_NAME); diff -urN linux-4.0.1/drivers/input/misc/Makefile linux-4.0.1-wd1/drivers/input/misc/Makefile --- linux-4.0.1/drivers/input/misc/Makefile 2015-04-29 11:22:30.000000000 +0300 +++ linux-4.0.1-wd1/drivers/input/misc/Makefile 2015-05-02 17:04:04.399816995 +0300 @@ -72,3 +72,4 @@ obj-$(CONFIG_INPUT_XEN_KBDDEV_FRONTEND) += xen-kbdfront.o obj-$(CONFIG_INPUT_YEALINK) += yealink.o obj-$(CONFIG_INPUT_IDEAPAD_SLIDEBAR) += ideapad_slidebar.o +obj-y += a3g_button.o