1d9bdffd2SPhil Sutter /* 2d9bdffd2SPhil Sutter * Support for the S1 button on Routerboard 532 3d9bdffd2SPhil Sutter * 4d9bdffd2SPhil Sutter * Copyright (C) 2009 Phil Sutter <n0-1@freewrt.org> 5d9bdffd2SPhil Sutter */ 6d9bdffd2SPhil Sutter 7d9bdffd2SPhil Sutter #include <linux/input-polldev.h> 8d9bdffd2SPhil Sutter #include <linux/module.h> 9d9bdffd2SPhil Sutter #include <linux/platform_device.h> 10d9bdffd2SPhil Sutter 11d9bdffd2SPhil Sutter #include <asm/mach-rc32434/gpio.h> 12d9bdffd2SPhil Sutter #include <asm/mach-rc32434/rb.h> 13d9bdffd2SPhil Sutter 14d9bdffd2SPhil Sutter #define DRV_NAME "rb532-button" 15d9bdffd2SPhil Sutter 16d9bdffd2SPhil Sutter #define RB532_BTN_RATE 100 /* msec */ 17d9bdffd2SPhil Sutter #define RB532_BTN_KSYM BTN_0 18d9bdffd2SPhil Sutter 19d9bdffd2SPhil Sutter /* The S1 button state is provided by GPIO pin 1. But as this 20d9bdffd2SPhil Sutter * pin is also used for uart input as alternate function, the 21d9bdffd2SPhil Sutter * operational modes must be switched first: 22d9bdffd2SPhil Sutter * 1) disable uart using set_latch_u5() 23d9bdffd2SPhil Sutter * 2) turn off alternate function implicitly through 24d9bdffd2SPhil Sutter * gpio_direction_input() 25d9bdffd2SPhil Sutter * 3) read the GPIO's current value 26d9bdffd2SPhil Sutter * 4) undo step 2 by enabling alternate function (in this 27d9bdffd2SPhil Sutter * mode the GPIO direction is fixed, so no change needed) 28d9bdffd2SPhil Sutter * 5) turn on uart again 29d9bdffd2SPhil Sutter * The GPIO value occurs to be inverted, so pin high means 30d9bdffd2SPhil Sutter * button is not pressed. 31d9bdffd2SPhil Sutter */ 32d9bdffd2SPhil Sutter static bool rb532_button_pressed(void) 33d9bdffd2SPhil Sutter { 34d9bdffd2SPhil Sutter int val; 35d9bdffd2SPhil Sutter 36d9bdffd2SPhil Sutter set_latch_u5(0, LO_FOFF); 37d9bdffd2SPhil Sutter gpio_direction_input(GPIO_BTN_S1); 38d9bdffd2SPhil Sutter 39d9bdffd2SPhil Sutter val = gpio_get_value(GPIO_BTN_S1); 40d9bdffd2SPhil Sutter 41d9bdffd2SPhil Sutter rb532_gpio_set_func(GPIO_BTN_S1); 42d9bdffd2SPhil Sutter set_latch_u5(LO_FOFF, 0); 43d9bdffd2SPhil Sutter 44d9bdffd2SPhil Sutter return !val; 45d9bdffd2SPhil Sutter } 46d9bdffd2SPhil Sutter 47d9bdffd2SPhil Sutter static void rb532_button_poll(struct input_polled_dev *poll_dev) 48d9bdffd2SPhil Sutter { 49d9bdffd2SPhil Sutter input_report_key(poll_dev->input, RB532_BTN_KSYM, 50d9bdffd2SPhil Sutter rb532_button_pressed()); 51d9bdffd2SPhil Sutter input_sync(poll_dev->input); 52d9bdffd2SPhil Sutter } 53d9bdffd2SPhil Sutter 54d9bdffd2SPhil Sutter static int __devinit rb532_button_probe(struct platform_device *pdev) 55d9bdffd2SPhil Sutter { 56d9bdffd2SPhil Sutter struct input_polled_dev *poll_dev; 57d9bdffd2SPhil Sutter int error; 58d9bdffd2SPhil Sutter 59d9bdffd2SPhil Sutter poll_dev = input_allocate_polled_device(); 60d9bdffd2SPhil Sutter if (!poll_dev) 61d9bdffd2SPhil Sutter return -ENOMEM; 62d9bdffd2SPhil Sutter 63d9bdffd2SPhil Sutter poll_dev->poll = rb532_button_poll; 64d9bdffd2SPhil Sutter poll_dev->poll_interval = RB532_BTN_RATE; 65d9bdffd2SPhil Sutter 66d9bdffd2SPhil Sutter poll_dev->input->name = "rb532 button"; 67d9bdffd2SPhil Sutter poll_dev->input->phys = "rb532/button0"; 68d9bdffd2SPhil Sutter poll_dev->input->id.bustype = BUS_HOST; 69d9bdffd2SPhil Sutter poll_dev->input->dev.parent = &pdev->dev; 70d9bdffd2SPhil Sutter 71d9bdffd2SPhil Sutter dev_set_drvdata(&pdev->dev, poll_dev); 72d9bdffd2SPhil Sutter 73d9bdffd2SPhil Sutter input_set_capability(poll_dev->input, EV_KEY, RB532_BTN_KSYM); 74d9bdffd2SPhil Sutter 75d9bdffd2SPhil Sutter error = input_register_polled_device(poll_dev); 76d9bdffd2SPhil Sutter if (error) { 77d9bdffd2SPhil Sutter input_free_polled_device(poll_dev); 78d9bdffd2SPhil Sutter return error; 79d9bdffd2SPhil Sutter } 80d9bdffd2SPhil Sutter 81d9bdffd2SPhil Sutter return 0; 82d9bdffd2SPhil Sutter } 83d9bdffd2SPhil Sutter 84d9bdffd2SPhil Sutter static int __devexit rb532_button_remove(struct platform_device *pdev) 85d9bdffd2SPhil Sutter { 86d9bdffd2SPhil Sutter struct input_polled_dev *poll_dev = dev_get_drvdata(&pdev->dev); 87d9bdffd2SPhil Sutter 88d9bdffd2SPhil Sutter input_unregister_polled_device(poll_dev); 89d9bdffd2SPhil Sutter input_free_polled_device(poll_dev); 90d9bdffd2SPhil Sutter dev_set_drvdata(&pdev->dev, NULL); 91d9bdffd2SPhil Sutter 92d9bdffd2SPhil Sutter return 0; 93d9bdffd2SPhil Sutter } 94d9bdffd2SPhil Sutter 95d9bdffd2SPhil Sutter static struct platform_driver rb532_button_driver = { 96d9bdffd2SPhil Sutter .probe = rb532_button_probe, 97d9bdffd2SPhil Sutter .remove = __devexit_p(rb532_button_remove), 98d9bdffd2SPhil Sutter .driver = { 99d9bdffd2SPhil Sutter .name = DRV_NAME, 100d9bdffd2SPhil Sutter .owner = THIS_MODULE, 101d9bdffd2SPhil Sutter }, 102d9bdffd2SPhil Sutter }; 103d9bdffd2SPhil Sutter 104d9bdffd2SPhil Sutter static int __init rb532_button_init(void) 105d9bdffd2SPhil Sutter { 106d9bdffd2SPhil Sutter return platform_driver_register(&rb532_button_driver); 107d9bdffd2SPhil Sutter } 108d9bdffd2SPhil Sutter 109d9bdffd2SPhil Sutter static void __exit rb532_button_exit(void) 110d9bdffd2SPhil Sutter { 111d9bdffd2SPhil Sutter platform_driver_unregister(&rb532_button_driver); 112d9bdffd2SPhil Sutter } 113d9bdffd2SPhil Sutter 114d9bdffd2SPhil Sutter module_init(rb532_button_init); 115d9bdffd2SPhil Sutter module_exit(rb532_button_exit); 116d9bdffd2SPhil Sutter 117d9bdffd2SPhil Sutter MODULE_AUTHOR("Phil Sutter <n0-1@freewrt.org>"); 118d9bdffd2SPhil Sutter MODULE_LICENSE("GPL"); 119d9bdffd2SPhil Sutter MODULE_DESCRIPTION("Support for S1 button on Routerboard 532"); 120d9bdffd2SPhil Sutter MODULE_ALIAS("platform:" DRV_NAME); 121