Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Bluetooth built-in chip control |
| 3 | * |
| 4 | * Copyright (c) 2008 Dmitry Baryshkov |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License version 2 as |
| 8 | * published by the Free Software Foundation. |
| 9 | * |
| 10 | */ |
| 11 | |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/module.h> |
| 14 | #include <linux/platform_device.h> |
| 15 | #include <linux/gpio.h> |
| 16 | #include <linux/delay.h> |
| 17 | #include <linux/rfkill.h> |
| 18 | |
Arnd Bergmann | 4c25c5d | 2015-01-30 10:45:33 +0100 | [diff] [blame] | 19 | #include "tosa_bt.h" |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 20 | |
| 21 | static void tosa_bt_on(struct tosa_bt_data *data) |
| 22 | { |
| 23 | gpio_set_value(data->gpio_reset, 0); |
| 24 | gpio_set_value(data->gpio_pwr, 1); |
| 25 | gpio_set_value(data->gpio_reset, 1); |
| 26 | mdelay(20); |
| 27 | gpio_set_value(data->gpio_reset, 0); |
| 28 | } |
| 29 | |
| 30 | static void tosa_bt_off(struct tosa_bt_data *data) |
| 31 | { |
| 32 | gpio_set_value(data->gpio_reset, 1); |
| 33 | mdelay(10); |
| 34 | gpio_set_value(data->gpio_pwr, 0); |
| 35 | gpio_set_value(data->gpio_reset, 0); |
| 36 | } |
| 37 | |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 38 | static int tosa_bt_set_block(void *data, bool blocked) |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 39 | { |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 40 | pr_info("BT_RADIO going: %s\n", blocked ? "off" : "on"); |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 41 | |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 42 | if (!blocked) { |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 43 | pr_info("TOSA_BT: going ON\n"); |
| 44 | tosa_bt_on(data); |
| 45 | } else { |
| 46 | pr_info("TOSA_BT: going OFF\n"); |
| 47 | tosa_bt_off(data); |
| 48 | } |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 49 | |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 50 | return 0; |
| 51 | } |
| 52 | |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 53 | static const struct rfkill_ops tosa_bt_rfkill_ops = { |
| 54 | .set_block = tosa_bt_set_block, |
| 55 | }; |
| 56 | |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 57 | static int tosa_bt_probe(struct platform_device *dev) |
| 58 | { |
| 59 | int rc; |
| 60 | struct rfkill *rfk; |
| 61 | |
| 62 | struct tosa_bt_data *data = dev->dev.platform_data; |
| 63 | |
| 64 | rc = gpio_request(data->gpio_reset, "Bluetooth reset"); |
| 65 | if (rc) |
| 66 | goto err_reset; |
| 67 | rc = gpio_direction_output(data->gpio_reset, 0); |
| 68 | if (rc) |
| 69 | goto err_reset_dir; |
| 70 | rc = gpio_request(data->gpio_pwr, "Bluetooth power"); |
| 71 | if (rc) |
| 72 | goto err_pwr; |
| 73 | rc = gpio_direction_output(data->gpio_pwr, 0); |
| 74 | if (rc) |
| 75 | goto err_pwr_dir; |
| 76 | |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 77 | rfk = rfkill_alloc("tosa-bt", &dev->dev, RFKILL_TYPE_BLUETOOTH, |
| 78 | &tosa_bt_rfkill_ops, data); |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 79 | if (!rfk) { |
| 80 | rc = -ENOMEM; |
| 81 | goto err_rfk_alloc; |
| 82 | } |
| 83 | |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 84 | rc = rfkill_register(rfk); |
| 85 | if (rc) |
| 86 | goto err_rfkill; |
| 87 | |
| 88 | platform_set_drvdata(dev, rfk); |
| 89 | |
| 90 | return 0; |
| 91 | |
| 92 | err_rfkill: |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 93 | rfkill_destroy(rfk); |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 94 | err_rfk_alloc: |
| 95 | tosa_bt_off(data); |
| 96 | err_pwr_dir: |
| 97 | gpio_free(data->gpio_pwr); |
| 98 | err_pwr: |
| 99 | err_reset_dir: |
| 100 | gpio_free(data->gpio_reset); |
| 101 | err_reset: |
| 102 | return rc; |
| 103 | } |
| 104 | |
Greg Kroah-Hartman | 351a102 | 2012-12-21 14:02:24 -0800 | [diff] [blame] | 105 | static int tosa_bt_remove(struct platform_device *dev) |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 106 | { |
| 107 | struct tosa_bt_data *data = dev->dev.platform_data; |
| 108 | struct rfkill *rfk = platform_get_drvdata(dev); |
| 109 | |
| 110 | platform_set_drvdata(dev, NULL); |
| 111 | |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 112 | if (rfk) { |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 113 | rfkill_unregister(rfk); |
Johannes Berg | 19d337d | 2009-06-02 13:01:37 +0200 | [diff] [blame] | 114 | rfkill_destroy(rfk); |
| 115 | } |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 116 | rfk = NULL; |
| 117 | |
| 118 | tosa_bt_off(data); |
| 119 | |
| 120 | gpio_free(data->gpio_pwr); |
| 121 | gpio_free(data->gpio_reset); |
| 122 | |
| 123 | return 0; |
| 124 | } |
| 125 | |
| 126 | static struct platform_driver tosa_bt_driver = { |
| 127 | .probe = tosa_bt_probe, |
Greg Kroah-Hartman | 351a102 | 2012-12-21 14:02:24 -0800 | [diff] [blame] | 128 | .remove = tosa_bt_remove, |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 129 | |
| 130 | .driver = { |
| 131 | .name = "tosa-bt", |
Dmitry Baryshkov | 16b32fd | 2008-07-05 09:02:48 +0100 | [diff] [blame] | 132 | }, |
| 133 | }; |
Vaishali Thakkar | 9754c8e | 2015-07-03 17:40:45 +0530 | [diff] [blame] | 134 | module_platform_driver(tosa_bt_driver); |