1 /*
2 * Copyright (C) 2012 ROCKCHIP, Inc.
3 *
4 * This software is licensed under the terms of the GNU General Public
5 * License version 2, as published by the Free Software Foundation, and
6 * may be copied, distributed, and modified under those terms.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 *
13 */
14 /* Rock-chips rfkill driver for bluetooth
15 *
16 */
17
18 #include <linux/kernel.h>
19 #include <linux/platform_device.h>
20 #include <linux/module.h>
21 #include <linux/rfkill.h>
22 #include <linux/init.h>
23 #include <linux/slab.h>
24 #include <linux/delay.h>
25 #include <linux/rfkill-bt.h>
26 #include <linux/rfkill-wlan.h>
27 #include <linux/wakelock.h>
28 #include <linux/interrupt.h>
29 #include <asm/irq.h>
30 #include <linux/suspend.h>
31 #include <linux/proc_fs.h>
32 #include <linux/uaccess.h>
33 #include <linux/gpio.h>
34 #include <linux/fs.h>
35 #include <dt-bindings/gpio/gpio.h>
36 #include <uapi/linux/rfkill.h>
37 #ifdef CONFIG_OF
38 #include <linux/of.h>
39 #include <linux/of_device.h>
40 #include <linux/of_gpio.h>
41 #endif
42
43 #if 0
44 #define DBG(x...) pr_info("[BT_RFKILL]: " x)
45 #else
46 #define DBG(x...)
47 #endif
48
49 #define LOG(x...) pr_info("[BT_RFKILL]: " x)
50
51 #define BT_WAKEUP_TIMEOUT 10000
52 #define BT_IRQ_WAKELOCK_TIMEOUT (10 * 1000)
53
54 #define BT_BLOCKED true
55 #define BT_UNBLOCK false
56 #define BT_SLEEP true
57 #define BT_WAKEUP false
58
59 enum {
60 IOMUX_FNORMAL = 0,
61 IOMUX_FGPIO,
62 IOMUX_FMUX,
63 };
64
65 struct rfkill_rk_data {
66 struct rfkill_rk_platform_data *pdata;
67 struct platform_device *pdev;
68 struct rfkill *rfkill_dev;
69 struct wake_lock bt_irq_wl;
70 struct delayed_work bt_sleep_delay_work;
71 int irq_req;
72 };
73
74 static struct rfkill_rk_data *g_rfkill = NULL;
75
76 static const char bt_name[] =
77 #if defined(CONFIG_BCM4330)
78 #if defined(CONFIG_BT_MODULE_NH660)
79 "nh660"
80 #else
81 "bcm4330"
82 #endif
83 #elif defined(CONFIG_RK903)
84 #if defined(CONFIG_RKWIFI_26M)
85 "rk903_26M"
86 #else
87 "rk903"
88 #endif
89 #elif defined(CONFIG_BCM4329)
90 "bcm4329"
91 #elif defined(CONFIG_MV8787)
92 "mv8787"
93 #elif defined(CONFIG_AP6210)
94 #if defined(CONFIG_RKWIFI_26M)
95 "ap6210"
96 #else
97 "ap6210_24M"
98 #endif
99 #elif defined(CONFIG_AP6330)
100 "ap6330"
101 #elif defined(CONFIG_AP6476)
102 "ap6476"
103 #elif defined(CONFIG_AP6493)
104 "ap6493"
105 #elif defined(CONFIG_AP6441)
106 "ap6441"
107 #elif defined(CONFIG_AP6335)
108 "ap6335"
109 #elif defined(CONFIG_GB86302I)
110 "gb86302i"
111 #else
112 "bt_default"
113 #endif
114 ;
115
rfkill_rk_wake_host_irq(int irq,void * dev)116 static irqreturn_t rfkill_rk_wake_host_irq(int irq, void *dev)
117 {
118 struct rfkill_rk_data *rfkill = dev;
119
120 LOG("BT_WAKE_HOST IRQ fired\n");
121
122 DBG("BT IRQ wakeup, request %dms wakelock\n", BT_IRQ_WAKELOCK_TIMEOUT);
123
124 wake_lock_timeout(&rfkill->bt_irq_wl,
125 msecs_to_jiffies(BT_IRQ_WAKELOCK_TIMEOUT));
126
127 return IRQ_HANDLED;
128 }
129
rfkill_rk_setup_gpio(struct platform_device * pdev,struct rfkill_rk_gpio * gpio,const char * prefix,const char * name)130 static int rfkill_rk_setup_gpio(struct platform_device *pdev,
131 struct rfkill_rk_gpio *gpio, const char *prefix,
132 const char *name)
133 {
134 if (gpio_is_valid(gpio->io)) {
135 int ret = 0;
136
137 sprintf(gpio->name, "%s_%s", prefix, name);
138 ret = devm_gpio_request(&pdev->dev, gpio->io, gpio->name);
139 if (ret) {
140 LOG("Failed to get %s gpio.\n", gpio->name);
141 return -1;
142 }
143 }
144
145 return 0;
146 }
147
rfkill_rk_setup_wake_irq(struct rfkill_rk_data * rfkill,int flag)148 static int rfkill_rk_setup_wake_irq(struct rfkill_rk_data *rfkill, int flag)
149 {
150 int ret = 0;
151 struct rfkill_rk_irq *irq = &rfkill->pdata->wake_host_irq;
152
153 if (!flag) {
154 rfkill->irq_req = 0;
155 ret = rfkill_rk_setup_gpio(rfkill->pdev, &irq->gpio,
156 rfkill->pdata->name, "wake_host");
157 if (ret)
158 goto fail1;
159 }
160 if (gpio_is_valid(irq->gpio.io)) {
161 if (rfkill->irq_req) {
162 rfkill->irq_req = 0;
163 free_irq(irq->irq, rfkill);
164 }
165 LOG("Request irq for bt wakeup host\n");
166 irq->irq = gpio_to_irq(irq->gpio.io);
167 sprintf(irq->name, "%s_irq", irq->gpio.name);
168 ret = request_irq(irq->irq, rfkill_rk_wake_host_irq,
169 (irq->gpio.enable == GPIO_ACTIVE_LOW) ?
170 IRQF_TRIGGER_FALLING :
171 IRQF_TRIGGER_RISING,
172 irq->name, rfkill);
173 if (ret)
174 goto fail2;
175 rfkill->irq_req = 1;
176 LOG("** disable irq\n");
177 disable_irq(irq->irq);
178 ret = enable_irq_wake(irq->irq);
179 if (ret)
180 goto fail3;
181 }
182
183 return ret;
184
185 fail3:
186 free_irq(irq->irq, rfkill);
187 fail2:
188 gpio_free(irq->gpio.io);
189 fail1:
190 return ret;
191 }
192
rfkill_rk_sleep_bt_internal(struct rfkill_rk_data * rfkill,bool sleep)193 static inline void rfkill_rk_sleep_bt_internal(struct rfkill_rk_data *rfkill,
194 bool sleep)
195 {
196 struct rfkill_rk_gpio *wake = &rfkill->pdata->wake_gpio;
197
198 DBG("*** bt sleep: %d ***\n", sleep);
199 #ifndef CONFIG_BK3515A_COMBO
200 gpio_direction_output(wake->io, sleep ? !wake->enable : wake->enable);
201 #else
202 if (!sleep) {
203 DBG("HOST_UART0_TX pull down 10us\n");
204 if (rfkill_rk_setup_gpio(rfkill->pdev, wake,
205 rfkill->pdata->name, "wake") != 0) {
206 return;
207 }
208
209 gpio_direction_output(wake->io, wake->enable);
210 usleep_range(10, 20);
211 gpio_direction_output(wake->io, !wake->enable);
212
213 gpio_free(wake->io);
214 }
215 #endif
216 }
217
rfkill_rk_delay_sleep_bt(struct work_struct * work)218 static void rfkill_rk_delay_sleep_bt(struct work_struct *work)
219 {
220 struct rfkill_rk_data *rfkill = NULL;
221
222 DBG("Enter %s\n", __func__);
223
224 rfkill = container_of(work, struct rfkill_rk_data,
225 bt_sleep_delay_work.work);
226
227 rfkill_rk_sleep_bt_internal(rfkill, BT_SLEEP);
228 }
229
rfkill_rk_sleep_bt(bool sleep)230 void rfkill_rk_sleep_bt(bool sleep)
231 {
232 struct rfkill_rk_data *rfkill = g_rfkill;
233 struct rfkill_rk_gpio *wake;
234
235 DBG("Enter %s\n", __func__);
236
237 if (!rfkill) {
238 LOG("*** RFKILL is empty???\n");
239 return;
240 }
241
242 wake = &rfkill->pdata->wake_gpio;
243 if (!gpio_is_valid(wake->io)) {
244 DBG("*** Not support bt wakeup and sleep\n");
245 return;
246 }
247
248 cancel_delayed_work_sync(&rfkill->bt_sleep_delay_work);
249
250 rfkill_rk_sleep_bt_internal(rfkill, sleep);
251
252 #ifdef CONFIG_BT_AUTOSLEEP
253 if (sleep == BT_WAKEUP) {
254 schedule_delayed_work(&rfkill->bt_sleep_delay_work,
255 msecs_to_jiffies(BT_WAKEUP_TIMEOUT));
256 }
257 #endif
258 }
259 EXPORT_SYMBOL(rfkill_rk_sleep_bt);
260
261 static int bt_power_state = 0;
rfkill_get_bt_power_state(int * power,bool * toggle)262 int rfkill_get_bt_power_state(int *power, bool *toggle)
263 {
264 struct rfkill_rk_data *mrfkill = g_rfkill;
265
266 if (!mrfkill) {
267 LOG("%s: rfkill-bt driver has not Successful initialized\n",
268 __func__);
269 return -1;
270 }
271
272 *toggle = mrfkill->pdata->power_toggle;
273 *power = bt_power_state;
274
275 return 0;
276 }
277
rfkill_rk_set_power(void * data,bool blocked)278 static int rfkill_rk_set_power(void *data, bool blocked)
279 {
280 struct rfkill_rk_data *rfkill = data;
281 struct rfkill_rk_gpio *wake_host = &rfkill->pdata->wake_host_irq.gpio;
282 struct rfkill_rk_gpio *poweron = &rfkill->pdata->poweron_gpio;
283 struct rfkill_rk_gpio *reset = &rfkill->pdata->reset_gpio;
284 struct rfkill_rk_gpio *rts = &rfkill->pdata->rts_gpio;
285 struct pinctrl *pinctrl = rfkill->pdata->pinctrl;
286 int wifi_power = 0;
287 bool toggle = false;
288
289 DBG("Enter %s\n", __func__);
290
291 DBG("Set blocked:%d\n", blocked);
292
293 toggle = rfkill->pdata->power_toggle;
294
295 if (toggle) {
296 if (rfkill_get_wifi_power_state(&wifi_power)) {
297 LOG("%s: cannot get wifi power state!\n", __func__);
298 return -1;
299 }
300 }
301
302 DBG("%s: toggle = %s\n", __func__, toggle ? "true" : "false");
303
304 if (!blocked) {
305 if (toggle) {
306 rfkill_set_wifi_bt_power(1);
307 msleep(100);
308 }
309
310 rfkill_rk_sleep_bt(BT_WAKEUP); // ensure bt is wakeup
311
312 if (gpio_is_valid(wake_host->io)) {
313 LOG("%s: set bt wake_host high!\n", __func__);
314 gpio_direction_output(wake_host->io, 1);
315 msleep(20);
316 }
317
318 if (gpio_is_valid(poweron->io)) {
319 if (gpio_get_value(poweron->io) == !poweron->enable) {
320 gpio_direction_output(poweron->io,
321 !poweron->enable);
322 msleep(20);
323 gpio_direction_output(poweron->io,
324 poweron->enable);
325 msleep(20);
326 }
327 }
328
329 if (gpio_is_valid(reset->io)) {
330 if (gpio_get_value(reset->io) == !reset->enable) {
331 gpio_direction_output(reset->io,
332 !reset->enable);
333 msleep(20);
334 gpio_direction_output(reset->io, reset->enable);
335 }
336 }
337
338 if (gpio_is_valid(wake_host->io)) {
339 LOG("%s: set bt wake_host input!\n", __func__);
340 gpio_direction_input(wake_host->io);
341 }
342
343 if (pinctrl && gpio_is_valid(rts->io)) {
344 pinctrl_select_state(pinctrl, rts->gpio_state);
345 LOG("ENABLE UART_RTS\n");
346 gpio_direction_output(rts->io, rts->enable);
347 msleep(100);
348 LOG("DISABLE UART_RTS\n");
349 gpio_direction_output(rts->io, !rts->enable);
350 pinctrl_select_state(pinctrl, rts->default_state);
351 }
352
353 bt_power_state = 1;
354 LOG("bt turn on power\n");
355 rfkill_rk_setup_wake_irq(rfkill, 1);
356 } else {
357 if (gpio_is_valid(poweron->io)) {
358 if (gpio_get_value(poweron->io) == poweron->enable) {
359 gpio_direction_output(poweron->io,
360 !poweron->enable);
361 msleep(20);
362 }
363 }
364
365 bt_power_state = 0;
366 LOG("bt shut off power\n");
367 if (gpio_is_valid(reset->io)) {
368 if (gpio_get_value(reset->io) == reset->enable) {
369 gpio_direction_output(reset->io,
370 !reset->enable);
371 msleep(20);
372 }
373 }
374 if (toggle) {
375 if (!wifi_power) {
376 LOG("%s: bt will set vbat to low\n", __func__);
377 rfkill_set_wifi_bt_power(0);
378 } else {
379 LOG("%s: bt shouldn't control the vbat\n", __func__);
380 }
381 }
382 }
383
384 return 0;
385 }
386
rfkill_rk_pm_prepare(struct device * dev)387 static int rfkill_rk_pm_prepare(struct device *dev)
388 {
389 struct rfkill_rk_data *rfkill = g_rfkill;
390 struct rfkill_rk_gpio *rts;
391 struct rfkill_rk_irq *wake_host_irq;
392
393 DBG("Enter %s\n", __func__);
394
395 if (!rfkill)
396 return 0;
397
398 rts = &rfkill->pdata->rts_gpio;
399 wake_host_irq = &rfkill->pdata->wake_host_irq;
400
401 //To prevent uart to receive bt data when suspended
402 if (rfkill->pdata->pinctrl && gpio_is_valid(rts->io)) {
403 DBG("Disable UART_RTS\n");
404 pinctrl_select_state(rfkill->pdata->pinctrl, rts->gpio_state);
405 gpio_direction_output(rts->io, !rts->enable);
406 }
407
408 #ifdef CONFIG_BT_AUTOSLEEP
409 rfkill_rk_sleep_bt(BT_SLEEP);
410 #endif
411
412 // enable bt wakeup host
413 if (gpio_is_valid(wake_host_irq->gpio.io) && bt_power_state) {
414 DBG("enable irq for bt wakeup host\n");
415 enable_irq(wake_host_irq->irq);
416 }
417
418 #ifdef CONFIG_RFKILL_RESET
419 rfkill_init_sw_state(rfkill->rfkill_dev, BT_BLOCKED);
420 rfkill_set_sw_state(rfkill->rfkill_dev, BT_BLOCKED);
421 rfkill_set_hw_state(rfkill->rfkill_dev, false);
422 rfkill_rk_set_power(rfkill, BT_BLOCKED);
423 #endif
424
425 return 0;
426 }
427
rfkill_rk_pm_complete(struct device * dev)428 static void rfkill_rk_pm_complete(struct device *dev)
429 {
430 struct rfkill_rk_data *rfkill = g_rfkill;
431 struct rfkill_rk_irq *wake_host_irq;
432 struct rfkill_rk_gpio *rts;
433
434 DBG("Enter %s\n", __func__);
435
436 if (!rfkill)
437 return;
438
439 wake_host_irq = &rfkill->pdata->wake_host_irq;
440 rts = &rfkill->pdata->rts_gpio;
441
442 if (gpio_is_valid(wake_host_irq->gpio.io) && bt_power_state) {
443 LOG("** disable irq\n");
444 disable_irq(wake_host_irq->irq);
445 }
446
447 if (rfkill->pdata->pinctrl && gpio_is_valid(rts->io)) {
448 DBG("Enable UART_RTS\n");
449 gpio_direction_output(rts->io, rts->enable);
450 pinctrl_select_state(rfkill->pdata->pinctrl, rts->default_state);
451 }
452 }
453
454 static const struct rfkill_ops rfkill_rk_ops = {
455 .set_block = rfkill_rk_set_power,
456 };
457
458 #define PROC_DIR "bluetooth/sleep"
459
460 static struct proc_dir_entry *bluetooth_dir, *sleep_dir;
461
bluesleep_read_proc_lpm(struct file * file,char __user * buffer,size_t count,loff_t * data)462 static ssize_t bluesleep_read_proc_lpm(struct file *file, char __user *buffer,
463 size_t count, loff_t *data)
464 {
465 return sprintf(buffer, "unsupported to read\n");
466 }
467
bluesleep_write_proc_lpm(struct file * file,const char __user * buffer,size_t count,loff_t * data)468 static ssize_t bluesleep_write_proc_lpm(struct file *file,
469 const char __user *buffer, size_t count,
470 loff_t *data)
471 {
472 return count;
473 }
474
bluesleep_read_proc_btwrite(struct file * file,char __user * buffer,size_t count,loff_t * data)475 static ssize_t bluesleep_read_proc_btwrite(struct file *file,
476 char __user *buffer, size_t count,
477 loff_t *data)
478 {
479 return sprintf(buffer, "unsupported to read\n");
480 }
481
bluesleep_write_proc_btwrite(struct file * file,const char __user * buffer,size_t count,loff_t * data)482 static ssize_t bluesleep_write_proc_btwrite(struct file *file,
483 const char __user *buffer,
484 size_t count, loff_t *data)
485 {
486 char b;
487
488 if (count < 1)
489 return -EINVAL;
490
491 if (copy_from_user(&b, buffer, 1))
492 return -EFAULT;
493
494 DBG("btwrite %c\n", b);
495 /* HCI_DEV_WRITE */
496 if (b != '0')
497 rfkill_rk_sleep_bt(BT_WAKEUP);
498 else
499 rfkill_rk_sleep_bt(BT_SLEEP);
500
501 return count;
502 }
503
504 #ifdef CONFIG_OF
bluetooth_platdata_parse_dt(struct device * dev,struct rfkill_rk_platform_data * data)505 static int bluetooth_platdata_parse_dt(struct device *dev,
506 struct rfkill_rk_platform_data *data)
507 {
508 struct device_node *node = dev->of_node;
509 int gpio;
510 enum of_gpio_flags flags;
511
512 if (!node)
513 return -ENODEV;
514
515 memset(data, 0, sizeof(*data));
516
517 if (of_find_property(node, "wifi-bt-power-toggle", NULL)) {
518 data->power_toggle = true;
519 LOG("%s: get property wifi-bt-power-toggle.\n", __func__);
520 } else {
521 data->power_toggle = false;
522 }
523
524 gpio = of_get_named_gpio_flags(node, "uart_rts_gpios", 0, &flags);
525 if (gpio_is_valid(gpio)) {
526 data->rts_gpio.io = gpio;
527 data->rts_gpio.enable = (flags == GPIO_ACTIVE_HIGH) ? 1 : 0;
528 LOG("%s: get property: uart_rts_gpios = %d.\n", __func__, gpio);
529 data->pinctrl = devm_pinctrl_get(dev);
530 if (!IS_ERR(data->pinctrl)) {
531 data->rts_gpio.default_state =
532 pinctrl_lookup_state(data->pinctrl, "default");
533 data->rts_gpio.gpio_state =
534 pinctrl_lookup_state(data->pinctrl, "rts_gpio");
535 } else {
536 data->pinctrl = NULL;
537 LOG("%s: dts does't define the uart rts iomux.\n",
538 __func__);
539 return -EINVAL;
540 }
541 } else {
542 data->pinctrl = NULL;
543 data->rts_gpio.io = -EINVAL;
544 LOG("%s: uart_rts_gpios is no-in-use.\n", __func__);
545 }
546
547 gpio = of_get_named_gpio_flags(node, "BT,power_gpio", 0, &flags);
548 if (gpio_is_valid(gpio)) {
549 data->poweron_gpio.io = gpio;
550 data->poweron_gpio.enable = (flags == GPIO_ACTIVE_HIGH) ? 1 : 0;
551 LOG("%s: get property: BT,power_gpio = %d.\n", __func__, gpio);
552 } else {
553 data->poweron_gpio.io = -1;
554 }
555 gpio = of_get_named_gpio_flags(node, "BT,reset_gpio", 0, &flags);
556 if (gpio_is_valid(gpio)) {
557 data->reset_gpio.io = gpio;
558 data->reset_gpio.enable = (flags == GPIO_ACTIVE_HIGH) ? 1 : 0;
559 LOG("%s: get property: BT,reset_gpio = %d.\n", __func__, gpio);
560 } else {
561 data->reset_gpio.io = -1;
562 }
563 gpio = of_get_named_gpio_flags(node, "BT,wake_gpio", 0, &flags);
564 if (gpio_is_valid(gpio)) {
565 data->wake_gpio.io = gpio;
566 data->wake_gpio.enable = (flags == GPIO_ACTIVE_HIGH) ? 1 : 0;
567 LOG("%s: get property: BT,wake_gpio = %d.\n", __func__, gpio);
568 } else {
569 data->wake_gpio.io = -1;
570 }
571 gpio = of_get_named_gpio_flags(node, "BT,wake_host_irq", 0, &flags);
572 if (gpio_is_valid(gpio)) {
573 data->wake_host_irq.gpio.io = gpio;
574 data->wake_host_irq.gpio.enable = flags;
575 LOG("%s: get property: BT,wake_host_irq = %d.\n", __func__,
576 gpio);
577 } else {
578 data->wake_host_irq.gpio.io = -1;
579 }
580
581 data->ext_clk = devm_clk_get(dev, "ext_clock");
582 if (IS_ERR(data->ext_clk)) {
583 LOG("%s: clk_get failed!!!.\n", __func__);
584 } else {
585 clk_prepare_enable(data->ext_clk);
586 }
587 return 0;
588 }
589 #endif //CONFIG_OF
590
591 static const struct proc_ops bluesleep_lpm = {
592 .proc_read = bluesleep_read_proc_lpm,
593 .proc_write = bluesleep_write_proc_lpm,
594 };
595
596 static const struct proc_ops bluesleep_btwrite = {
597 .proc_read = bluesleep_read_proc_btwrite,
598 .proc_write = bluesleep_write_proc_btwrite,
599 };
600
rfkill_rk_probe(struct platform_device * pdev)601 static int rfkill_rk_probe(struct platform_device *pdev)
602 {
603 struct rfkill_rk_data *rfkill;
604 struct rfkill_rk_platform_data *pdata = pdev->dev.platform_data;
605 int ret = 0;
606 struct proc_dir_entry *ent;
607
608 DBG("Enter %s\n", __func__);
609
610 if (!pdata) {
611 #ifdef CONFIG_OF
612 pdata = devm_kzalloc(&pdev->dev,
613 sizeof(struct rfkill_rk_platform_data),
614 GFP_KERNEL);
615 if (!pdata)
616 return -ENOMEM;
617
618 ret = bluetooth_platdata_parse_dt(&pdev->dev, pdata);
619 if (ret < 0) {
620 #endif
621 LOG("%s: No platform data specified\n", __func__);
622 return ret;
623 #ifdef CONFIG_OF
624 }
625 #endif
626 }
627
628 pdata->name = (char *)bt_name;
629 pdata->type = RFKILL_TYPE_BLUETOOTH;
630
631 rfkill = devm_kzalloc(&pdev->dev, sizeof(*rfkill), GFP_KERNEL);
632 if (!rfkill)
633 return -ENOMEM;
634
635 rfkill->pdata = pdata;
636 rfkill->pdev = pdev;
637 g_rfkill = rfkill;
638
639 bluetooth_dir = proc_mkdir("bluetooth", NULL);
640 if (!bluetooth_dir) {
641 LOG("Unable to create /proc/bluetooth directory");
642 return -ENOMEM;
643 }
644
645 sleep_dir = proc_mkdir("sleep", bluetooth_dir);
646 if (!sleep_dir) {
647 LOG("Unable to create /proc/%s directory", PROC_DIR);
648 return -ENOMEM;
649 }
650
651 /* read/write proc entries */
652 ent = proc_create("lpm", 0444, sleep_dir, &bluesleep_lpm);
653 if (!ent) {
654 LOG("Unable to create /proc/%s/lpm entry", PROC_DIR);
655 ret = -ENOMEM;
656 goto fail_alloc;
657 }
658
659 /* read/write proc entries */
660 ent = proc_create("btwrite", 0444, sleep_dir, &bluesleep_btwrite);
661 if (!ent) {
662 LOG("Unable to create /proc/%s/btwrite entry", PROC_DIR);
663 ret = -ENOMEM;
664 goto fail_alloc;
665 }
666
667 DBG("init gpio\n");
668
669 ret = rfkill_rk_setup_gpio(pdev, &pdata->poweron_gpio, pdata->name,
670 "poweron");
671 if (ret)
672 goto fail_gpio;
673
674 ret = rfkill_rk_setup_gpio(pdev, &pdata->reset_gpio, pdata->name,
675 "reset");
676 if (ret)
677 goto fail_gpio;
678
679 ret = rfkill_rk_setup_gpio(pdev, &pdata->wake_gpio, pdata->name,
680 "wake");
681 if (ret)
682 goto fail_gpio;
683
684 ret = rfkill_rk_setup_gpio(pdev, &pdata->rts_gpio, rfkill->pdata->name,
685 "rts");
686 if (ret)
687 goto fail_gpio;
688
689 wake_lock_init(&rfkill->bt_irq_wl, WAKE_LOCK_SUSPEND,
690 "rfkill_rk_irq_wl");
691
692 ret = rfkill_rk_setup_wake_irq(rfkill, 0);
693 if (ret)
694 goto fail_setup_wake_irq;
695
696 DBG("setup rfkill\n");
697 rfkill->rfkill_dev = rfkill_alloc(pdata->name, &pdev->dev, pdata->type,
698 &rfkill_rk_ops, rfkill);
699 if (!rfkill->rfkill_dev)
700 goto fail_alloc;
701
702 rfkill_init_sw_state(rfkill->rfkill_dev, BT_BLOCKED);
703 rfkill_set_sw_state(rfkill->rfkill_dev, BT_BLOCKED);
704 rfkill_set_hw_state(rfkill->rfkill_dev, false);
705 ret = rfkill_register(rfkill->rfkill_dev);
706 if (ret < 0)
707 goto fail_rfkill;
708
709 INIT_DELAYED_WORK(&rfkill->bt_sleep_delay_work,
710 rfkill_rk_delay_sleep_bt);
711
712 //rfkill_rk_set_power(rfkill, BT_BLOCKED);
713 // bt turn off power
714 if (gpio_is_valid(pdata->poweron_gpio.io)) {
715 gpio_direction_output(pdata->poweron_gpio.io,
716 !pdata->poweron_gpio.enable);
717 }
718 if (gpio_is_valid(pdata->reset_gpio.io)) {
719 gpio_direction_output(pdata->reset_gpio.io,
720 !pdata->reset_gpio.enable);
721 }
722
723 platform_set_drvdata(pdev, rfkill);
724
725 LOG("%s device registered.\n", pdata->name);
726
727 return 0;
728
729 fail_rfkill:
730 rfkill_destroy(rfkill->rfkill_dev);
731 fail_alloc:
732
733 remove_proc_entry("btwrite", sleep_dir);
734 remove_proc_entry("lpm", sleep_dir);
735 fail_setup_wake_irq:
736 wake_lock_destroy(&rfkill->bt_irq_wl);
737 fail_gpio:
738
739 g_rfkill = NULL;
740 return ret;
741 }
742
rfkill_rk_remove(struct platform_device * pdev)743 static int rfkill_rk_remove(struct platform_device *pdev)
744 {
745 struct rfkill_rk_data *rfkill = platform_get_drvdata(pdev);
746
747 LOG("Enter %s\n", __func__);
748
749 rfkill_unregister(rfkill->rfkill_dev);
750 rfkill_destroy(rfkill->rfkill_dev);
751
752 cancel_delayed_work_sync(&rfkill->bt_sleep_delay_work);
753
754 // free gpio
755 if (gpio_is_valid(rfkill->pdata->rts_gpio.io))
756 gpio_free(rfkill->pdata->rts_gpio.io);
757
758 if (gpio_is_valid(rfkill->pdata->wake_host_irq.gpio.io)) {
759 free_irq(rfkill->pdata->wake_host_irq.irq, rfkill);
760 #ifndef CONFIG_BK3515A_COMBO
761 gpio_free(rfkill->pdata->wake_host_irq.gpio.io);
762 #endif
763 }
764
765 #ifndef CONFIG_BK3515A_COMBO
766 if (gpio_is_valid(rfkill->pdata->wake_gpio.io))
767 gpio_free(rfkill->pdata->wake_gpio.io);
768 #endif
769
770 if (gpio_is_valid(rfkill->pdata->reset_gpio.io))
771 gpio_free(rfkill->pdata->reset_gpio.io);
772
773 if (gpio_is_valid(rfkill->pdata->poweron_gpio.io))
774 gpio_free(rfkill->pdata->poweron_gpio.io);
775 clk_disable_unprepare(rfkill->pdata->ext_clk);
776 wake_lock_destroy(&rfkill->bt_irq_wl);
777 g_rfkill = NULL;
778
779 return 0;
780 }
781
782 static const struct dev_pm_ops rfkill_rk_pm_ops = {
783 .prepare = rfkill_rk_pm_prepare,
784 .complete = rfkill_rk_pm_complete,
785 };
786
787 #ifdef CONFIG_OF
788 static struct of_device_id bt_platdata_of_match[] = {
789 { .compatible = "bluetooth-platdata" },
790 {}
791 };
792 MODULE_DEVICE_TABLE(of, bt_platdata_of_match);
793 #endif //CONFIG_OF
794
795 static struct platform_driver rfkill_rk_driver = {
796 .probe = rfkill_rk_probe,
797 .remove = rfkill_rk_remove,
798 .driver = {
799 .name = "rfkill_bt",
800 .owner = THIS_MODULE,
801 .pm = &rfkill_rk_pm_ops,
802 .of_match_table = of_match_ptr(bt_platdata_of_match),
803 },
804 };
805
rfkill_rk_init(void)806 static int __init rfkill_rk_init(void)
807 {
808 int err;
809
810 LOG("Enter %s\n", __func__);
811 err = rfkill_wlan_init();
812 if (err)
813 return err;
814 return platform_driver_register(&rfkill_rk_driver);
815 }
816
rfkill_rk_exit(void)817 static void __exit rfkill_rk_exit(void)
818 {
819 LOG("Enter %s\n", __func__);
820 platform_driver_unregister(&rfkill_rk_driver);
821 rfkill_wlan_exit();
822 }
823
824 module_init(rfkill_rk_init);
825 module_exit(rfkill_rk_exit);
826
827 MODULE_DESCRIPTION("rock-chips rfkill for Bluetooth v0.3");
828 MODULE_AUTHOR("cmy@rock-chips.com, gwl@rock-chips.com");
829 MODULE_LICENSE("GPL");
830