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-rk.h>
  27 #include <linux/rfkill-wlan.h>
  28 #include <linux/wakelock.h>
  29 #include <linux/interrupt.h>
  30 #include <asm/irq.h>
  31 #include <linux/suspend.h>
  32 #include <linux/proc_fs.h>
  33 #include <linux/uaccess.h>
  34 #include <linux/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 Reset Func
 269  *
 270  *************************************************************************/
 271 int rockchip_wifi_reset(int on)
 272 {
 273     return 0;
 274 }
 275 EXPORT_SYMBOL(rockchip_wifi_reset);
 276
 277 /**************************************************************************
 278  *
 279  * Wifi MAC custom Func
 280  *
 281  *************************************************************************/
 282 #include <linux/etherdevice.h>
 283 u8 wifi_custom_mac_addr[6] = {0,0,0,0,0,0};
 284 extern char GetSNSectorInfo(char * pbuf);
 285 int rockchip_wifi_mac_addr(unsigned char *buf)
 286 {
 287     char mac_buf[20] = {0};
 288     LOG("%s: enter.\n", __func__);
 289
 290     // from vflash
 291     if(is_zero_ether_addr(wifi_custom_mac_addr)) {
 292         int i;
 293         char *tempBuf = kmalloc(512, GFP_KERNEL);
 294         if(tempBuf) {
 295             GetSNSectorInfo(tempBuf);
 296             for (i = 506; i <= 511; i++)
 297                 wifi_custom_mac_addr[i-506] = tempBuf[i];
 298             kfree(tempBuf);
 299         } else {
 300             return -1;
 301         }
 302     }
 303
 304     sprintf(mac_buf,"%02x:%02x:%02x:%02x:%02x:%02x",wifi_custom_mac_addr[0],wifi_custom_mac_addr[1],
 305     wifi_custom_mac_addr[2],wifi_custom_mac_addr[3],wifi_custom_mac_addr[4],wifi_custom_mac_addr[5]);
 306     LOG("falsh wifi_custom_mac_addr=[%s]\n", mac_buf);
 307
 308     if (is_valid_ether_addr(wifi_custom_mac_addr)) {
 309         if (2 == (wifi_custom_mac_addr[0] & 0x0F)) {
 310             LOG("This mac address come into conflict with the address of direct, ignored...\n");
 311             return -1;
 312         }
 313     } else {
 314         LOG("This mac address is not valid, ignored...\n");
 315         return -1;
 316     }
 317
 318 #if defined(CONFIG_RKWIFI)
 319     memcpy(buf, wifi_custom_mac_addr, 6);
 320 #else
 321     memcpy(buf, mac_buf, strlen(mac_buf));//realtek's wifi use this branch
 322 #endif
 323     return 0;
 324 }
 325 EXPORT_SYMBOL(rockchip_wifi_mac_addr);
 326
 327 /**************************************************************************
 328  *
 329  * wifi get country code func
 330  *
 331  *************************************************************************/
 332 struct cntry_locales_custom {
 333     char iso_abbrev[4];  /* ISO 3166-1 country abbreviation */
 334     char custom_locale[4];   /* Custom firmware locale */
 335     int custom_locale_rev;        /* Custom local revisin default -1 */
 336 };
 337
 338 static struct cntry_locales_custom country_cloc;
 339
 340 void *rockchip_wifi_country_code(char *ccode)
 341 {
 342     struct cntry_locales_custom *mcloc;
 343
 344     LOG("%s: set country code [%s]\n", __func__, ccode);
 345     mcloc = &country_cloc;
 346     memcpy(mcloc->custom_locale, ccode, 4);
 347     mcloc->custom_locale_rev = 0;
 348
 349     return mcloc;
 350 }
 351 EXPORT_SYMBOL(rockchip_wifi_country_code);
 352 /**************************************************************************/
 353
 354 static int rfkill_rk_setup_gpio(struct rksdmmc_gpio *gpio, const char* prefix, const char* name)
 355 {
 356     if (gpio_is_valid(gpio->io)) {
 357         int ret=0;
 358         sprintf(gpio->name, "%s_%s", prefix, name);
 359         ret = gpio_request(gpio->io, gpio->name);
 360         if (ret) {
 361             LOG("Failed to get %s gpio.\n", gpio->name);
 362             return -1;
 363         }
 364     }
 365
 366     return 0;
 367 }
 368
 369 #ifdef CONFIG_OF
 370 static int wlan_platdata_parse_dt(struct device *dev,
 371                   struct rksdmmc_gpio_wifi_moudle *data)
 372 {
 373     struct device_node *node = dev->of_node;
 374     struct device_node *childnode, *grandchildnode;
 375     const char *pin_funcs, *strings;
 376     u32 value;
 377     int gpio,ret;
 378     enum of_gpio_flags flags;
 379
 380     if (!node)
 381         return -ENODEV;
 382
 383     memset(data, 0, sizeof(*data));
 384
 385     ret = of_property_read_u32(node, "sdio_vref", &value);
 386     if (ret < 0)
 387         LOG("%s: Can't get sdio vref.", __func__);
 388
 389     data->sdio_vol = value;
 390
 391     childnode = of_get_child_by_name(node, "wlan_ctrl_pmic");
 392         if (!childnode) {
 393                 LOG("%s: Can not get child => wlan_ctrl_pmic.\n", __func__);
 394         } else {
 395                 ret = of_property_read_string(childnode, "power_ctrl_by_pmu", &strings);
 396                 if (ret) {
 397                         LOG("%s: Can not read property: power_ctrl_by_pmu.\n", __func__);
 398                         data->mregulator.power_ctrl_by_pmu = false;
 399                 }
 400                 if (0 == strcmp(strings, "true")) {
 401                         data->mregulator.power_ctrl_by_pmu = true;
 402                         ret = of_property_read_string(childnode, "pmu_regulator", &strings);
 403                         if (ret) {
 404                                 LOG("%s: Can not read property: pmu_regulator.\n", __func__);
 405                                 data->mregulator.power_ctrl_by_pmu = false;
 406                         } else {
 407                                 LOG("%s: wifi power controled by pmu(%s).\n", __func__, strings);
 408                 sprintf(data->mregulator.pmu_regulator, "%s", strings);
 409                         }
 410                         ret = of_property_read_u32(childnode, "pmu_enable_level", &value);
 411                         if (ret) {
 412                                 LOG("%s: Can not read property: pmu_enable_level.\n", __func__);
 413                                 data->mregulator.power_ctrl_by_pmu = false;
 414                         } else {
 415                                 LOG("%s: wifi power controled by pmu(level = %s).\n", __func__, (value == 1)?"HIGH":"LOW");
 416                 data->mregulator.enable = value;
 417                         }
 418                 } else {
 419                         data->mregulator.power_ctrl_by_pmu = false;
 420                         LOG("%s: wifi power controled by gpio.\n", __func__);
 421                 }
 422     }
 423
 424     childnode = of_get_child_by_name(node, "wlan_ctrl_gpios");
 425         if (!childnode) {
 426                 LOG("%s: Can not get child => wlan_ctrl_gpios.\n", __func__);
 427                 return -EINVAL;
 428         }
 429
 430     for_each_child_of_node(childnode, grandchildnode) {
 431         ret = of_property_read_string(grandchildnode, "pin-func", &pin_funcs);
 432                 if (ret) {
 433                         LOG("%s: Can not read property: pin-func.\n", __func__);
 434             continue;
 435                 }
 436         gpio = of_get_named_gpio_flags(grandchildnode, "gpios", 0, &flags);
 437         if (!gpio_is_valid(gpio)){
 438             LOG("%s: Can not read property: %s->gpios.\n", __func__, pin_funcs);
 439             continue;
 440         }
 441
 442         if (0 == strcmp(pin_funcs, "wlan_poweren")) {
 443             data->power_n.io = gpio;
 444             data->power_n.enable = flags;
 445                     LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
 446         } else if (0 == strcmp(pin_funcs, "wlan_reset")) {
 447             data->reset_n.io = gpio;
 448             data->reset_n.enable = flags;
 449                     LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
 450         } else if (0 == strcmp(pin_funcs, "wlan_wake_host_irq")) {
 451             data->wifi_int_b.io = gpio;
 452             data->wifi_int_b.enable = flags;
 453                     LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
 454         }
 455
 456     }
 457
 458     return 0;
 459 }
 460 #endif //CONFIG_OF
 461
 462 #if defined(CONFIG_HAS_EARLYSUSPEND)
 463 #include <linux/earlysuspend.h>
 464
 465 static void wlan_early_suspend(struct early_suspend *h)
 466 {
 467     LOG("%s :enter\n", __func__);
 468
 469     return;
 470 }
 471
 472 static void wlan_late_resume(struct early_suspend *h)
 473 {
 474     LOG("%s :enter\n", __func__);
 475
 476     return;
 477 }
 478
 479 struct early_suspend wlan_early_suspend {
 480     .level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20;
 481     .suspend = wlan_early_suspend;
 482     .resume = wlan_late_resume;
 483 }
 484 #endif
 485
 486 static int rfkill_wlan_probe(struct platform_device *pdev)
 487 {
 488         struct rfkill_wlan_data *rfkill;
 489         struct rksdmmc_gpio_wifi_moudle *pdata = pdev->dev.platform_data;
 490         int ret = -1;
 491
 492     LOG("Enter %s\n", __func__);
 493
 494         if (!pdata) {
 495 #ifdef CONFIG_OF
 496         pdata = kzalloc(sizeof(struct rksdmmc_gpio_wifi_moudle), GFP_KERNEL);
 497         if (!pdata)
 498             return -ENOMEM;
 499
 500         ret = wlan_platdata_parse_dt(&pdev->dev, pdata);
 501         if (ret < 0) {
 502 #endif
 503                     LOG("%s: No platform data specified\n", __func__);
 504             return ret;
 505 #ifdef CONFIG_OF
 506         }
 507 #endif
 508         }
 509
 510         rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL);
 511         if (!rfkill)
 512         goto rfkill_alloc_fail;
 513
 514         rfkill->pdata = pdata;
 515     g_rfkill = rfkill;
 516
 517     LOG("%s: init gpio\n", __func__);
 518
 519     ret = rfkill_rk_setup_gpio(&pdata->power_n, wlan_name, "wlan_poweren");
 520     if (ret) goto fail_alloc;
 521
 522     ret = rfkill_rk_setup_gpio(&pdata->reset_n, wlan_name, "wlan_reset");
 523     if (ret) goto fail_alloc;
 524 /*
 525         ret = rfkill_rk_setup_gpio(&pdata->vddio, IOMUX_FGPIO, wlan_name, "wlan-vddio");
 526         if (ret) goto fail_alloc;
 527
 528         ret = rfkill_rk_setup_gpio(&pdata->bgf_int_b, IOMUX_FGPIO, wlan_name, "bgf_int_b");
 529         if (ret) goto fail_alloc;
 530
 531     ret = rfkill_rk_setup_gpio(&pdata->gps_sync, IOMUX_FGPIO, wlan_name, "gps_sync");
 532     if (ret) goto fail_alloc;
 533
 534         ret = rfkill_rk_setup_gpio(&pdata->ANTSEL2, IOMUX_FGPIO, wlan_name, "ANTSEL2");
 535         if (ret) goto fail_alloc;
 536
 537         ret = rfkill_rk_setup_gpio(&pdata->ANTSEL3, IOMUX_FGPIO, wlan_name, "ANTSEL3");
 538         if (ret) goto fail_alloc;
 539
 540         ret = rfkill_rk_setup_gpio(&pdata->GPS_LAN, IOMUX_FGPIO, wlan_name, "GPS_LAN");
 541         if (ret) goto fail_alloc;
 542 */
 543     wake_lock_init(&(rfkill->wlan_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_wlan_wake");
 544
 545     // Turn off wifi power as default
 546     if (gpio_is_valid(pdata->power_n.io))
 547     {
 548         gpio_direction_output(pdata->power_n.io, pdata->power_n.enable);
 549     }
 550
 551 #if BCM_STATIC_MEMORY_SUPPORT
 552     rockchip_init_wifi_mem();
 553 #endif
 554
 555 #if defined(CONFIG_HAS_EARLYSUSPEND)
 556     register_early_suspend(wlan_early_suspend);
 557 #endif
 558
 559     LOG("Exit %s\n", __func__);
 560
 561         return 0;
 562
 563 fail_alloc:
 564         kfree(rfkill);
 565 rfkill_alloc_fail:
 566     kfree(pdata);
 567
 568     g_rfkill = NULL;
 569
 570         return ret;
 571 }
 572
 573 static int rfkill_wlan_remove(struct platform_device *pdev)
 574 {
 575         struct rfkill_wlan_data *rfkill = platform_get_drvdata(pdev);
 576
 577     LOG("Enter %s\n", __func__);
 578
 579     wake_lock_destroy(&rfkill->wlan_irq_wl);
 580
 581     if (gpio_is_valid(rfkill->pdata->power_n.io))
 582         gpio_free(rfkill->pdata->power_n.io);
 583
 584     if (gpio_is_valid(rfkill->pdata->reset_n.io))
 585         gpio_free(rfkill->pdata->reset_n.io);
 586
 587 //    if (gpio_is_valid(rfkill->pdata->vddio.io))
 588 //        gpio_free(rfkill->pdata->vddio.io);
 589 //
 590 //    if (gpio_is_valid(rfkill->pdata->bgf_int_b.io))
 591 //        gpio_free(rfkill->pdata->bgf_int_b.io);
 592 //
 593 //    if (gpio_is_valid(rfkill->pdata->gps_sync.io))
 594 //        gpio_free(rfkill->pdata->gps_sync.io);
 595 //
 596 //    if (gpio_is_valid(rfkill->pdata->ANTSEL2.io))
 597 //        gpio_free(rfkill->pdata->ANTSEL2.io);
 598 //
 599 //    if (gpio_is_valid(rfkill->pdata->ANTSEL3.io))
 600 //        gpio_free(rfkill->pdata->ANTSEL3.io);
 601 //
 602 //    if (gpio_is_valid(rfkill->pdata->GPS_LAN.io))
 603 //        gpio_free(rfkill->pdata->GPS_LAN.io);
 604
 605     kfree(rfkill);
 606     g_rfkill = NULL;
 607
 608         return 0;
 609 }
 610
 611 static int rfkill_wlan_suspend(struct platform_device *pdev, pm_message_t state)
 612 {
 613     LOG("Enter %s\n", __func__);
 614     return 0;
 615 }
 616
 617 static int rfkill_wlan_resume(struct platform_device *pdev)
 618 {
 619     LOG("Enter %s\n", __func__);
 620     return 0;
 621 }
 622
 623 #ifdef CONFIG_OF
 624 static struct of_device_id wlan_platdata_of_match[] = {
 625     { .compatible = "wlan-platdata" },
 626     { }
 627 };
 628 MODULE_DEVICE_TABLE(of, wlan_platdata_of_match);
 629 #endif //CONFIG_OF
 630
 631 static struct platform_driver rfkill_wlan_driver = {
 632         .probe = rfkill_wlan_probe,
 633         .remove = rfkill_wlan_remove,
 634     .suspend = rfkill_wlan_suspend,
 635     .resume = rfkill_wlan_resume,
 636         .driver = {
 637                 .name = "wlan-platdata",
 638                 .owner = THIS_MODULE,
 639         .of_match_table = of_match_ptr(wlan_platdata_of_match),
 640         },
 641 };
 642
 643 static int __init rfkill_wlan_init(void)
 644 {
 645     LOG("Enter %s\n", __func__);
 646         return platform_driver_register(&rfkill_wlan_driver);
 647 }
 648
 649 static void __exit rfkill_wlan_exit(void)
 650 {
 651     LOG("Enter %s\n", __func__);
 652         platform_driver_unregister(&rfkill_wlan_driver);
 653 }
 654
 655 module_init(rfkill_wlan_init);
 656 module_exit(rfkill_wlan_exit);
 657
 658 MODULE_DESCRIPTION("rock-chips rfkill for wifi v0.1");
 659 MODULE_AUTHOR("gwl@rock-chips.com");
 660 MODULE_LICENSE("GPL");