platform-drivers: move probe to .devinit.text in arch/arm
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / arch / arm / mach-s3c2410 / h1940-bluetooth.c
bloba3f3c7b1ca3877fdeb5afe4ea922d9c3e57c4283
1 /*
2 * arch/arm/mach-s3c2410/h1940-bluetooth.c
3 * Copyright (c) Arnaud Patard <arnaud.patard@rtp-net.org>
5 * This file is subject to the terms and conditions of the GNU General Public
6 * License. See the file COPYING in the main directory of this archive for
7 * more details.
9 * S3C2410 bluetooth "driver"
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/delay.h>
16 #include <linux/string.h>
17 #include <linux/ctype.h>
18 #include <linux/leds.h>
19 #include <linux/gpio.h>
20 #include <linux/rfkill.h>
22 #include <mach/regs-gpio.h>
23 #include <mach/hardware.h>
24 #include <mach/h1940-latch.h>
26 #define DRV_NAME "h1940-bt"
28 /* Bluetooth control */
29 static void h1940bt_enable(int on)
31 if (on) {
32 /* Power on the chip */
33 h1940_latch_control(0, H1940_LATCH_BLUETOOTH_POWER);
34 /* Reset the chip */
35 mdelay(10);
36 s3c2410_gpio_setpin(S3C2410_GPH(1), 1);
37 mdelay(10);
38 s3c2410_gpio_setpin(S3C2410_GPH(1), 0);
40 else {
41 s3c2410_gpio_setpin(S3C2410_GPH(1), 1);
42 mdelay(10);
43 s3c2410_gpio_setpin(S3C2410_GPH(1), 0);
44 mdelay(10);
45 h1940_latch_control(H1940_LATCH_BLUETOOTH_POWER, 0);
49 static int h1940bt_set_block(void *data, bool blocked)
51 h1940bt_enable(!blocked);
52 return 0;
55 static const struct rfkill_ops h1940bt_rfkill_ops = {
56 .set_block = h1940bt_set_block,
59 static int __devinit h1940bt_probe(struct platform_device *pdev)
61 struct rfkill *rfk;
62 int ret = 0;
64 /* Configures BT serial port GPIOs */
65 s3c2410_gpio_cfgpin(S3C2410_GPH(0), S3C2410_GPH0_nCTS0);
66 s3c2410_gpio_pullup(S3C2410_GPH(0), 1);
67 s3c2410_gpio_cfgpin(S3C2410_GPH(1), S3C2410_GPIO_OUTPUT);
68 s3c2410_gpio_pullup(S3C2410_GPH(1), 1);
69 s3c2410_gpio_cfgpin(S3C2410_GPH(2), S3C2410_GPH2_TXD0);
70 s3c2410_gpio_pullup(S3C2410_GPH(2), 1);
71 s3c2410_gpio_cfgpin(S3C2410_GPH(3), S3C2410_GPH3_RXD0);
72 s3c2410_gpio_pullup(S3C2410_GPH(3), 1);
75 rfk = rfkill_alloc(DRV_NAME, &pdev->dev, RFKILL_TYPE_BLUETOOTH,
76 &h1940bt_rfkill_ops, NULL);
77 if (!rfk) {
78 ret = -ENOMEM;
79 goto err_rfk_alloc;
82 rfkill_set_led_trigger_name(rfk, "h1940-bluetooth");
84 ret = rfkill_register(rfk);
85 if (ret)
86 goto err_rfkill;
88 platform_set_drvdata(pdev, rfk);
90 return 0;
92 err_rfkill:
93 rfkill_destroy(rfk);
94 err_rfk_alloc:
95 return ret;
98 static int h1940bt_remove(struct platform_device *pdev)
100 struct rfkill *rfk = platform_get_drvdata(pdev);
102 platform_set_drvdata(pdev, NULL);
104 if (rfk) {
105 rfkill_unregister(rfk);
106 rfkill_destroy(rfk);
108 rfk = NULL;
110 h1940bt_enable(0);
112 return 0;
116 static struct platform_driver h1940bt_driver = {
117 .driver = {
118 .name = DRV_NAME,
120 .probe = h1940bt_probe,
121 .remove = h1940bt_remove,
125 static int __init h1940bt_init(void)
127 return platform_driver_register(&h1940bt_driver);
130 static void __exit h1940bt_exit(void)
132 platform_driver_unregister(&h1940bt_driver);
135 module_init(h1940bt_init);
136 module_exit(h1940bt_exit);
138 MODULE_AUTHOR("Arnaud Patard <arnaud.patard@rtp-net.org>");
139 MODULE_DESCRIPTION("Driver for the iPAQ H1940 bluetooth chip");
140 MODULE_LICENSE("GPL");