2 * Copyright (C) 2012 ROCKCHIP, Inc.
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.
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.
14 /* Rock-chips rfkill driver for wifi
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>
24 #include <linux/regulator/consumer.h>
25 #include <linux/delay.h>
26 #include <linux/rfkill-wlan.h>
27 #include <linux/rfkill-bt.h>
28 #include <linux/wakelock.h>
29 #include <linux/interrupt.h>
31 #include <linux/suspend.h>
32 #include <linux/proc_fs.h>
33 #include <linux/uaccess.h>
34 #include <linux/gpio.h>
35 #include <linux/rockchip/iomap.h>
36 #include <dt-bindings/gpio/gpio.h>
39 #include <linux/of_device.h>
40 #include <linux/of_gpio.h>
44 #define DBG(x...) printk(KERN_INFO "[WLAN_RFKILL]: "x)
49 #define LOG(x...) printk(KERN_INFO "[WLAN_RFKILL]: "x)
51 struct rfkill_wlan_data {
52 struct rksdmmc_gpio_wifi_moudle *pdata;
53 struct wake_lock wlan_irq_wl;
56 static struct rfkill_wlan_data *g_rfkill = NULL;
58 static const char wlan_name[] =
59 #if defined (CONFIG_BCM4330)
60 #if defined (CONFIG_BT_MODULE_NH660)
65 #elif defined (CONFIG_RK903)
66 #if defined(CONFIG_RKWIFI_26M)
71 #elif defined(CONFIG_BCM4329)
73 #elif defined(CONFIG_MV8787)
75 #elif defined(CONFIG_AP6210)
76 #if defined(CONFIG_RKWIFI_26M)
81 #elif defined(CONFIG_AP6330)
83 #elif defined(CONFIG_AP6476)
85 #elif defined(CONFIG_AP6493)
92 /***********************************************************
94 * Broadcom Wifi Static Memory
96 **********************************************************/
97 #define BCM_STATIC_MEMORY_SUPPORT 0
98 //===========================
99 #if BCM_STATIC_MEMORY_SUPPORT
100 #define PREALLOC_WLAN_SEC_NUM 4
101 #define PREALLOC_WLAN_BUF_NUM 160
102 #define PREALLOC_WLAN_SECTION_HEADER 24
103 #define WLAN_SKB_BUF_NUM 16
105 #define WLAN_SECTION_SIZE_0 (PREALLOC_WLAN_BUF_NUM * 128)
106 #define WLAN_SECTION_SIZE_1 (PREALLOC_WLAN_BUF_NUM * 128)
107 #define WLAN_SECTION_SIZE_2 (PREALLOC_WLAN_BUF_NUM * 512)
108 #define WLAN_SECTION_SIZE_3 (PREALLOC_WLAN_BUF_NUM * 1024)
109 #define WLAN_SECTION_SIZE_5 (PREALLOC_WLAN_BUF_NUM * 512)
111 static struct sk_buff *wlan_static_skb[WLAN_SKB_BUF_NUM];
113 struct wifi_mem_prealloc {
118 static struct wifi_mem_prealloc wifi_mem_array[5] = {
119 {NULL, (WLAN_SECTION_SIZE_0 + PREALLOC_WLAN_SECTION_HEADER)},
120 {NULL, (WLAN_SECTION_SIZE_1 + PREALLOC_WLAN_SECTION_HEADER)},
121 {NULL, (WLAN_SECTION_SIZE_2 + PREALLOC_WLAN_SECTION_HEADER)},
122 {NULL, (WLAN_SECTION_SIZE_3 + PREALLOC_WLAN_SECTION_HEADER)},
123 {NULL, (WLAN_SECTION_SIZE_5 + PREALLOC_WLAN_SECTION_HEADER)}
126 static int __init rockchip_init_wifi_mem(void)
131 for (i = 0 ; i < WLAN_SKB_BUF_NUM ; i++) {
132 wlan_static_skb[i] = dev_alloc_skb(
133 ((i < (WLAN_SKB_BUF_NUM / 2)) ? 4096 : 8192));
135 if (!wlan_static_skb[i])
139 for (i = 0 ; i < 5; i++) {
140 wifi_mem_array[i].mem_ptr =
141 kmalloc(wifi_mem_array[i].size, GFP_KERNEL);
143 if (!wifi_mem_array[i].mem_ptr)
149 pr_err("Failed to mem_alloc for WLAN\n");
150 for (j = 0 ; j < i ; j++)
151 kfree(wifi_mem_array[j].mem_ptr);
152 i = WLAN_SKB_BUF_NUM;
154 pr_err("Failed to skb_alloc for WLAN\n");
155 for (j = 0 ; j < i ; j++)
156 dev_kfree_skb(wlan_static_skb[j]);
161 void *rockchip_mem_prealloc(int section, unsigned long size)
163 if (section == PREALLOC_WLAN_SEC_NUM)
164 return wlan_static_skb;
166 if ((section < 0) || (section > 5))
170 return wifi_mem_array[4].mem_ptr;
172 if (wifi_mem_array[section].size < size)
175 return wifi_mem_array[section].mem_ptr;
178 void *rockchip_mem_prealloc(int section, unsigned long size) { return NULL;}
180 EXPORT_SYMBOL(rockchip_mem_prealloc);
182 /**************************************************************************
184 * get wifi power state Func
186 *************************************************************************/
187 static int wifi_power_state = 0;
188 int rfkill_get_wifi_power_state(int *power)
190 struct rfkill_wlan_data *mrfkill = g_rfkill;
192 if (mrfkill == NULL) {
193 LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
197 *power = wifi_power_state;
202 /**************************************************************************
204 * Wifi Power Control Func
208 *************************************************************************/
209 int rockchip_wifi_power(int on)
211 struct rfkill_wlan_data *mrfkill = g_rfkill;
212 struct rksdmmc_gpio *poweron, *reset;
213 struct regulator *ldo = NULL;
217 LOG("%s: %d\n", __func__, on);
219 if (mrfkill == NULL) {
220 LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
224 if(!rfkill_get_bt_power_state(&power, &toggle)) {
225 if (toggle == true && power == 1) {
226 LOG("%s: wifi shouldn't control the power, it was enabled by BT!\n", __func__);
231 if (mrfkill->pdata->mregulator.power_ctrl_by_pmu) {
234 int level = mrfkill->pdata->mregulator.enable;
236 ldostr = mrfkill->pdata->mregulator.pmu_regulator;
237 if (ldostr == NULL) {
238 LOG("%s: wifi power set to be controled by pmic, but which one?\n", __func__);
241 ldo = regulator_get(NULL, ldostr);
243 LOG("\n\n\n%s get ldo error,please mod this\n\n\n", __func__);
246 regulator_set_voltage(ldo, 3000000, 3000000);
247 LOG("%s: %s enabled\n", __func__, ldostr);
248 ret = regulator_enable(ldo);
250 LOG("%s: faild to enable %s\n", __func__, ldostr);
252 wifi_power_state = 1;
253 LOG("wifi turn on power.\n");
256 LOG("%s: %s disabled\n", __func__, ldostr);
257 ret = regulator_disable(ldo);
259 LOG("%s: faild to disable %s\n", __func__, ldostr);
261 wifi_power_state = 0;
262 LOG("wifi shut off power.\n");
269 poweron = &mrfkill->pdata->power_n;
270 reset = &mrfkill->pdata->reset_n;
273 if (gpio_is_valid(poweron->io)) {
274 gpio_set_value(poweron->io, poweron->enable);
278 if (gpio_is_valid(reset->io)) {
279 gpio_set_value(reset->io, reset->enable);
283 wifi_power_state = 1;
284 LOG("wifi turn on power. %d\n", poweron->io);
286 if (gpio_is_valid(poweron->io)) {
287 gpio_set_value(poweron->io, !(poweron->enable));
291 if (gpio_is_valid(reset->io)) {
292 gpio_set_value(reset->io, !(reset->enable));
295 wifi_power_state = 0;
296 LOG("wifi shut off power.\n");
302 EXPORT_SYMBOL(rockchip_wifi_power);
304 /**************************************************************************
306 * Wifi Sdio Detect Func
308 *************************************************************************/
309 #include <linux/mmc/host.h>
310 extern int mmc_host_rescan(struct mmc_host *host, int val);
311 int rockchip_wifi_set_carddetect(int val)
313 return mmc_host_rescan(NULL, val);//NULL => SDIO host
315 EXPORT_SYMBOL(rockchip_wifi_set_carddetect);
317 /**************************************************************************
319 * Wifi Get Interrupt irq Func
321 *************************************************************************/
322 int rockchip_wifi_get_oob_irq(void)
324 struct rfkill_wlan_data *mrfkill = g_rfkill;
325 struct rksdmmc_gpio *wifi_int_irq;
327 LOG("%s: Enter\n", __func__);
329 if (mrfkill == NULL) {
330 LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
334 wifi_int_irq = &mrfkill->pdata->wifi_int_b;
335 if (gpio_is_valid(wifi_int_irq->io)) {
336 return gpio_to_irq(wifi_int_irq->io);
337 //return wifi_int_irq->io;
339 LOG("%s: wifi OOB pin isn't defined.\n", __func__);
344 EXPORT_SYMBOL(rockchip_wifi_get_oob_irq);
346 /**************************************************************************
350 *************************************************************************/
351 int rockchip_wifi_reset(int on)
355 EXPORT_SYMBOL(rockchip_wifi_reset);
357 /**************************************************************************
359 * Wifi MAC custom Func
361 *************************************************************************/
362 #include <linux/etherdevice.h>
363 u8 wifi_custom_mac_addr[6] = {0,0,0,0,0,0};
364 extern char GetSNSectorInfo(char * pbuf);
365 int rockchip_wifi_mac_addr(unsigned char *buf)
368 char mac_buf[20] = {0};
369 LOG("%s: enter.\n", __func__);
372 if(is_zero_ether_addr(wifi_custom_mac_addr)) {
374 char *tempBuf = kmalloc(512, GFP_KERNEL);
376 GetSNSectorInfo(tempBuf);
377 for (i = 506; i <= 511; i++)
378 wifi_custom_mac_addr[i-506] = tempBuf[i];
385 sprintf(mac_buf,"%02x:%02x:%02x:%02x:%02x:%02x",wifi_custom_mac_addr[0],wifi_custom_mac_addr[1],
386 wifi_custom_mac_addr[2],wifi_custom_mac_addr[3],wifi_custom_mac_addr[4],wifi_custom_mac_addr[5]);
387 LOG("falsh wifi_custom_mac_addr=[%s]\n", mac_buf);
389 if (is_valid_ether_addr(wifi_custom_mac_addr)) {
390 if (2 == (wifi_custom_mac_addr[0] & 0x0F)) {
391 LOG("This mac address come into conflict with the address of direct, ignored...\n");
395 LOG("This mac address is not valid, ignored...\n");
399 #if defined(CONFIG_RKWIFI)
400 memcpy(buf, wifi_custom_mac_addr, 6);
402 memcpy(buf, mac_buf, strlen(mac_buf));//realtek's wifi use this branch
406 EXPORT_SYMBOL(rockchip_wifi_mac_addr);
408 /**************************************************************************
410 * wifi get country code func
412 *************************************************************************/
413 struct cntry_locales_custom {
414 char iso_abbrev[4]; /* ISO 3166-1 country abbreviation */
415 char custom_locale[4]; /* Custom firmware locale */
416 int custom_locale_rev; /* Custom local revisin default -1 */
419 static struct cntry_locales_custom country_cloc;
421 void *rockchip_wifi_country_code(char *ccode)
423 struct cntry_locales_custom *mcloc;
425 LOG("%s: set country code [%s]\n", __func__, ccode);
426 mcloc = &country_cloc;
427 memcpy(mcloc->custom_locale, ccode, 4);
428 mcloc->custom_locale_rev = 0;
432 EXPORT_SYMBOL(rockchip_wifi_country_code);
433 /**************************************************************************/
435 static int rockchip_wifi_voltage_select(void)
437 struct rfkill_wlan_data *mrfkill = g_rfkill;
440 if (mrfkill == NULL) {
441 LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
444 voltage = mrfkill->pdata->sdio_vol;
445 if (voltage > 2700 && voltage < 3500) {
446 writel_relaxed(0x00100000, RK_GRF_VIRT+0x380); //3.3
447 LOG("%s: wifi & sdio reference voltage: 3.3V\n", __func__);
448 } else if (voltage > 1500 && voltage < 1950) {
449 writel_relaxed(0x00100010, RK_GRF_VIRT+0x380); //1.8
450 LOG("%s: wifi & sdio reference voltage: 1.8V\n", __func__);
452 LOG("%s: unsupport wifi & sdio reference voltage!\n", __func__);
459 static int rfkill_rk_setup_gpio(struct rksdmmc_gpio *gpio, const char* prefix, const char* name)
461 if (gpio_is_valid(gpio->io)) {
463 sprintf(gpio->name, "%s_%s", prefix, name);
464 ret = gpio_request(gpio->io, gpio->name);
466 LOG("Failed to get %s gpio.\n", gpio->name);
475 static int wlan_platdata_parse_dt(struct device *dev,
476 struct rksdmmc_gpio_wifi_moudle *data)
478 struct device_node *node = dev->of_node;
482 enum of_gpio_flags flags;
487 memset(data, 0, sizeof(*data));
489 ret = of_property_read_u32(node, "sdio_vref", &value);
491 LOG("%s: Can't get sdio vref.", __func__);
494 data->sdio_vol = value;
496 if (of_find_property(node, "power_ctrl_by_pmu", NULL)) {
497 data->mregulator.power_ctrl_by_pmu = true;
498 ret = of_property_read_string(node, "pmu_regulator", &strings);
500 LOG("%s: Can not read property: pmu_regulator.\n", __func__);
501 data->mregulator.power_ctrl_by_pmu = false;
503 LOG("%s: wifi power controled by pmu(%s).\n", __func__, strings);
504 sprintf(data->mregulator.pmu_regulator, "%s", strings);
506 ret = of_property_read_u32(node, "pmu_enable_level", &value);
508 LOG("%s: Can not read property: pmu_enable_level.\n", __func__);
509 data->mregulator.power_ctrl_by_pmu = false;
511 LOG("%s: wifi power controled by pmu(level = %s).\n", __func__, (value == 1)?"HIGH":"LOW");
512 data->mregulator.enable = value;
515 data->mregulator.power_ctrl_by_pmu = false;
516 LOG("%s: wifi power controled by gpio.\n", __func__);
517 gpio = of_get_named_gpio_flags(node, "WIFI,poweren_gpio", 0, &flags);
518 if (gpio_is_valid(gpio)){
519 data->power_n.io = gpio;
520 data->power_n.enable = (flags == GPIO_ACTIVE_HIGH)? 1:0;
521 LOG("%s: get property: WIFI,poweren_gpio = %d, flags = %d.\n", __func__, gpio, flags);
522 } else data->power_n.io = -1;
523 gpio = of_get_named_gpio_flags(node, "WIFI,reset_gpio", 0, &flags);
524 if (gpio_is_valid(gpio)){
525 data->reset_n.io = gpio;
526 data->reset_n.enable = (flags == GPIO_ACTIVE_HIGH)? 1:0;
527 LOG("%s: get property: WIFI,reset_gpio = %d, flags = %d.\n", __func__, gpio, flags);
528 } else data->reset_n.io = -1;
529 gpio = of_get_named_gpio_flags(node, "WIFI,host_wake_irq", 0, &flags);
530 if (gpio_is_valid(gpio)){
531 data->wifi_int_b.io = gpio;
532 data->wifi_int_b.enable = flags;
533 LOG("%s: get property: WIFI,host_wake_irq = %d, flags = %d.\n", __func__, gpio, flags);
534 } else data->wifi_int_b.io = -1;
541 #if defined(CONFIG_HAS_EARLYSUSPEND)
542 #include <linux/earlysuspend.h>
544 static void wlan_early_suspend(struct early_suspend *h)
546 LOG("%s :enter\n", __func__);
551 static void wlan_late_resume(struct early_suspend *h)
553 LOG("%s :enter\n", __func__);
558 struct early_suspend wlan_early_suspend {
559 .level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20;
560 .suspend = wlan_early_suspend;
561 .resume = wlan_late_resume;
565 static int rfkill_wlan_probe(struct platform_device *pdev)
567 struct rfkill_wlan_data *rfkill;
568 struct rksdmmc_gpio_wifi_moudle *pdata = pdev->dev.platform_data;
571 LOG("Enter %s\n", __func__);
575 pdata = kzalloc(sizeof(struct rksdmmc_gpio_wifi_moudle), GFP_KERNEL);
579 ret = wlan_platdata_parse_dt(&pdev->dev, pdata);
582 LOG("%s: No platform data specified\n", __func__);
589 rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL);
591 goto rfkill_alloc_fail;
593 rfkill->pdata = pdata;
596 LOG("%s: init gpio\n", __func__);
598 if (!pdata->mregulator.power_ctrl_by_pmu) {
599 ret = rfkill_rk_setup_gpio(&pdata->power_n, wlan_name, "wlan_poweren");
600 if (ret) goto fail_alloc;
602 ret = rfkill_rk_setup_gpio(&pdata->reset_n, wlan_name, "wlan_reset");
603 if (ret) goto fail_alloc;
606 wake_lock_init(&(rfkill->wlan_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_wlan_wake");
608 // Turn off wifi power as default
609 if (gpio_is_valid(pdata->power_n.io))
611 gpio_direction_output(pdata->power_n.io, !pdata->power_n.enable);
614 rockchip_wifi_voltage_select();
616 #if BCM_STATIC_MEMORY_SUPPORT
617 rockchip_init_wifi_mem();
620 #if defined(CONFIG_HAS_EARLYSUSPEND)
621 register_early_suspend(wlan_early_suspend);
624 LOG("Exit %s\n", __func__);
638 static int rfkill_wlan_remove(struct platform_device *pdev)
640 struct rfkill_wlan_data *rfkill = platform_get_drvdata(pdev);
642 LOG("Enter %s\n", __func__);
644 wake_lock_destroy(&rfkill->wlan_irq_wl);
646 if (gpio_is_valid(rfkill->pdata->power_n.io))
647 gpio_free(rfkill->pdata->power_n.io);
649 if (gpio_is_valid(rfkill->pdata->reset_n.io))
650 gpio_free(rfkill->pdata->reset_n.io);
652 // if (gpio_is_valid(rfkill->pdata->vddio.io))
653 // gpio_free(rfkill->pdata->vddio.io);
655 // if (gpio_is_valid(rfkill->pdata->bgf_int_b.io))
656 // gpio_free(rfkill->pdata->bgf_int_b.io);
658 // if (gpio_is_valid(rfkill->pdata->gps_sync.io))
659 // gpio_free(rfkill->pdata->gps_sync.io);
661 // if (gpio_is_valid(rfkill->pdata->ANTSEL2.io))
662 // gpio_free(rfkill->pdata->ANTSEL2.io);
664 // if (gpio_is_valid(rfkill->pdata->ANTSEL3.io))
665 // gpio_free(rfkill->pdata->ANTSEL3.io);
667 // if (gpio_is_valid(rfkill->pdata->GPS_LAN.io))
668 // gpio_free(rfkill->pdata->GPS_LAN.io);
676 static int rfkill_wlan_suspend(struct platform_device *pdev, pm_message_t state)
678 LOG("Enter %s\n", __func__);
682 static int rfkill_wlan_resume(struct platform_device *pdev)
684 LOG("Enter %s\n", __func__);
689 static struct of_device_id wlan_platdata_of_match[] = {
690 { .compatible = "wlan-platdata" },
693 MODULE_DEVICE_TABLE(of, wlan_platdata_of_match);
696 static struct platform_driver rfkill_wlan_driver = {
697 .probe = rfkill_wlan_probe,
698 .remove = rfkill_wlan_remove,
699 .suspend = rfkill_wlan_suspend,
700 .resume = rfkill_wlan_resume,
702 .name = "wlan-platdata",
703 .owner = THIS_MODULE,
704 .of_match_table = of_match_ptr(wlan_platdata_of_match),
708 static int __init rfkill_wlan_init(void)
710 LOG("Enter %s\n", __func__);
711 return platform_driver_register(&rfkill_wlan_driver);
714 static void __exit rfkill_wlan_exit(void)
716 LOG("Enter %s\n", __func__);
717 platform_driver_unregister(&rfkill_wlan_driver);
720 module_init(rfkill_wlan_init);
721 module_exit(rfkill_wlan_exit);
723 MODULE_DESCRIPTION("rock-chips rfkill for wifi v0.1");
724 MODULE_AUTHOR("gwl@rock-chips.com");
725 MODULE_LICENSE("GPL");