wifi:rfkill:bcmdhd: insmod wifi driver after android started.
[firefly-linux-kernel-4.4.55.git] / net / rfkill / rfkill-wlan.c
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 wifi
15 */
16
17 #include <linux/kernel.h>
18 #include <linux/platform_device.h>
19 #include <linux/module.h>
20 #include <linux/rfkill.h>
21 #include <linux/init.h>
22 #include <linux/slab.h>
23 #include <asm/gpio.h>
24 #include <linux/regulator/consumer.h>
25 #include <linux/delay.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 <dt-bindings/gpio/gpio.h>
35 #ifdef CONFIG_OF
36 #include <linux/of.h>
37 #include <linux/of_device.h>
38 #include <linux/of_gpio.h>
39 #endif
40
41 #if 0
42 #define DBG(x...)   printk(KERN_INFO "[WLAN_RFKILL]: "x)
43 #else
44 #define DBG(x...)
45 #endif
46
47 #define LOG(x...)   printk(KERN_INFO "[WLAN_RFKILL]: "x)
48
49 struct rfkill_wlan_data {
50         struct rksdmmc_gpio_wifi_moudle *pdata;
51     struct wake_lock            wlan_irq_wl;
52 };
53
54 static struct rfkill_wlan_data *g_rfkill = NULL;
55
56 static const char wlan_name[] = 
57 #if defined (CONFIG_BCM4330)
58     #if defined (CONFIG_BT_MODULE_NH660)
59         "nh660"
60     #else
61         "bcm4330"
62     #endif
63 #elif defined (CONFIG_RK903)
64     #if defined(CONFIG_RKWIFI_26M)
65         "rk903_26M"
66     #else
67         "rk903"
68     #endif
69 #elif defined(CONFIG_BCM4329)
70         "bcm4329"
71 #elif defined(CONFIG_MV8787)
72         "mv8787"
73 #elif defined(CONFIG_AP6210)
74     #if defined(CONFIG_RKWIFI_26M)
75         "ap6210"
76     #else
77         "ap6210_24M"
78     #endif
79 #elif defined(CONFIG_AP6330)
80                 "ap6330"
81 #elif defined(CONFIG_AP6476)
82                 "ap6476"
83 #elif defined(CONFIG_AP6493)
84                 "ap6493"
85 #else
86         "wlan_default"
87 #endif
88 ;
89
90 /***********************************************************
91  * 
92  * Broadcom Wifi Static Memory
93  * 
94  **********************************************************/
95 #define BCM_STATIC_MEMORY_SUPPORT 0
96 //===========================
97 #if BCM_STATIC_MEMORY_SUPPORT
98 #define PREALLOC_WLAN_SEC_NUM           4
99 #define PREALLOC_WLAN_BUF_NUM           160
100 #define PREALLOC_WLAN_SECTION_HEADER    24
101 #define WLAN_SKB_BUF_NUM        16
102
103 #define WLAN_SECTION_SIZE_0     (PREALLOC_WLAN_BUF_NUM * 128)
104 #define WLAN_SECTION_SIZE_1     (PREALLOC_WLAN_BUF_NUM * 128)
105 #define WLAN_SECTION_SIZE_2     (PREALLOC_WLAN_BUF_NUM * 512)
106 #define WLAN_SECTION_SIZE_3     (PREALLOC_WLAN_BUF_NUM * 1024)
107 #define WLAN_SECTION_SIZE_5     (PREALLOC_WLAN_BUF_NUM * 512)
108
109 static struct sk_buff *wlan_static_skb[WLAN_SKB_BUF_NUM];
110
111 struct wifi_mem_prealloc {
112     void *mem_ptr;
113     unsigned long size;
114 };
115
116 static struct wifi_mem_prealloc wifi_mem_array[5] = {
117     {NULL, (WLAN_SECTION_SIZE_0 + PREALLOC_WLAN_SECTION_HEADER)},
118     {NULL, (WLAN_SECTION_SIZE_1 + PREALLOC_WLAN_SECTION_HEADER)},
119     {NULL, (WLAN_SECTION_SIZE_2 + PREALLOC_WLAN_SECTION_HEADER)},
120     {NULL, (WLAN_SECTION_SIZE_3 + PREALLOC_WLAN_SECTION_HEADER)},
121     {NULL, (WLAN_SECTION_SIZE_5 + PREALLOC_WLAN_SECTION_HEADER)}
122 };
123
124 static int __init rockchip_init_wifi_mem(void)
125 {
126     int i;
127     int j;
128
129     for (i = 0 ; i < WLAN_SKB_BUF_NUM ; i++) {
130         wlan_static_skb[i] = dev_alloc_skb(
131                ((i < (WLAN_SKB_BUF_NUM / 2)) ? 4096 : 8192));
132
133         if (!wlan_static_skb[i])
134             goto err_skb_alloc;
135     }
136
137     for (i = 0 ; i < 5; i++) {
138         wifi_mem_array[i].mem_ptr =
139                kmalloc(wifi_mem_array[i].size, GFP_KERNEL);
140
141         if (!wifi_mem_array[i].mem_ptr)
142             goto err_mem_alloc;
143         }
144         return 0;
145
146 err_mem_alloc:
147     pr_err("Failed to mem_alloc for WLAN\n");
148     for (j = 0 ; j < i ; j++)
149         kfree(wifi_mem_array[j].mem_ptr);
150     i = WLAN_SKB_BUF_NUM;
151 err_skb_alloc:
152     pr_err("Failed to skb_alloc for WLAN\n");
153     for (j = 0 ; j < i ; j++)
154         dev_kfree_skb(wlan_static_skb[j]);
155
156     return -ENOMEM;
157 }
158
159 void *rockchip_mem_prealloc(int section, unsigned long size)
160 {
161     if (section == PREALLOC_WLAN_SEC_NUM)
162         return wlan_static_skb;
163
164     if ((section < 0) || (section > 5))
165         return NULL;
166
167     if (section == 5)
168         return wifi_mem_array[4].mem_ptr;
169
170     if (wifi_mem_array[section].size < size)
171         return NULL;
172
173     return wifi_mem_array[section].mem_ptr;
174 }
175 #else
176 void *rockchip_mem_prealloc(int section, unsigned long size) { return NULL;}
177 #endif
178 EXPORT_SYMBOL(rockchip_mem_prealloc);
179
180 /**************************************************************************
181  *
182  * Wifi Power Control Func
183  * 0 -> power off
184  * 1 -> power on
185  *
186  *************************************************************************/
187 int rockchip_wifi_power(int on)
188 {
189         struct rfkill_wlan_data *mrfkill = g_rfkill;
190     struct rksdmmc_gpio *poweron, *reset;
191     struct regulator *ldo = NULL;
192
193     LOG("%s: %d\n", __func__, on);
194
195     if (mrfkill == NULL) {
196         LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
197         return -1;
198     }
199
200     if (mrfkill->pdata->mregulator.power_ctrl_by_pmu) {
201         char *ldostr;
202         int ret = -1;
203         int level = mrfkill->pdata->mregulator.enable;
204
205         ldostr = mrfkill->pdata->mregulator.pmu_regulator;
206         if (ldostr == NULL) {
207             LOG("%s: wifi power set to be controled by pmic, but which one?\n", __func__);
208             return -1;
209         }
210         ldo = regulator_get(NULL, ldostr);
211         if (ldo == NULL) {
212             LOG("\n\n\n%s get ldo error,please mod this\n\n\n", __func__);
213         } else {
214                         if (on == level) {
215                                 regulator_set_voltage(ldo, 3000000, 3000000);
216                             LOG("%s: %s enabled\n", __func__, ldostr);
217                                 ret = regulator_enable(ldo);
218                                 if(ret != 0){
219                                     LOG("%s: faild to enable %s\n", __func__, ldostr);
220                                 }
221                             LOG("wifi turn on power.\n");
222             } else {
223                             LOG("wifi shut off power.\n");
224                                 LOG("%s: %s disabled\n", __func__, ldostr);
225                                 ret = regulator_disable(ldo);
226                                 if(ret != 0){
227                                         LOG("%s: faild to disable %s\n", __func__, ldostr);
228                                 }
229                         }
230                         regulator_put(ldo);
231                         mdelay(100);
232                 }
233     } else {
234                 poweron = &mrfkill->pdata->power_n;
235                 reset = &mrfkill->pdata->reset_n;
236
237                 if (on){
238                         if (gpio_is_valid(poweron->io)) {
239                                 gpio_set_value(poweron->io, poweron->enable);
240                         }
241                         mdelay(100);
242
243                         if (gpio_is_valid(reset->io)) {
244                                 gpio_set_value(reset->io, reset->enable);
245                         }
246                         mdelay(100);
247                         LOG("wifi turn on power. %d\n", poweron->io);
248                 }else{
249                         if (gpio_is_valid(poweron->io)) {
250                                 gpio_set_value(poweron->io, !(poweron->enable));
251                         }
252
253                         mdelay(100);
254                         if (gpio_is_valid(reset->io)) {
255                                 gpio_set_value(reset->io, !(reset->enable));
256                         }
257
258                         LOG("wifi shut off power.\n");
259                 }
260     }
261
262     return 0;
263 }
264 EXPORT_SYMBOL(rockchip_wifi_power);
265
266 /**************************************************************************
267  *
268  * Wifi Sdio Detect Func
269  *
270  *************************************************************************/
271 extern int mmc_host_rescan(struct mmc_host *host);
272 int rockchip_wifi_set_carddetect(void)
273 {
274     return mmc_host_rescan(NULL);//NULL => SDIO host
275 }
276 EXPORT_SYMBOL(rockchip_wifi_set_carddetect);
277
278 /**************************************************************************
279  *
280  * Wifi Reset Func
281  *
282  *************************************************************************/
283 int rockchip_wifi_reset(int on)
284 {
285     return 0;
286 }
287 EXPORT_SYMBOL(rockchip_wifi_reset);
288
289 /**************************************************************************
290  *
291  * Wifi MAC custom Func
292  *
293  *************************************************************************/
294 #include <linux/etherdevice.h>
295 u8 wifi_custom_mac_addr[6] = {0,0,0,0,0,0};
296 extern char GetSNSectorInfo(char * pbuf);
297 int rockchip_wifi_mac_addr(unsigned char *buf)
298 {
299     char mac_buf[20] = {0};
300     LOG("%s: enter.\n", __func__);
301
302     // from vflash
303     if(is_zero_ether_addr(wifi_custom_mac_addr)) {
304         int i;
305         char *tempBuf = kmalloc(512, GFP_KERNEL);
306         if(tempBuf) {
307             GetSNSectorInfo(tempBuf);
308             for (i = 506; i <= 511; i++)
309                 wifi_custom_mac_addr[i-506] = tempBuf[i];
310             kfree(tempBuf);
311         } else {
312             return -1;
313         }
314     }
315
316     sprintf(mac_buf,"%02x:%02x:%02x:%02x:%02x:%02x",wifi_custom_mac_addr[0],wifi_custom_mac_addr[1],
317     wifi_custom_mac_addr[2],wifi_custom_mac_addr[3],wifi_custom_mac_addr[4],wifi_custom_mac_addr[5]);
318     LOG("falsh wifi_custom_mac_addr=[%s]\n", mac_buf);
319
320     if (is_valid_ether_addr(wifi_custom_mac_addr)) {
321         if (2 == (wifi_custom_mac_addr[0] & 0x0F)) {
322             LOG("This mac address come into conflict with the address of direct, ignored...\n");
323             return -1;
324         }
325     } else {
326         LOG("This mac address is not valid, ignored...\n");
327         return -1;
328     }
329
330 #if defined(CONFIG_RKWIFI)
331     memcpy(buf, wifi_custom_mac_addr, 6);
332 #else
333     memcpy(buf, mac_buf, strlen(mac_buf));//realtek's wifi use this branch
334 #endif
335     return 0;
336 }
337 EXPORT_SYMBOL(rockchip_wifi_mac_addr);
338
339 /**************************************************************************
340  *
341  * wifi get country code func
342  *
343  *************************************************************************/
344 struct cntry_locales_custom {
345     char iso_abbrev[4];  /* ISO 3166-1 country abbreviation */
346     char custom_locale[4];   /* Custom firmware locale */
347     int custom_locale_rev;        /* Custom local revisin default -1 */
348 };
349
350 static struct cntry_locales_custom country_cloc;
351
352 void *rockchip_wifi_country_code(char *ccode)
353 {
354     struct cntry_locales_custom *mcloc;
355
356     LOG("%s: set country code [%s]\n", __func__, ccode);
357     mcloc = &country_cloc;
358     memcpy(mcloc->custom_locale, ccode, 4);
359     mcloc->custom_locale_rev = 0;
360
361     return mcloc;
362 }
363 EXPORT_SYMBOL(rockchip_wifi_country_code);
364 /**************************************************************************/
365
366 static int rfkill_rk_setup_gpio(struct rksdmmc_gpio *gpio, const char* prefix, const char* name)
367 {
368     if (gpio_is_valid(gpio->io)) {
369         int ret=0;
370         sprintf(gpio->name, "%s_%s", prefix, name);
371         ret = gpio_request(gpio->io, gpio->name);
372         if (ret) {
373             LOG("Failed to get %s gpio.\n", gpio->name);
374             return -1;
375         }
376     }
377
378     return 0;
379 }
380
381 #ifdef CONFIG_OF
382 static int wlan_platdata_parse_dt(struct device *dev,
383                   struct rksdmmc_gpio_wifi_moudle *data)
384 {
385     struct device_node *node = dev->of_node;
386     const char *strings;
387     u32 value;
388     int gpio,ret;
389     enum of_gpio_flags flags;
390
391     if (!node)
392         return -ENODEV;
393
394     memset(data, 0, sizeof(*data));
395
396     ret = of_property_read_u32(node, "sdio_vref", &value);
397     if (ret < 0)
398         LOG("%s: Can't get sdio vref.", __func__);
399
400     data->sdio_vol = value;
401
402     if (of_find_property(node, "power_ctrl_by_pmu", NULL)) {
403         data->mregulator.power_ctrl_by_pmu = true;
404         ret = of_property_read_string(node, "pmu_regulator", &strings);
405         if (ret) {
406             LOG("%s: Can not read property: pmu_regulator.\n", __func__);
407             data->mregulator.power_ctrl_by_pmu = false;
408         } else {
409             LOG("%s: wifi power controled by pmu(%s).\n", __func__, strings);
410             sprintf(data->mregulator.pmu_regulator, "%s", strings);
411         }
412         ret = of_property_read_u32(node, "pmu_enable_level", &value);
413         if (ret) {
414             LOG("%s: Can not read property: pmu_enable_level.\n", __func__);
415             data->mregulator.power_ctrl_by_pmu = false;
416         } else {
417             LOG("%s: wifi power controled by pmu(level = %s).\n", __func__, (value == 1)?"HIGH":"LOW");
418             data->mregulator.enable = value;
419         }
420         } else {
421                 data->mregulator.power_ctrl_by_pmu = false;
422                 LOG("%s: wifi power controled by gpio.\n", __func__);
423         gpio = of_get_named_gpio_flags(node, "WIFI,poweren_gpio", 0, &flags);
424         if (gpio_is_valid(gpio)){
425                         data->power_n.io = gpio;
426                         data->power_n.enable = (flags == GPIO_ACTIVE_HIGH)? 1:0;
427                         LOG("%s: get property: WIFI,poweren_gpio = %d, flags = %d.\n", __func__, gpio, flags);
428         }
429         gpio = of_get_named_gpio_flags(node, "WIFI,reset_gpio", 0, &flags);
430         if (gpio_is_valid(gpio)){
431                         data->reset_n.io = gpio;
432                         data->reset_n.enable = (flags == GPIO_ACTIVE_HIGH)? 1:0;
433                         LOG("%s: get property: WIFI,reset_gpio = %d, flags = %d.\n", __func__, gpio, flags);
434         }
435         gpio = of_get_named_gpio_flags(node, "WIFI,host_wake_irq", 0, &flags);
436         if (gpio_is_valid(gpio)){
437                         data->wifi_int_b.io = gpio;
438                         data->wifi_int_b.enable = flags;
439                         LOG("%s: get property: WIFI,host_wake_irq = %d, flags = %d.\n", __func__, gpio, flags);
440         }
441         }
442
443     return 0;
444 }
445 #endif //CONFIG_OF
446
447 #if defined(CONFIG_HAS_EARLYSUSPEND)
448 #include <linux/earlysuspend.h>
449
450 static void wlan_early_suspend(struct early_suspend *h)
451 {
452     LOG("%s :enter\n", __func__);
453
454     return;
455 }
456
457 static void wlan_late_resume(struct early_suspend *h)
458 {
459     LOG("%s :enter\n", __func__);
460
461     return;
462 }
463
464 struct early_suspend wlan_early_suspend {
465     .level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20;
466     .suspend = wlan_early_suspend;
467     .resume = wlan_late_resume; 
468 }
469 #endif
470
471 static int rfkill_wlan_probe(struct platform_device *pdev)
472 {
473         struct rfkill_wlan_data *rfkill;
474         struct rksdmmc_gpio_wifi_moudle *pdata = pdev->dev.platform_data;
475         int ret = -1;
476
477     LOG("Enter %s\n", __func__);
478
479         if (!pdata) {
480 #ifdef CONFIG_OF
481         pdata = kzalloc(sizeof(struct rksdmmc_gpio_wifi_moudle), GFP_KERNEL);
482         if (!pdata)
483             return -ENOMEM;
484
485         ret = wlan_platdata_parse_dt(&pdev->dev, pdata);
486         if (ret < 0) {
487 #endif
488                     LOG("%s: No platform data specified\n", __func__);
489             return ret;
490 #ifdef CONFIG_OF
491         }
492 #endif
493         }
494
495         rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL);
496         if (!rfkill)
497         goto rfkill_alloc_fail;
498
499         rfkill->pdata = pdata;
500     g_rfkill = rfkill;
501
502     LOG("%s: init gpio\n", __func__);
503
504     if (!pdata->mregulator.power_ctrl_by_pmu) {
505         ret = rfkill_rk_setup_gpio(&pdata->power_n, wlan_name, "wlan_poweren");
506         if (ret) goto fail_alloc;
507
508         ret = rfkill_rk_setup_gpio(&pdata->reset_n, wlan_name, "wlan_reset");
509         if (ret) goto fail_alloc;
510     }
511
512     wake_lock_init(&(rfkill->wlan_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_wlan_wake");
513
514     // Turn off wifi power as default
515     if (gpio_is_valid(pdata->power_n.io))
516     {
517         gpio_direction_output(pdata->power_n.io, !pdata->power_n.enable);
518     }
519
520 #if BCM_STATIC_MEMORY_SUPPORT
521     rockchip_init_wifi_mem();
522 #endif
523
524 #if defined(CONFIG_HAS_EARLYSUSPEND)
525     register_early_suspend(wlan_early_suspend);
526 #endif
527
528     LOG("Exit %s\n", __func__);
529
530         return 0;
531
532 fail_alloc:
533         kfree(rfkill);
534 rfkill_alloc_fail:
535     kfree(pdata);
536
537     g_rfkill = NULL;
538
539         return ret;
540 }
541
542 static int rfkill_wlan_remove(struct platform_device *pdev)
543 {
544         struct rfkill_wlan_data *rfkill = platform_get_drvdata(pdev);
545
546     LOG("Enter %s\n", __func__);
547
548     wake_lock_destroy(&rfkill->wlan_irq_wl);
549     
550     if (gpio_is_valid(rfkill->pdata->power_n.io))
551         gpio_free(rfkill->pdata->power_n.io);
552     
553     if (gpio_is_valid(rfkill->pdata->reset_n.io))
554         gpio_free(rfkill->pdata->reset_n.io);
555     
556 //    if (gpio_is_valid(rfkill->pdata->vddio.io))
557 //        gpio_free(rfkill->pdata->vddio.io);
558 //
559 //    if (gpio_is_valid(rfkill->pdata->bgf_int_b.io))
560 //        gpio_free(rfkill->pdata->bgf_int_b.io);
561 //    
562 //    if (gpio_is_valid(rfkill->pdata->gps_sync.io))
563 //        gpio_free(rfkill->pdata->gps_sync.io);
564 //    
565 //    if (gpio_is_valid(rfkill->pdata->ANTSEL2.io))
566 //        gpio_free(rfkill->pdata->ANTSEL2.io);
567 //
568 //    if (gpio_is_valid(rfkill->pdata->ANTSEL3.io))
569 //        gpio_free(rfkill->pdata->ANTSEL3.io);
570 //    
571 //    if (gpio_is_valid(rfkill->pdata->GPS_LAN.io))
572 //        gpio_free(rfkill->pdata->GPS_LAN.io);
573
574     kfree(rfkill);
575     g_rfkill = NULL;
576
577         return 0;
578 }
579
580 static int rfkill_wlan_suspend(struct platform_device *pdev, pm_message_t state)
581 {
582     LOG("Enter %s\n", __func__);
583     return 0;
584 }
585
586 static int rfkill_wlan_resume(struct platform_device *pdev)
587 {
588     LOG("Enter %s\n", __func__);
589     return 0;
590 }
591
592 #ifdef CONFIG_OF
593 static struct of_device_id wlan_platdata_of_match[] = {
594     { .compatible = "wlan-platdata" },
595     { }
596 };
597 MODULE_DEVICE_TABLE(of, wlan_platdata_of_match);
598 #endif //CONFIG_OF
599
600 static struct platform_driver rfkill_wlan_driver = {
601         .probe = rfkill_wlan_probe,
602         .remove = rfkill_wlan_remove,
603     .suspend = rfkill_wlan_suspend,
604     .resume = rfkill_wlan_resume,
605         .driver = {
606                 .name = "wlan-platdata",
607                 .owner = THIS_MODULE,
608         .of_match_table = of_match_ptr(wlan_platdata_of_match),
609         },
610 };
611
612 static int __init rfkill_wlan_init(void)
613 {
614     LOG("Enter %s\n", __func__);
615         return platform_driver_register(&rfkill_wlan_driver);
616 }
617
618 static void __exit rfkill_wlan_exit(void)
619 {
620     LOG("Enter %s\n", __func__);
621         platform_driver_unregister(&rfkill_wlan_driver);
622 }
623
624 module_init(rfkill_wlan_init);
625 module_exit(rfkill_wlan_exit);
626
627 MODULE_DESCRIPTION("rock-chips rfkill for wifi v0.1");
628 MODULE_AUTHOR("gwl@rock-chips.com");
629 MODULE_LICENSE("GPL");