diff options
| author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
|---|---|---|
| committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
| commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
| tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /drivers/bluetooth | |
| parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) | |
Diffstat (limited to 'drivers/bluetooth')
| -rw-r--r-- | drivers/bluetooth/bluesleep.c | 864 | ||||
| -rw-r--r-- | drivers/bluetooth/ti_bluesleep.c | 371 |
2 files changed, 1235 insertions, 0 deletions
diff --git a/drivers/bluetooth/bluesleep.c b/drivers/bluetooth/bluesleep.c new file mode 100644 index 00000000000..0e2ec0befbe --- /dev/null +++ b/drivers/bluetooth/bluesleep.c | |||
| @@ -0,0 +1,864 @@ | |||
| 1 | /* | ||
| 2 | * This program is free software; you can redistribute it and/or modify | ||
| 3 | * it under the terms of the GNU General Public License version 2 as | ||
| 4 | * published by the Free Software Foundation. | ||
| 5 | * | ||
| 6 | * You should have received a copy of the GNU General Public License | ||
| 7 | * along with this program; if not, write to the Free Software | ||
| 8 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 9 | * | ||
| 10 | * This program is distributed in the hope that it will be useful, but | ||
| 11 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | ||
| 12 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | ||
| 13 | * for more details. | ||
| 14 | * | ||
| 15 | * Copyright (C) 2006-2007 - Motorola | ||
| 16 | * Copyright (c) 2008-2009, Code Aurora Forum. All rights reserved. | ||
| 17 | * | ||
| 18 | * Date Author Comment | ||
| 19 | * ----------- -------------- -------------------------------- | ||
| 20 | * 2006-Apr-28 Motorola The kernel module for running the Bluetooth(R) | ||
| 21 | * Sleep-Mode Protocol from the Host side | ||
| 22 | * 2006-Sep-08 Motorola Added workqueue for handling sleep work. | ||
| 23 | * 2007-Jan-24 Motorola Added mbm_handle_ioi() call to ISR. | ||
| 24 | * 2009-Aug-10 Motorola Changed "add_timer" to "mod_timer" to solve | ||
| 25 | * race when flurry of queued work comes in. | ||
| 26 | */ | ||
| 27 | |||
| 28 | #include <linux/module.h> /* kernel module definitions */ | ||
| 29 | #include <linux/errno.h> | ||
| 30 | #include <linux/init.h> | ||
| 31 | #include <linux/interrupt.h> | ||
| 32 | #include <linux/kernel.h> | ||
| 33 | #include <linux/notifier.h> | ||
| 34 | #include <linux/proc_fs.h> | ||
| 35 | #include <linux/spinlock.h> | ||
| 36 | #include <linux/timer.h> | ||
| 37 | #include <linux/uaccess.h> | ||
| 38 | #include <linux/version.h> | ||
| 39 | #include <linux/workqueue.h> | ||
| 40 | #include <linux/platform_device.h> | ||
| 41 | |||
| 42 | #include <linux/irq.h> | ||
| 43 | #include <linux/ioport.h> | ||
| 44 | #include <linux/param.h> | ||
| 45 | #include <linux/bitops.h> | ||
| 46 | #include <linux/termios.h> | ||
| 47 | #include <linux/wakelock.h> | ||
| 48 | #include <mach/gpio.h> | ||
| 49 | #include <linux/serial_core.h> | ||
| 50 | #include <linux/tegra_uart.h> | ||
| 51 | |||
| 52 | #include <net/bluetooth/bluetooth.h> | ||
| 53 | #include <net/bluetooth/hci_core.h> /* event notifications */ | ||
| 54 | #include "hci_uart.h" | ||
| 55 | |||
| 56 | #define BT_SLEEP_DBG | ||
| 57 | #ifndef BT_SLEEP_DBG | ||
| 58 | #define BT_DBG(fmt, arg...) | ||
| 59 | #endif | ||
| 60 | /* | ||
| 61 | * Defines | ||
| 62 | */ | ||
| 63 | |||
| 64 | #define VERSION "1.1" | ||
| 65 | #define PROC_DIR "bluetooth/sleep" | ||
| 66 | |||
| 67 | #define POLARITY_LOW 0 | ||
| 68 | #define POLARITY_HIGH 1 | ||
| 69 | |||
| 70 | /* enable/disable wake-on-bluetooth */ | ||
| 71 | #define BT_ENABLE_IRQ_WAKE 1 | ||
| 72 | |||
| 73 | struct bluesleep_info { | ||
| 74 | unsigned host_wake; | ||
| 75 | unsigned ext_wake; | ||
| 76 | unsigned host_wake_irq; | ||
| 77 | struct uart_port *uport; | ||
| 78 | struct wake_lock wake_lock; | ||
| 79 | int irq_polarity; | ||
| 80 | int has_ext_wake; | ||
| 81 | }; | ||
| 82 | |||
| 83 | /* work function */ | ||
| 84 | static void bluesleep_sleep_work(struct work_struct *work); | ||
| 85 | |||
| 86 | /* work queue */ | ||
| 87 | DECLARE_DELAYED_WORK(sleep_workqueue, bluesleep_sleep_work); | ||
| 88 | |||
| 89 | /* Macros for handling sleep work */ | ||
| 90 | #define bluesleep_rx_busy() schedule_delayed_work(&sleep_workqueue, 0) | ||
| 91 | #define bluesleep_tx_busy() schedule_delayed_work(&sleep_workqueue, 0) | ||
| 92 | #define bluesleep_rx_idle() schedule_delayed_work(&sleep_workqueue, 0) | ||
| 93 | #define bluesleep_tx_idle() schedule_delayed_work(&sleep_workqueue, 0) | ||
| 94 | |||
| 95 | /* 10 second timeout */ | ||
| 96 | #define TX_TIMER_INTERVAL 10 | ||
| 97 | |||
| 98 | /* state variable names and bit positions */ | ||
| 99 | #define BT_PROTO 0x01 | ||
| 100 | #define BT_TXDATA 0x02 | ||
| 101 | #define BT_ASLEEP 0x04 | ||
| 102 | #define BT_EXT_WAKE 0x08 | ||
| 103 | #define BT_SUSPEND 0x10 | ||
| 104 | |||
| 105 | /* global pointer to a single hci device. */ | ||
| 106 | static struct hci_dev *bluesleep_hdev; | ||
| 107 | |||
| 108 | static struct bluesleep_info *bsi; | ||
| 109 | |||
| 110 | /* module usage */ | ||
| 111 | static atomic_t open_count = ATOMIC_INIT(1); | ||
| 112 | |||
| 113 | /* | ||
| 114 | * Local function prototypes | ||
| 115 | */ | ||
| 116 | static int bluesleep_hci_event(struct notifier_block *this, | ||
| 117 | unsigned long event, void *data); | ||
| 118 | static int bluesleep_start(void); | ||
| 119 | static void bluesleep_stop(void); | ||
| 120 | |||
| 121 | /* | ||
| 122 | * Global variables | ||
| 123 | */ | ||
| 124 | /** Global state flags */ | ||
| 125 | static unsigned long flags; | ||
| 126 | |||
| 127 | /** Tasklet to respond to change in hostwake line */ | ||
| 128 | static struct tasklet_struct hostwake_task; | ||
| 129 | |||
| 130 | /** Transmission timer */ | ||
| 131 | static void bluesleep_tx_timer_expire(unsigned long data); | ||
| 132 | static DEFINE_TIMER(tx_timer, bluesleep_tx_timer_expire, 0, 0); | ||
| 133 | |||
| 134 | /** Lock for state transitions */ | ||
| 135 | static spinlock_t rw_lock; | ||
| 136 | |||
| 137 | /** Notifier block for HCI events */ | ||
| 138 | struct notifier_block hci_event_nblock = { | ||
| 139 | .notifier_call = bluesleep_hci_event, | ||
| 140 | }; | ||
| 141 | |||
| 142 | struct proc_dir_entry *bluetooth_dir, *sleep_dir; | ||
| 143 | |||
| 144 | /* | ||
| 145 | * Local functions | ||
| 146 | */ | ||
| 147 | static void hsuart_power(int on) | ||
| 148 | { | ||
| 149 | if (test_bit(BT_SUSPEND, &flags)) | ||
| 150 | return; | ||
| 151 | if (on) { | ||
| 152 | tegra_uart_request_clock_on(bsi->uport); | ||
| 153 | tegra_uart_set_mctrl(bsi->uport, TIOCM_RTS); | ||
| 154 | } else { | ||
| 155 | tegra_uart_set_mctrl(bsi->uport, 0); | ||
| 156 | tegra_uart_request_clock_off(bsi->uport); | ||
| 157 | } | ||
| 158 | } | ||
| 159 | |||
| 160 | /** | ||
| 161 | * @return 1 if the Host can go to sleep, 0 otherwise. | ||
| 162 | */ | ||
| 163 | int bluesleep_can_sleep(void) | ||
| 164 | { | ||
| 165 | /* check if WAKE_BT_GPIO and BT_WAKE_GPIO are both deasserted */ | ||
| 166 | return ((gpio_get_value(bsi->host_wake) != bsi->irq_polarity) && | ||
| 167 | (!test_bit(BT_EXT_WAKE, &flags)) && | ||
| 168 | (bsi->uport != NULL)); | ||
| 169 | } | ||
| 170 | |||
| 171 | void bluesleep_sleep_wakeup(void) | ||
| 172 | { | ||
| 173 | if (test_bit(BT_ASLEEP, &flags)) { | ||
| 174 | BT_DBG("waking up..."); | ||
| 175 | wake_lock(&bsi->wake_lock); | ||
| 176 | /* Start the timer */ | ||
| 177 | mod_timer(&tx_timer, jiffies + (TX_TIMER_INTERVAL * HZ)); | ||
| 178 | if (bsi->has_ext_wake == 1) | ||
| 179 | gpio_set_value(bsi->ext_wake, 1); | ||
| 180 | set_bit(BT_EXT_WAKE, &flags); | ||
| 181 | clear_bit(BT_ASLEEP, &flags); | ||
| 182 | /*Activating UART */ | ||
| 183 | } | ||
| 184 | } | ||
| 185 | |||
| 186 | /** | ||
| 187 | * @brief@ main sleep work handling function which update the flags | ||
| 188 | * and activate and deactivate UART ,check FIFO. | ||
| 189 | */ | ||
| 190 | static void bluesleep_sleep_work(struct work_struct *work) | ||
| 191 | { | ||
| 192 | if (bluesleep_can_sleep()) { | ||
| 193 | /* already asleep, this is an error case */ | ||
| 194 | if (test_bit(BT_ASLEEP, &flags)) { | ||
| 195 | BT_DBG("already asleep"); | ||
| 196 | return; | ||
| 197 | } | ||
| 198 | |||
| 199 | if (tegra_uart_is_tx_empty(bsi->uport)) { | ||
| 200 | BT_DBG("going to sleep..."); | ||
| 201 | set_bit(BT_ASLEEP, &flags); | ||
| 202 | /*Deactivating UART */ | ||
| 203 | /* UART clk is not turned off immediately. Release | ||
| 204 | * wakelock after 500 ms. | ||
| 205 | */ | ||
| 206 | wake_lock_timeout(&bsi->wake_lock, HZ / 2); | ||
| 207 | } else { | ||
| 208 | mod_timer(&tx_timer, jiffies + TX_TIMER_INTERVAL * HZ); | ||
| 209 | return; | ||
| 210 | } | ||
| 211 | } else if (!test_bit(BT_EXT_WAKE, &flags) | ||
| 212 | && !test_bit(BT_ASLEEP, &flags)) { | ||
| 213 | mod_timer(&tx_timer, jiffies + (TX_TIMER_INTERVAL * HZ)); | ||
| 214 | if (bsi->has_ext_wake == 1) | ||
| 215 | gpio_set_value(bsi->ext_wake, 1); | ||
| 216 | set_bit(BT_EXT_WAKE, &flags); | ||
| 217 | } else { | ||
| 218 | bluesleep_sleep_wakeup(); | ||
| 219 | } | ||
| 220 | } | ||
| 221 | |||
| 222 | /** | ||
| 223 | * A tasklet function that runs in tasklet context and reads the value | ||
| 224 | * of the HOST_WAKE GPIO pin and further defer the work. | ||
| 225 | * @param data Not used. | ||
| 226 | */ | ||
| 227 | static void bluesleep_hostwake_task(unsigned long data) | ||
| 228 | { | ||
| 229 | BT_DBG("hostwake line change"); | ||
| 230 | |||
| 231 | spin_lock(&rw_lock); | ||
| 232 | if ((gpio_get_value(bsi->host_wake) == bsi->irq_polarity)) | ||
| 233 | bluesleep_rx_busy(); | ||
| 234 | else | ||
| 235 | bluesleep_rx_idle(); | ||
| 236 | spin_unlock(&rw_lock); | ||
| 237 | |||
| 238 | } | ||
| 239 | |||
| 240 | /** | ||
| 241 | * Handles proper timer action when outgoing data is delivered to the | ||
| 242 | * HCI line discipline. Sets BT_TXDATA. | ||
| 243 | */ | ||
| 244 | static void bluesleep_outgoing_data(void) | ||
| 245 | { | ||
| 246 | unsigned long irq_flags; | ||
| 247 | |||
| 248 | spin_lock_irqsave(&rw_lock, irq_flags); | ||
| 249 | /* log data passing by */ | ||
| 250 | set_bit(BT_TXDATA, &flags); | ||
| 251 | /* if the tx side is sleeping... */ | ||
| 252 | if (!test_bit(BT_EXT_WAKE, &flags)) { | ||
| 253 | BT_DBG("tx was sleeping"); | ||
| 254 | bluesleep_sleep_wakeup(); | ||
| 255 | } | ||
| 256 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 257 | } | ||
| 258 | |||
| 259 | /** | ||
| 260 | * Handles HCI device events. | ||
| 261 | * @param this Not used. | ||
| 262 | * @param event The event that occurred. | ||
| 263 | * @param data The HCI device associated with the event. | ||
| 264 | * @return <code>NOTIFY_DONE</code>. | ||
| 265 | */ | ||
| 266 | static int bluesleep_hci_event(struct notifier_block *this, | ||
| 267 | unsigned long event, void *data) | ||
| 268 | { | ||
| 269 | struct hci_dev *hdev = (struct hci_dev *) data; | ||
| 270 | struct hci_uart *hu; | ||
| 271 | struct uart_state *state; | ||
| 272 | |||
| 273 | if (!hdev) | ||
| 274 | return NOTIFY_DONE; | ||
| 275 | |||
| 276 | switch (event) { | ||
| 277 | case HCI_DEV_REG: | ||
| 278 | if (!bluesleep_hdev) { | ||
| 279 | bluesleep_hdev = hdev; | ||
| 280 | hu = (struct hci_uart *) hdev->driver_data; | ||
| 281 | state = (struct uart_state *) hu->tty->driver_data; | ||
| 282 | bsi->uport = state->uart_port; | ||
| 283 | /* if bluetooth started, start bluesleep*/ | ||
| 284 | bluesleep_start(); | ||
| 285 | } | ||
| 286 | break; | ||
| 287 | case HCI_DEV_UNREG: | ||
| 288 | bluesleep_stop(); | ||
| 289 | bluesleep_hdev = NULL; | ||
| 290 | bsi->uport = NULL; | ||
| 291 | /* if bluetooth stopped, stop bluesleep also */ | ||
| 292 | break; | ||
| 293 | case HCI_DEV_WRITE: | ||
| 294 | bluesleep_outgoing_data(); | ||
| 295 | break; | ||
| 296 | } | ||
| 297 | |||
| 298 | return NOTIFY_DONE; | ||
| 299 | } | ||
| 300 | |||
| 301 | /** | ||
| 302 | * Handles transmission timer expiration. | ||
| 303 | * @param data Not used. | ||
| 304 | */ | ||
| 305 | static void bluesleep_tx_timer_expire(unsigned long data) | ||
| 306 | { | ||
| 307 | unsigned long irq_flags; | ||
| 308 | |||
| 309 | BT_DBG("Tx timer expired"); | ||
| 310 | |||
| 311 | spin_lock_irqsave(&rw_lock, irq_flags); | ||
| 312 | |||
| 313 | /* were we silent during the last timeout? */ | ||
| 314 | if (!test_bit(BT_TXDATA, &flags)) { | ||
| 315 | BT_DBG("Tx has been idle"); | ||
| 316 | if (bsi->has_ext_wake == 1) | ||
| 317 | gpio_set_value(bsi->ext_wake, 0); | ||
| 318 | clear_bit(BT_EXT_WAKE, &flags); | ||
| 319 | bluesleep_tx_idle(); | ||
| 320 | } else { | ||
| 321 | BT_DBG("Tx data during last period"); | ||
| 322 | mod_timer(&tx_timer, jiffies + (TX_TIMER_INTERVAL*HZ)); | ||
| 323 | } | ||
| 324 | |||
| 325 | /* clear the incoming data flag */ | ||
| 326 | clear_bit(BT_TXDATA, &flags); | ||
| 327 | |||
| 328 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 329 | } | ||
| 330 | |||
| 331 | /** | ||
| 332 | * Schedules a tasklet to run when receiving an interrupt on the | ||
| 333 | * <code>HOST_WAKE</code> GPIO pin. | ||
| 334 | * @param irq Not used. | ||
| 335 | * @param dev_id Not used. | ||
| 336 | */ | ||
| 337 | static irqreturn_t bluesleep_hostwake_isr(int irq, void *dev_id) | ||
| 338 | { | ||
| 339 | /* schedule a tasklet to handle the change in the host wake line */ | ||
| 340 | tasklet_schedule(&hostwake_task); | ||
| 341 | return IRQ_HANDLED; | ||
| 342 | } | ||
| 343 | |||
| 344 | /** | ||
| 345 | * Starts the Sleep-Mode Protocol on the Host. | ||
| 346 | * @return On success, 0. On error, -1, and <code>errno</code> is set | ||
| 347 | * appropriately. | ||
| 348 | */ | ||
| 349 | static int bluesleep_start(void) | ||
| 350 | { | ||
| 351 | int retval; | ||
| 352 | unsigned long irq_flags; | ||
| 353 | |||
| 354 | spin_lock_irqsave(&rw_lock, irq_flags); | ||
| 355 | if (test_bit(BT_PROTO, &flags)) { | ||
| 356 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 357 | return 0; | ||
| 358 | } | ||
| 359 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 360 | |||
| 361 | if (!atomic_dec_and_test(&open_count)) { | ||
| 362 | atomic_inc(&open_count); | ||
| 363 | return -EBUSY; | ||
| 364 | } | ||
| 365 | |||
| 366 | /* start the timer */ | ||
| 367 | mod_timer(&tx_timer, jiffies + (TX_TIMER_INTERVAL * HZ)); | ||
| 368 | |||
| 369 | /* assert BT_WAKE */ | ||
| 370 | if (bsi->has_ext_wake == 1) | ||
| 371 | gpio_set_value(bsi->ext_wake, 1); | ||
| 372 | set_bit(BT_EXT_WAKE, &flags); | ||
| 373 | #if BT_ENABLE_IRQ_WAKE | ||
| 374 | retval = enable_irq_wake(bsi->host_wake_irq); | ||
| 375 | if (retval < 0) { | ||
| 376 | BT_ERR("Couldn't enable BT_HOST_WAKE as wakeup interrupt"); | ||
| 377 | goto fail; | ||
| 378 | } | ||
| 379 | #endif | ||
| 380 | set_bit(BT_PROTO, &flags); | ||
| 381 | wake_lock(&bsi->wake_lock); | ||
| 382 | return 0; | ||
| 383 | fail: | ||
| 384 | del_timer(&tx_timer); | ||
| 385 | atomic_inc(&open_count); | ||
| 386 | |||
| 387 | return retval; | ||
| 388 | } | ||
| 389 | |||
| 390 | /** | ||
| 391 | * Stops the Sleep-Mode Protocol on the Host. | ||
| 392 | */ | ||
| 393 | static void bluesleep_stop(void) | ||
| 394 | { | ||
| 395 | unsigned long irq_flags; | ||
| 396 | |||
| 397 | spin_lock_irqsave(&rw_lock, irq_flags); | ||
| 398 | if (!test_bit(BT_PROTO, &flags)) { | ||
| 399 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 400 | return; | ||
| 401 | } | ||
| 402 | /* assert BT_WAKE */ | ||
| 403 | if (bsi->has_ext_wake == 1) | ||
| 404 | gpio_set_value(bsi->ext_wake, 1); | ||
| 405 | set_bit(BT_EXT_WAKE, &flags); | ||
| 406 | del_timer(&tx_timer); | ||
| 407 | clear_bit(BT_PROTO, &flags); | ||
| 408 | |||
| 409 | if (test_bit(BT_ASLEEP, &flags)) { | ||
| 410 | clear_bit(BT_ASLEEP, &flags); | ||
| 411 | hsuart_power(1); | ||
| 412 | } | ||
| 413 | |||
| 414 | atomic_inc(&open_count); | ||
| 415 | spin_unlock_irqrestore(&rw_lock, irq_flags); | ||
| 416 | |||
| 417 | #if BT_ENABLE_IRQ_WAKE | ||
| 418 | if (disable_irq_wake(bsi->host_wake_irq)) | ||
| 419 | BT_ERR("Couldn't disable hostwake IRQ wakeup mode\n"); | ||
| 420 | #endif | ||
| 421 | wake_lock_timeout(&bsi->wake_lock, HZ / 2); | ||
| 422 | } | ||
| 423 | /** | ||
| 424 | * Read the <code>BT_WAKE</code> GPIO pin value via the proc interface. | ||
| 425 | * When this function returns, <code>page</code> will contain a 1 if the | ||
| 426 | * pin is high, 0 otherwise. | ||
| 427 | * @param page Buffer for writing data. | ||
| 428 | * @param start Not used. | ||
| 429 | * @param offset Not used. | ||
| 430 | * @param count Not used. | ||
| 431 | * @param eof Whether or not there is more data to be read. | ||
| 432 | * @param data Not used. | ||
| 433 | * @return The number of bytes written. | ||
| 434 | */ | ||
| 435 | static int bluepower_read_proc_btwake(char *page, char **start, off_t offset, | ||
| 436 | int count, int *eof, void *data) | ||
| 437 | { | ||
| 438 | *eof = 1; | ||
| 439 | return sprintf(page, "btwake:%u\n",test_bit(BT_EXT_WAKE, &flags)); | ||
| 440 | } | ||
| 441 | |||
| 442 | /** | ||
| 443 | * Write the <code>BT_WAKE</code> GPIO pin value via the proc interface. | ||
| 444 | * @param file Not used. | ||
| 445 | * @param buffer The buffer to read from. | ||
| 446 | * @param count The number of bytes to be written. | ||
| 447 | * @param data Not used. | ||
| 448 | * @return On success, the number of bytes written. On error, -1, and | ||
| 449 | * <code>errno</code> is set appropriately. | ||
| 450 | */ | ||
| 451 | static int bluepower_write_proc_btwake(struct file *file, const char *buffer, | ||
| 452 | unsigned long count, void *data) | ||
| 453 | { | ||
| 454 | char *buf; | ||
| 455 | |||
| 456 | if (count < 1) | ||
| 457 | return -EINVAL; | ||
| 458 | |||
| 459 | buf = kmalloc(count, GFP_KERNEL); | ||
| 460 | if (!buf) | ||
| 461 | return -ENOMEM; | ||
| 462 | |||
| 463 | if (copy_from_user(buf, buffer, count)) { | ||
| 464 | kfree(buf); | ||
| 465 | return -EFAULT; | ||
| 466 | } | ||
| 467 | if (buf[0] == '0') { | ||
| 468 | if (bsi->has_ext_wake == 1) | ||
| 469 | gpio_set_value(bsi->ext_wake, 0); | ||
| 470 | clear_bit(BT_EXT_WAKE, &flags); | ||
| 471 | } else if (buf[0] == '1') { | ||
| 472 | if (bsi->has_ext_wake == 1) | ||
| 473 | gpio_set_value(bsi->ext_wake, 1); | ||
| 474 | set_bit(BT_EXT_WAKE, &flags); | ||
| 475 | } else { | ||
| 476 | kfree(buf); | ||
| 477 | return -EINVAL; | ||
| 478 | } | ||
| 479 | |||
| 480 | kfree(buf); | ||
| 481 | return count; | ||
| 482 | } | ||
| 483 | |||
| 484 | /** | ||
| 485 | * Read the <code>BT_HOST_WAKE</code> GPIO pin value via the proc interface. | ||
| 486 | * When this function returns, <code>page</code> will contain a 1 if the pin | ||
| 487 | * is high, 0 otherwise. | ||
| 488 | * @param page Buffer for writing data. | ||
| 489 | * @param start Not used. | ||
| 490 | * @param offset Not used. | ||
| 491 | * @param count Not used. | ||
| 492 | * @param eof Whether or not there is more data to be read. | ||
| 493 | * @param data Not used. | ||
| 494 | * @return The number of bytes written. | ||
| 495 | */ | ||
| 496 | static int bluepower_read_proc_hostwake(char *page, char **start, off_t offset, | ||
| 497 | int count, int *eof, void *data) | ||
| 498 | { | ||
| 499 | *eof = 1; | ||
| 500 | return sprintf(page, "hostwake: %u\n", gpio_get_value(bsi->host_wake)); | ||
| 501 | } | ||
| 502 | |||
| 503 | |||
| 504 | /** | ||
| 505 | * Read the low-power status of the Host via the proc interface. | ||
| 506 | * When this function returns, <code>page</code> contains a 1 if the Host | ||
| 507 | * is asleep, 0 otherwise. | ||
| 508 | * @param page Buffer for writing data. | ||
| 509 | * @param start Not used. | ||
| 510 | * @param offset Not used. | ||
| 511 | * @param count Not used. | ||
| 512 | * @param eof Whether or not there is more data to be read. | ||
| 513 | * @param data Not used. | ||
| 514 | * @return The number of bytes written. | ||
| 515 | */ | ||
| 516 | static int bluesleep_read_proc_asleep(char *page, char **start, off_t offset, | ||
| 517 | int count, int *eof, void *data) | ||
| 518 | { | ||
| 519 | unsigned int asleep; | ||
| 520 | |||
| 521 | asleep = test_bit(BT_ASLEEP, &flags) ? 1 : 0; | ||
| 522 | *eof = 1; | ||
| 523 | return sprintf(page, "asleep: %u\n", asleep); | ||
| 524 | } | ||
| 525 | |||
| 526 | /** | ||
| 527 | * Read the low-power protocol being used by the Host via the proc interface. | ||
| 528 | * When this function returns, <code>page</code> will contain a 1 if the Host | ||
| 529 | * is using the Sleep Mode Protocol, 0 otherwise. | ||
| 530 | * @param page Buffer for writing data. | ||
| 531 | * @param start Not used. | ||
| 532 | * @param offset Not used. | ||
| 533 | * @param count Not used. | ||
| 534 | * @param eof Whether or not there is more data to be read. | ||
| 535 | * @param data Not used. | ||
| 536 | * @return The number of bytes written. | ||
| 537 | */ | ||
| 538 | static int bluesleep_read_proc_proto(char *page, char **start, off_t offset, | ||
| 539 | int count, int *eof, void *data) | ||
| 540 | { | ||
| 541 | unsigned int proto; | ||
| 542 | |||
| 543 | proto = test_bit(BT_PROTO, &flags) ? 1 : 0; | ||
| 544 | *eof = 1; | ||
| 545 | return sprintf(page, "proto: %u\n", proto); | ||
| 546 | } | ||
| 547 | |||
| 548 | /** | ||
| 549 | * Modify the low-power protocol used by the Host via the proc interface. | ||
| 550 | * @param file Not used. | ||
| 551 | * @param buffer The buffer to read from. | ||
| 552 | * @param count The number of bytes to be written. | ||
| 553 | * @param data Not used. | ||
| 554 | * @return On success, the number of bytes written. On error, -1, and | ||
| 555 | * <code>errno</code> is set appropriately. | ||
| 556 | */ | ||
| 557 | static int bluesleep_write_proc_proto(struct file *file, const char *buffer, | ||
| 558 | unsigned long count, void *data) | ||
| 559 | { | ||
| 560 | char proto; | ||
| 561 | |||
| 562 | if (count < 1) | ||
| 563 | return -EINVAL; | ||
| 564 | |||
| 565 | if (copy_from_user(&proto, buffer, 1)) | ||
| 566 | return -EFAULT; | ||
| 567 | |||
| 568 | if (proto == '0') | ||
| 569 | bluesleep_stop(); | ||
| 570 | else | ||
| 571 | bluesleep_start(); | ||
| 572 | |||
| 573 | /* claim that we wrote everything */ | ||
| 574 | return count; | ||
| 575 | } | ||
| 576 | |||
| 577 | |||
| 578 | static int bluesleep_probe(struct platform_device *pdev) | ||
| 579 | { | ||
| 580 | int ret; | ||
| 581 | struct resource *res; | ||
| 582 | |||
| 583 | bsi = kzalloc(sizeof(struct bluesleep_info), GFP_KERNEL); | ||
| 584 | if (!bsi) | ||
| 585 | return -ENOMEM; | ||
| 586 | |||
| 587 | res = platform_get_resource_byname(pdev, IORESOURCE_IO, | ||
| 588 | "gpio_host_wake"); | ||
| 589 | if (!res) { | ||
| 590 | BT_ERR("couldn't find host_wake gpio\n"); | ||
| 591 | ret = -ENODEV; | ||
| 592 | goto free_bsi; | ||
| 593 | } | ||
| 594 | bsi->host_wake = res->start; | ||
| 595 | |||
| 596 | ret = gpio_request(bsi->host_wake, "bt_host_wake"); | ||
| 597 | if (ret) | ||
| 598 | goto free_bsi; | ||
| 599 | |||
| 600 | /* configure host_wake as input */ | ||
| 601 | ret = gpio_direction_input(bsi->host_wake); | ||
| 602 | if (ret < 0) { | ||
| 603 | pr_err("gpio-keys: failed to configure input" | ||
| 604 | " direction for GPIO %d, error %d\n", | ||
| 605 | bsi->host_wake, ret); | ||
| 606 | gpio_free(bsi->host_wake); | ||
| 607 | goto free_bsi; | ||
| 608 | } | ||
| 609 | |||
| 610 | res = platform_get_resource_byname(pdev, IORESOURCE_IO, | ||
| 611 | "gpio_ext_wake"); | ||
| 612 | |||
| 613 | if (!res) | ||
| 614 | bsi->has_ext_wake = 0; | ||
| 615 | else | ||
| 616 | bsi->has_ext_wake = 1; | ||
| 617 | |||
| 618 | if (bsi->has_ext_wake) { | ||
| 619 | bsi->ext_wake = res->start; | ||
| 620 | ret = gpio_request(bsi->ext_wake, "bt_ext_wake"); | ||
| 621 | if (ret) | ||
| 622 | goto free_bt_host_wake; | ||
| 623 | |||
| 624 | /* configure ext_wake as output mode*/ | ||
| 625 | ret = gpio_direction_output(bsi->ext_wake, 1); | ||
| 626 | if (ret < 0) { | ||
| 627 | pr_err("gpio-keys: failed to configure output" | ||
| 628 | " direction for GPIO %d, error %d\n", | ||
| 629 | bsi->ext_wake, ret); | ||
| 630 | gpio_free(bsi->ext_wake); | ||
| 631 | goto free_bt_host_wake; | ||
| 632 | } | ||
| 633 | } else | ||
| 634 | set_bit(BT_EXT_WAKE, &flags); | ||
| 635 | |||
| 636 | res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, | ||
| 637 | "host_wake"); | ||
| 638 | if (!res) { | ||
| 639 | BT_ERR("couldn't find host_wake irq\n"); | ||
| 640 | ret = -ENODEV; | ||
| 641 | goto free_bt_host_wake; | ||
| 642 | } | ||
| 643 | bsi->host_wake_irq = res->start; | ||
| 644 | if (bsi->host_wake_irq < 0) { | ||
| 645 | BT_ERR("couldn't find host_wake irq\n"); | ||
| 646 | ret = -ENODEV; | ||
| 647 | goto free_bt_ext_wake; | ||
| 648 | } | ||
| 649 | if (res->flags & IORESOURCE_IRQ_LOWEDGE) | ||
| 650 | bsi->irq_polarity = POLARITY_LOW;/*low edge (falling edge)*/ | ||
| 651 | else | ||
| 652 | bsi->irq_polarity = POLARITY_HIGH;/*anything else*/ | ||
| 653 | |||
| 654 | wake_lock_init(&bsi->wake_lock, WAKE_LOCK_SUSPEND, "bluesleep"); | ||
| 655 | clear_bit(BT_SUSPEND, &flags); | ||
| 656 | |||
| 657 | if (bsi->irq_polarity == POLARITY_LOW) { | ||
| 658 | ret = request_irq(bsi->host_wake_irq, bluesleep_hostwake_isr, | ||
| 659 | IRQF_DISABLED | IRQF_TRIGGER_FALLING, | ||
| 660 | "bluetooth hostwake", NULL); | ||
| 661 | } else { | ||
| 662 | ret = request_irq(bsi->host_wake_irq, bluesleep_hostwake_isr, | ||
| 663 | IRQF_DISABLED | IRQF_TRIGGER_RISING, | ||
| 664 | "bluetooth hostwake", NULL); | ||
| 665 | } | ||
| 666 | if (ret < 0) { | ||
| 667 | BT_ERR("Couldn't acquire BT_HOST_WAKE IRQ"); | ||
| 668 | goto free_bt_ext_wake; | ||
| 669 | } | ||
| 670 | |||
| 671 | return 0; | ||
| 672 | |||
| 673 | free_bt_ext_wake: | ||
| 674 | gpio_free(bsi->ext_wake); | ||
| 675 | free_bt_host_wake: | ||
| 676 | gpio_free(bsi->host_wake); | ||
| 677 | free_bsi: | ||
| 678 | kfree(bsi); | ||
| 679 | return ret; | ||
| 680 | } | ||
| 681 | |||
| 682 | static int bluesleep_remove(struct platform_device *pdev) | ||
| 683 | { | ||
| 684 | free_irq(bsi->host_wake_irq, NULL); | ||
| 685 | gpio_free(bsi->host_wake); | ||
| 686 | gpio_free(bsi->ext_wake); | ||
| 687 | wake_lock_destroy(&bsi->wake_lock); | ||
| 688 | kfree(bsi); | ||
| 689 | return 0; | ||
| 690 | } | ||
| 691 | |||
| 692 | |||
| 693 | static int bluesleep_resume(struct platform_device *pdev) | ||
| 694 | { | ||
| 695 | if (test_bit(BT_SUSPEND, &flags)) { | ||
| 696 | BT_DBG("bluesleep resuming...\n"); | ||
| 697 | if ((bsi->uport != NULL) && | ||
| 698 | (gpio_get_value(bsi->host_wake) == bsi->irq_polarity)) { | ||
| 699 | BT_DBG("bluesleep resume form BT event...\n"); | ||
| 700 | tegra_uart_request_clock_on(bsi->uport); | ||
| 701 | tegra_uart_set_mctrl(bsi->uport, TIOCM_RTS); | ||
| 702 | } | ||
| 703 | clear_bit(BT_SUSPEND, &flags); | ||
| 704 | } | ||
| 705 | return 0; | ||
| 706 | } | ||
| 707 | |||
| 708 | static int bluesleep_suspend(struct platform_device *pdev, pm_message_t state) | ||
| 709 | { | ||
| 710 | BT_DBG("bluesleep suspending...\n"); | ||
| 711 | set_bit(BT_SUSPEND, &flags); | ||
| 712 | return 0; | ||
| 713 | } | ||
| 714 | |||
| 715 | static struct platform_driver bluesleep_driver = { | ||
| 716 | .probe = bluesleep_probe, | ||
| 717 | .remove = bluesleep_remove, | ||
| 718 | .suspend = bluesleep_suspend, | ||
| 719 | .resume = bluesleep_resume, | ||
| 720 | .driver = { | ||
| 721 | .name = "bluesleep", | ||
| 722 | .owner = THIS_MODULE, | ||
| 723 | }, | ||
| 724 | }; | ||
| 725 | /** | ||
| 726 | * Initializes the module. | ||
| 727 | * @return On success, 0. On error, -1, and <code>errno</code> is set | ||
| 728 | * appropriately. | ||
| 729 | */ | ||
| 730 | static int __init bluesleep_init(void) | ||
| 731 | { | ||
| 732 | int retval; | ||
| 733 | struct proc_dir_entry *ent; | ||
| 734 | |||
| 735 | BT_INFO("BlueSleep Mode Driver Ver %s", VERSION); | ||
| 736 | |||
| 737 | retval = platform_driver_register(&bluesleep_driver); | ||
| 738 | if (retval) | ||
| 739 | return retval; | ||
| 740 | |||
| 741 | if (bsi == NULL) | ||
| 742 | return 0; | ||
| 743 | |||
| 744 | bluesleep_hdev = NULL; | ||
| 745 | |||
| 746 | bluetooth_dir = proc_mkdir("bluetooth", NULL); | ||
| 747 | if (bluetooth_dir == NULL) { | ||
| 748 | BT_ERR("Unable to create /proc/bluetooth directory"); | ||
| 749 | return -ENOMEM; | ||
| 750 | } | ||
| 751 | |||
| 752 | sleep_dir = proc_mkdir("sleep", bluetooth_dir); | ||
| 753 | if (sleep_dir == NULL) { | ||
| 754 | BT_ERR("Unable to create /proc/%s directory", PROC_DIR); | ||
| 755 | return -ENOMEM; | ||
| 756 | } | ||
| 757 | |||
| 758 | /* Creating read/write "btwake" entry */ | ||
| 759 | ent = create_proc_entry("btwake", 0, sleep_dir); | ||
| 760 | if (ent == NULL) { | ||
| 761 | BT_ERR("Unable to create /proc/%s/btwake entry", PROC_DIR); | ||
| 762 | retval = -ENOMEM; | ||
| 763 | goto fail; | ||
| 764 | } | ||
| 765 | ent->read_proc = bluepower_read_proc_btwake; | ||
| 766 | ent->write_proc = bluepower_write_proc_btwake; | ||
| 767 | |||
| 768 | /* read only proc entries */ | ||
| 769 | if (create_proc_read_entry("hostwake", 0, sleep_dir, | ||
| 770 | bluepower_read_proc_hostwake, NULL) == NULL) { | ||
| 771 | BT_ERR("Unable to create /proc/%s/hostwake entry", PROC_DIR); | ||
| 772 | retval = -ENOMEM; | ||
| 773 | goto fail; | ||
| 774 | } | ||
| 775 | |||
| 776 | /* read/write proc entries */ | ||
| 777 | ent = create_proc_entry("proto", 0, sleep_dir); | ||
| 778 | if (ent == NULL) { | ||
| 779 | BT_ERR("Unable to create /proc/%s/proto entry", PROC_DIR); | ||
| 780 | retval = -ENOMEM; | ||
| 781 | goto fail; | ||
| 782 | } | ||
| 783 | ent->read_proc = bluesleep_read_proc_proto; | ||
| 784 | ent->write_proc = bluesleep_write_proc_proto; | ||
| 785 | |||
| 786 | /* read only proc entries */ | ||
| 787 | if (create_proc_read_entry("asleep", 0, | ||
| 788 | sleep_dir, bluesleep_read_proc_asleep, NULL) == NULL) { | ||
| 789 | BT_ERR("Unable to create /proc/%s/asleep entry", PROC_DIR); | ||
| 790 | retval = -ENOMEM; | ||
| 791 | goto fail; | ||
| 792 | } | ||
| 793 | |||
| 794 | flags = 0; /* clear all status bits */ | ||
| 795 | |||
| 796 | /* Initialize spinlock. */ | ||
| 797 | spin_lock_init(&rw_lock); | ||
| 798 | |||
| 799 | /* Initialize timer */ | ||
| 800 | init_timer(&tx_timer); | ||
| 801 | tx_timer.function = bluesleep_tx_timer_expire; | ||
| 802 | tx_timer.data = 0; | ||
| 803 | |||
| 804 | /* initialize host wake tasklet */ | ||
| 805 | tasklet_init(&hostwake_task, bluesleep_hostwake_task, 0); | ||
| 806 | |||
| 807 | /* assert bt wake */ | ||
| 808 | if (bsi->has_ext_wake == 1) | ||
| 809 | gpio_set_value(bsi->ext_wake, 1); | ||
| 810 | set_bit(BT_EXT_WAKE, &flags); | ||
| 811 | hci_register_notifier(&hci_event_nblock); | ||
| 812 | |||
| 813 | return 0; | ||
| 814 | |||
| 815 | fail: | ||
| 816 | remove_proc_entry("asleep", sleep_dir); | ||
| 817 | remove_proc_entry("proto", sleep_dir); | ||
| 818 | remove_proc_entry("hostwake", sleep_dir); | ||
| 819 | remove_proc_entry("btwake", sleep_dir); | ||
| 820 | remove_proc_entry("sleep", bluetooth_dir); | ||
| 821 | remove_proc_entry("bluetooth", 0); | ||
| 822 | return retval; | ||
| 823 | } | ||
| 824 | |||
| 825 | /** | ||
| 826 | * Cleans up the module. | ||
| 827 | */ | ||
| 828 | static void __exit bluesleep_exit(void) | ||
| 829 | { | ||
| 830 | if (bsi == NULL) | ||
| 831 | return; | ||
| 832 | |||
| 833 | /* assert bt wake */ | ||
| 834 | if (bsi->has_ext_wake == 1) | ||
| 835 | gpio_set_value(bsi->ext_wake, 1); | ||
| 836 | set_bit(BT_EXT_WAKE, &flags); | ||
| 837 | if (test_bit(BT_PROTO, &flags)) { | ||
| 838 | if (disable_irq_wake(bsi->host_wake_irq)) | ||
| 839 | BT_ERR("Couldn't disable hostwake IRQ wakeup mode\n"); | ||
| 840 | free_irq(bsi->host_wake_irq, NULL); | ||
| 841 | del_timer(&tx_timer); | ||
| 842 | if (test_bit(BT_ASLEEP, &flags)) | ||
| 843 | hsuart_power(1); | ||
| 844 | } | ||
| 845 | |||
| 846 | hci_unregister_notifier(&hci_event_nblock); | ||
| 847 | platform_driver_unregister(&bluesleep_driver); | ||
| 848 | |||
| 849 | remove_proc_entry("asleep", sleep_dir); | ||
| 850 | remove_proc_entry("proto", sleep_dir); | ||
| 851 | remove_proc_entry("hostwake", sleep_dir); | ||
| 852 | remove_proc_entry("btwake", sleep_dir); | ||
| 853 | remove_proc_entry("sleep", bluetooth_dir); | ||
| 854 | remove_proc_entry("bluetooth", 0); | ||
| 855 | } | ||
| 856 | |||
| 857 | module_init(bluesleep_init); | ||
| 858 | module_exit(bluesleep_exit); | ||
| 859 | |||
| 860 | MODULE_DESCRIPTION("Bluetooth Sleep Mode Driver ver %s " VERSION); | ||
| 861 | #ifdef MODULE_LICENSE | ||
| 862 | MODULE_LICENSE("GPL"); | ||
| 863 | #endif | ||
| 864 | |||
diff --git a/drivers/bluetooth/ti_bluesleep.c b/drivers/bluetooth/ti_bluesleep.c new file mode 100644 index 00000000000..d86fd261e67 --- /dev/null +++ b/drivers/bluetooth/ti_bluesleep.c | |||
| @@ -0,0 +1,371 @@ | |||
| 1 | /* | ||
| 2 | * TI Bluesleep driver | ||
| 3 | * Kernel module responsible for Wake up of Host | ||
| 4 | * Copyright (C) 2009-2010 Texas Instruments | ||
| 5 | |||
| 6 | |||
| 7 | * This program is free software; you can redistribute it and/or modify | ||
| 8 | * it under the terms of the GNU General Public License version 2 as | ||
| 9 | * published by the Free Software Foundation. | ||
| 10 | * | ||
| 11 | * You should have received a copy of the GNU General Public License | ||
| 12 | * along with this program; if not, write to the Free Software | ||
| 13 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 14 | * | ||
| 15 | * This program is distributed in the hope that it will be useful, but | ||
| 16 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | ||
| 17 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | ||
| 18 | * for more details. | ||
| 19 | * | ||
| 20 | * Copyright (C) 2006-2007 - Motorola | ||
| 21 | * Copyright (c) 2008-2009, Code Aurora Forum. All rights reserved. | ||
| 22 | * | ||
| 23 | * Date Author Comment | ||
| 24 | * ----------- -------------- -------------------------------- | ||
| 25 | * 2006-Apr-28 Motorola The kernel module for running the Bluetooth(R) | ||
| 26 | * Sleep-Mode Protocol from the Host side | ||
| 27 | * 2006-Sep-08 Motorola Added workqueue for handling sleep work. | ||
| 28 | * 2007-Jan-24 Motorola Added mbm_handle_ioi() call to ISR. | ||
| 29 | * 2009-Aug-10 Motorola Changed "add_timer" to "mod_timer" to solve | ||
| 30 | * race when flurry of queued work comes in. | ||
| 31 | */ | ||
| 32 | |||
| 33 | #include <linux/module.h> /* kernel module definitions */ | ||
| 34 | #include <linux/errno.h> | ||
| 35 | #include <linux/init.h> | ||
| 36 | #include <linux/interrupt.h> | ||
| 37 | #include <linux/kernel.h> | ||
| 38 | #include <linux/notifier.h> | ||
| 39 | #include <linux/proc_fs.h> | ||
| 40 | #include <linux/spinlock.h> | ||
| 41 | #include <linux/timer.h> | ||
| 42 | #include <linux/uaccess.h> | ||
| 43 | #include <linux/version.h> | ||
| 44 | #include <linux/workqueue.h> | ||
| 45 | #include <linux/platform_device.h> | ||
| 46 | |||
| 47 | #include <linux/irq.h> | ||
| 48 | #include <linux/ioport.h> | ||
| 49 | #include <linux/param.h> | ||
| 50 | #include <linux/bitops.h> | ||
| 51 | #include <linux/termios.h> | ||
| 52 | #include <linux/wakelock.h> | ||
| 53 | #include <mach/gpio.h> | ||
| 54 | #include <linux/serial_core.h> | ||
| 55 | #include <linux/tegra_uart.h> | ||
| 56 | |||
| 57 | #include <net/bluetooth/bluetooth.h> | ||
| 58 | #include <net/bluetooth/hci_core.h> /* event notifications */ | ||
| 59 | #include "hci_uart.h" | ||
| 60 | |||
| 61 | /* | ||
| 62 | * Defines | ||
| 63 | */ | ||
| 64 | |||
| 65 | #define VERSION "1.1" | ||
| 66 | |||
| 67 | #define POLARITY_LOW 0 | ||
| 68 | #define POLARITY_HIGH 1 | ||
| 69 | |||
| 70 | struct bluesleep_info { | ||
| 71 | unsigned host_wake_irq; | ||
| 72 | struct uart_port *uport; | ||
| 73 | struct wake_lock wake_lock; | ||
| 74 | int irq_polarity; | ||
| 75 | int has_ext_wake; | ||
| 76 | }; | ||
| 77 | |||
| 78 | |||
| 79 | /* state variable names and bit positions */ | ||
| 80 | #define FLAG_RESET 0x00 | ||
| 81 | #define BT_ACTIVE 0x02 | ||
| 82 | #define BT_SUSPEND 0x04 | ||
| 83 | |||
| 84 | |||
| 85 | /* work function */ | ||
| 86 | static void hostwake_sleep_work(struct work_struct *work); | ||
| 87 | |||
| 88 | /* work queue */ | ||
| 89 | DECLARE_DELAYED_WORK(ti_sleep_workqueue, hostwake_sleep_work); | ||
| 90 | |||
| 91 | /* Macros for handling sleep work */ | ||
| 92 | #define hostwake_workqueue() schedule_delayed_work(&ti_sleep_workqueue, 0) | ||
| 93 | |||
| 94 | static struct bluesleep_info *bsi; | ||
| 95 | |||
| 96 | /* module usage */ | ||
| 97 | static atomic_t open_count = ATOMIC_INIT(1); | ||
| 98 | |||
| 99 | /* | ||
| 100 | * Global variables | ||
| 101 | */ | ||
| 102 | /** Global state flags */ | ||
| 103 | static unsigned long flags; | ||
| 104 | |||
| 105 | /** Tasklet to respond to change in hostwake line */ | ||
| 106 | static struct tasklet_struct hostwake_task; | ||
| 107 | |||
| 108 | /** Lock for state transitions */ | ||
| 109 | static spinlock_t rw_lock; | ||
| 110 | |||
| 111 | /* | ||
| 112 | * Local functions | ||
| 113 | */ | ||
| 114 | static void hsuart_power(int on) | ||
| 115 | { | ||
| 116 | pr_debug("%s", __func__); | ||
| 117 | |||
| 118 | if (on) { | ||
| 119 | tegra_uart_request_clock_on(bsi->uport); | ||
| 120 | tegra_uart_set_mctrl(bsi->uport, TIOCM_RTS); | ||
| 121 | } else { | ||
| 122 | tegra_uart_set_mctrl(bsi->uport, 0); | ||
| 123 | tegra_uart_request_clock_off(bsi->uport); | ||
| 124 | } | ||
| 125 | } | ||
| 126 | |||
| 127 | |||
| 128 | |||
| 129 | /** | ||
| 130 | * @brief@ main sleep work handling function which update the flags | ||
| 131 | * and activate and deactivate UART . | ||
| 132 | */ | ||
| 133 | |||
| 134 | static void hostwake_sleep_work(struct work_struct *work) | ||
| 135 | { | ||
| 136 | pr_debug("%s", __func__); | ||
| 137 | free_irq(bsi->host_wake_irq, "tibluesleep"); | ||
| 138 | /*Activating UART */ | ||
| 139 | if (test_bit(BT_SUSPEND, &flags)) { | ||
| 140 | BT_DBG("Activate UART"); | ||
| 141 | hsuart_power(1); | ||
| 142 | |||
| 143 | } | ||
| 144 | bsi->has_ext_wake = 0; | ||
| 145 | clear_bit(BT_SUSPEND, &flags); | ||
| 146 | set_bit(BT_ACTIVE, &flags); | ||
| 147 | |||
| 148 | } | ||
| 149 | |||
| 150 | |||
| 151 | /** | ||
| 152 | * A tasklet function that runs in tasklet context | ||
| 153 | * @param data Not used. | ||
| 154 | */ | ||
| 155 | static void bluesleep_hostwake_task(unsigned long data) | ||
| 156 | { | ||
| 157 | pr_debug("%s", __func__); | ||
| 158 | disable_irq(bsi->host_wake_irq); | ||
| 159 | spin_lock(&rw_lock); | ||
| 160 | hostwake_workqueue(); | ||
| 161 | spin_unlock(&rw_lock); | ||
| 162 | } | ||
| 163 | |||
| 164 | |||
| 165 | /** | ||
| 166 | * Schedules a tasklet to run when receiving an interrupt on the | ||
| 167 | * <code>HOST_WAKE</code> GPIO pin. | ||
| 168 | * @param irq Not used. | ||
| 169 | * @param dev_id Not used. | ||
| 170 | */ | ||
| 171 | static irqreturn_t bluesleep_hostwake_isr(int irq, void *dev_id) | ||
| 172 | { | ||
| 173 | |||
| 174 | pr_debug("%s", __func__); | ||
| 175 | /* schedule a tasklet to handle the change in the host wake line */ | ||
| 176 | bsi->has_ext_wake = 1; | ||
| 177 | tasklet_schedule(&hostwake_task); | ||
| 178 | return IRQ_HANDLED; | ||
| 179 | } | ||
| 180 | |||
| 181 | /** | ||
| 182 | * Starts the Sleep-Mode Protocol on the Host. | ||
| 183 | * @return On success, 0. On error, -1, and <code>errno</code> is set | ||
| 184 | * appropriately. | ||
| 185 | */ | ||
| 186 | |||
| 187 | int bluesleep_start(struct uart_port *uport) | ||
| 188 | { | ||
| 189 | int retval; | ||
| 190 | bsi->uport = uport; | ||
| 191 | pr_debug("%s", __func__); | ||
| 192 | |||
| 193 | if (test_bit(BT_SUSPEND, &flags)) { | ||
| 194 | BT_DBG("bluesleep_acquire irq"); | ||
| 195 | if (bsi->irq_polarity == POLARITY_LOW) { | ||
| 196 | retval = request_irq(bsi->host_wake_irq, bluesleep_hostwake_isr, | ||
| 197 | IRQF_DISABLED | IRQF_TRIGGER_FALLING, | ||
| 198 | "bluetooth hostwake", "tibluesleep"); | ||
| 199 | } else { | ||
| 200 | retval = request_irq(bsi->host_wake_irq, bluesleep_hostwake_isr, | ||
| 201 | IRQF_DISABLED | IRQF_TRIGGER_RISING, | ||
| 202 | "bluetooth hostwake", "tibluesleep"); | ||
| 203 | } | ||
| 204 | if (retval < 0) { | ||
| 205 | BT_ERR("Couldn't acquire BT_HOST_WAKE IRQ"); | ||
| 206 | goto fail; | ||
| 207 | } | ||
| 208 | |||
| 209 | retval = enable_irq_wake(bsi->host_wake_irq); | ||
| 210 | if (retval < 0) { | ||
| 211 | BT_ERR("Couldn't enable BT_HOST_WAKE as wakeup" | ||
| 212 | "interrupt retval %d\n", retval); | ||
| 213 | free_irq(bsi->host_wake_irq, NULL); | ||
| 214 | goto fail; | ||
| 215 | } | ||
| 216 | } | ||
| 217 | |||
| 218 | return 0; | ||
| 219 | fail: | ||
| 220 | atomic_inc(&open_count); | ||
| 221 | return retval; | ||
| 222 | } | ||
| 223 | |||
| 224 | /** | ||
| 225 | * Stops the Sleep-Mode Protocol on the Host. | ||
| 226 | */ | ||
| 227 | void bluesleep_stop(void) | ||
| 228 | { | ||
| 229 | |||
| 230 | pr_debug("%s", __func__); | ||
| 231 | |||
| 232 | if (disable_irq_wake(bsi->host_wake_irq)) | ||
| 233 | BT_ERR("Couldn't disable hostwake IRQ wakeup mode\n"); | ||
| 234 | |||
| 235 | free_irq(bsi->host_wake_irq, NULL); | ||
| 236 | } | ||
| 237 | |||
| 238 | static int bluesleep_probe(struct platform_device *pdev) | ||
| 239 | { | ||
| 240 | int ret; | ||
| 241 | struct resource *res; | ||
| 242 | |||
| 243 | bsi = kzalloc(sizeof(struct bluesleep_info), GFP_KERNEL); | ||
| 244 | if (!bsi) | ||
| 245 | return -ENOMEM; | ||
| 246 | |||
| 247 | res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, | ||
| 248 | "host_wake"); | ||
| 249 | if (!res) { | ||
| 250 | BT_ERR("couldn't find host_wake irq\n"); | ||
| 251 | ret = -ENODEV; | ||
| 252 | goto free_bsi; | ||
| 253 | } | ||
| 254 | |||
| 255 | bsi->host_wake_irq = res->start; | ||
| 256 | |||
| 257 | if (bsi->host_wake_irq < 0) { | ||
| 258 | BT_ERR("couldn't find host_wake irq"); | ||
| 259 | ret = -ENODEV; | ||
| 260 | goto free_bsi; | ||
| 261 | } | ||
| 262 | if (res->flags & IORESOURCE_IRQ_LOWEDGE) | ||
| 263 | bsi->irq_polarity = POLARITY_LOW;/*low edge (falling edge)*/ | ||
| 264 | else | ||
| 265 | bsi->irq_polarity = POLARITY_HIGH;/*anything else*/ | ||
| 266 | |||
| 267 | wake_lock_init(&bsi->wake_lock, WAKE_LOCK_SUSPEND, "bluesleep"); | ||
| 268 | clear_bit(BT_SUSPEND, &flags); | ||
| 269 | set_bit(BT_ACTIVE, &flags); | ||
| 270 | |||
| 271 | return 0; | ||
| 272 | |||
| 273 | free_bsi: | ||
| 274 | kfree(bsi); | ||
| 275 | return ret; | ||
| 276 | } | ||
| 277 | |||
| 278 | static int bluesleep_remove(struct platform_device *pdev) | ||
| 279 | { | ||
| 280 | pr_debug("%s", __func__); | ||
| 281 | kfree(bsi); | ||
| 282 | return 0; | ||
| 283 | } | ||
| 284 | |||
| 285 | |||
| 286 | static int bluesleep_resume(struct platform_device *pdev) | ||
| 287 | { | ||
| 288 | |||
| 289 | pr_debug("%s", __func__); | ||
| 290 | if (test_bit(BT_SUSPEND, &flags)) { | ||
| 291 | |||
| 292 | if ((bsi->uport != NULL) && (bsi->has_ext_wake)) { | ||
| 293 | tegra_uart_request_clock_on(bsi->uport); | ||
| 294 | tegra_uart_set_mctrl(bsi->uport, TIOCM_RTS); | ||
| 295 | } | ||
| 296 | clear_bit(BT_SUSPEND, &flags); | ||
| 297 | set_bit(BT_ACTIVE, &flags); | ||
| 298 | } | ||
| 299 | |||
| 300 | return 0; | ||
| 301 | } | ||
| 302 | |||
| 303 | static int bluesleep_suspend(struct platform_device *pdev, pm_message_t state) | ||
| 304 | { | ||
| 305 | pr_debug("%s", __func__); | ||
| 306 | set_bit(BT_SUSPEND, &flags); | ||
| 307 | return 0; | ||
| 308 | } | ||
| 309 | |||
| 310 | static struct platform_driver bluesleep_driver = { | ||
| 311 | .probe = bluesleep_probe, | ||
| 312 | .remove = bluesleep_remove, | ||
| 313 | .suspend = bluesleep_suspend, | ||
| 314 | .resume = bluesleep_resume, | ||
| 315 | .driver = { | ||
| 316 | .name = "tibluesleep", | ||
| 317 | .owner = THIS_MODULE, | ||
| 318 | }, | ||
| 319 | }; | ||
| 320 | /** | ||
| 321 | * Initializes the module. | ||
| 322 | * @return On success, 0. On error, -1, and <code>errno</code> is set | ||
| 323 | * appropriately. | ||
| 324 | */ | ||
| 325 | static int __init bluesleep_init(void) | ||
| 326 | { | ||
| 327 | int retval; | ||
| 328 | |||
| 329 | BT_INFO("BlueSleep Mode Driver Ver %s", VERSION); | ||
| 330 | |||
| 331 | retval = platform_driver_register(&bluesleep_driver); | ||
| 332 | if (retval) | ||
| 333 | goto fail; | ||
| 334 | |||
| 335 | if (bsi == NULL) | ||
| 336 | return 0; | ||
| 337 | |||
| 338 | flags = FLAG_RESET; /* clear all status bits */ | ||
| 339 | |||
| 340 | /* Initialize spinlock. */ | ||
| 341 | spin_lock_init(&rw_lock); | ||
| 342 | |||
| 343 | /* initialize host wake tasklet */ | ||
| 344 | tasklet_init(&hostwake_task, bluesleep_hostwake_task, 0); | ||
| 345 | |||
| 346 | return 0; | ||
| 347 | fail: | ||
| 348 | return retval; | ||
| 349 | } | ||
| 350 | |||
| 351 | /** | ||
| 352 | * Cleans up the module. | ||
| 353 | */ | ||
| 354 | |||
| 355 | static void __exit bluesleep_exit(void) | ||
| 356 | { | ||
| 357 | if (bsi == NULL) | ||
| 358 | return; | ||
| 359 | /* assert bt wake */ | ||
| 360 | free_irq(bsi->host_wake_irq, NULL); | ||
| 361 | platform_driver_unregister(&bluesleep_driver); | ||
| 362 | |||
| 363 | } | ||
| 364 | |||
| 365 | module_init(bluesleep_init); | ||
| 366 | module_exit(bluesleep_exit); | ||
| 367 | |||
| 368 | MODULE_DESCRIPTION("TI Bluetooth Sleep Mode Driver ver %s " VERSION); | ||
| 369 | #ifdef MODULE_LICENSE | ||
| 370 | MODULE_LICENSE("GPL"); | ||
| 371 | #endif | ||
