/arch/arm/mach-msm/board-sapphire-rfkill.c

https://github.com/AICP/kernel_google_msm · C · 105 lines · 71 code · 19 blank · 15 comment · 4 complexity · 7c5b6a7bdaca5294c5a001dcec615a43 MD5 · raw file 

    

  1. /* linux/arch/arm/mach-msm/board-sapphire-rfkill.c
    2. 

  2.  * Copyright (C) 2007-2009 HTC Corporation.
    3. 

  3.  * Author: Thomas Tsai <thomas_tsai@htc.com>
    4. 

  4.  *
    5. 

  5.  * This software is licensed under the terms of the GNU General Public
    6. 

  6.  * License version 2, as published by the Free Software Foundation, and
    7. 

  7.  * may be copied, distributed, and modified under those terms.
    8. 

  8.  *
    9. 

  9.  * This program is distributed in the hope that it will be useful,
    10. 

  10.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
    11. 

  11.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    12. 

  12.  * GNU General Public License for more details.
    13. 

  13. */
    14. 

  14. 

  15. /* Control bluetooth power for sapphire platform */
    16. 

  16. 

  17. #include <linux/platform_device.h>
    18. 

  18. #include <linux/module.h>
    19. 

  19. #include <linux/device.h>
    20. 

  20. #include <linux/rfkill.h>
    21. 

  21. #include <linux/delay.h>
    22. 

  22. #include <linux/gpio.h>
    23. 

  23. #include <asm/mach-types.h>
    24. 

  24. #include "gpio_chip.h"
    25. 

  25. #include "board-sapphire.h"
    26. 

  26. 

  27. static struct rfkill *bt_rfk;
    28. 

  28. static const char bt_name[] = "brf6300";
    29. 

  29. 

  30. extern int sapphire_bt_fastclock_power(int on);
    31. 

  31. 

  32. static int bluetooth_set_power(void *data, bool blocked)
    33. 

  33. {
    34. 

  34. 	if (!blocked) {
    35. 

  35. 		sapphire_bt_fastclock_power(1);
    36. 

  36. 		gpio_set_value(SAPPHIRE_GPIO_BT_32K_EN, 1);
    37. 

  37. 		udelay(10);
    38. 

  38. 		gpio_direction_output(101, 1);
    39. 

  39. 	} else {
    40. 

  40. 		gpio_direction_output(101, 0);
    41. 

  41. 		gpio_set_value(SAPPHIRE_GPIO_BT_32K_EN, 0);
    42. 

  42. 		sapphire_bt_fastclock_power(0);
    43. 

  43. 	}
    44. 

  44. 	return 0;
    45. 

  45. }
    46. 

  46. 

  47. static struct rfkill_ops sapphire_rfkill_ops = {
    48. 

  48. 	.set_block = bluetooth_set_power,
    49. 

  49. };
    50. 

  50. 

  51. static int sapphire_rfkill_probe(struct platform_device *pdev)
    52. 

  52. {
    53. 

  53. 	int rc = 0;
    54. 

  54. 	bool default_state = true;  /* off */
    55. 

  55. 

  56. 	bluetooth_set_power(NULL, default_state);
    57. 

  57. 

  58. 	bt_rfk = rfkill_alloc(bt_name, &pdev->dev, RFKILL_TYPE_BLUETOOTH,
    59. 

  59. 			      &sapphire_rfkill_ops, NULL);
    60. 

  60. 	if (!bt_rfk)
    61. 

  61. 		return -ENOMEM;
    62. 

  62. 

  63. 	/* userspace cannot take exclusive control */
    64. 

  64. 

  65. 	rfkill_set_states(bt_rfk, default_state, false);
    66. 

  66. 

  67. 	rc = rfkill_register(bt_rfk);
    68. 

  68. 

  69. 	if (rc)
    70. 

  70. 		rfkill_destroy(bt_rfk);
    71. 

  71. 	return rc;
    72. 

  72. }
    73. 

  73. 

  74. static int sapphire_rfkill_remove(struct platform_device *dev)
    75. 

  75. {
    76. 

  76. 	rfkill_unregister(bt_rfk);
    77. 

  77. 	rfkill_destroy(bt_rfk);
    78. 

  78. 

  79. 	return 0;
    80. 

  80. }
    81. 

  81. 

  82. static struct platform_driver sapphire_rfkill_driver = {
    83. 

  83. 	.probe = sapphire_rfkill_probe,
    84. 

  84. 	.remove = sapphire_rfkill_remove,
    85. 

  85. 	.driver = {
    86. 

  86. 		.name = "sapphire_rfkill",
    87. 

  87. 		.owner = THIS_MODULE,
    88. 

  88. 	},
    89. 

  89. };
    90. 

  90. 

  91. static int __init sapphire_rfkill_init(void)
    92. 

  92. {
    93. 

  93. 	return platform_driver_register(&sapphire_rfkill_driver);
    94. 

  94. }
    95. 

  95. 

  96. static void __exit sapphire_rfkill_exit(void)
    97. 

  97. {
    98. 

  98. 	platform_driver_unregister(&sapphire_rfkill_driver);
    99. 

  99. }
    100. 

  100. 

  101. module_init(sapphire_rfkill_init);
    102. 

  102. module_exit(sapphire_rfkill_exit);
    103. 

  103. MODULE_DESCRIPTION("sapphire rfkill");
    104. 

  104. MODULE_AUTHOR("Nick Pelly <npelly@google.com>");
    105. 

  105. MODULE_LICENSE("GPL");
    106.