iommu/rockchip: don't do power domain enable on probe
[firefly-linux-kernel-4.4.55.git] / net / rfkill / rfkill-wlan.c
old mode 100755 (executable)
new mode 100644 (file)
index 7ee0790..070ef05
@@ -20,7 +20,6 @@
 #include <linux/rfkill.h>
 #include <linux/init.h>
 #include <linux/slab.h>
-#include <asm/gpio.h>
 #include <linux/regulator/consumer.h>
 #include <linux/delay.h>
 #include <linux/rfkill-wlan.h>
 #include <linux/rockchip/iomap.h>
 #include <dt-bindings/gpio/gpio.h>
 #include <linux/skbuff.h>
-#include <linux/rockchip/cpu.h>
+#include <linux/fb.h>
+#include <linux/rockchip/grf.h>
+#include <linux/rockchip/common.h>
+#include <linux/regmap.h>
+#include <linux/mfd/syscon.h>
+#include <linux/mmc/host.h>
 #ifdef CONFIG_OF
 #include <linux/of.h>
 #include <linux/of_device.h>
 #include <linux/of_gpio.h>
 #endif
+#include <linux/soc/rockchip/rk_vendor_storage.h>
 
 #if 0
 #define DBG(x...)   printk(KERN_INFO "[WLAN_RFKILL]: "x)
 
 #define LOG(x...)   printk(KERN_INFO "[WLAN_RFKILL]: "x)
 
+extern struct mmc_host *primary_sdio_host;
+extern void mmc_pwrseq_power_off(struct mmc_host *host);
+
 struct rfkill_wlan_data {
        struct rksdmmc_gpio_wifi_moudle *pdata;
     struct wake_lock            wlan_irq_wl;
 };
 
 static struct rfkill_wlan_data *g_rfkill = NULL;
+static int power_set_time = 0;
 
 static const char wlan_name[] = 
 #if defined (CONFIG_BCM4330)
@@ -95,14 +104,52 @@ static char wifi_chip_type_string[64];
 int get_wifi_chip_type(void)
 {
     int type;
-    if (strcmp(wifi_chip_type_string, "rkwifi") == 0) {
-        type = WIFI_RKWIFI;
+    if (strcmp(wifi_chip_type_string, "ap6210") == 0) {
+        type = WIFI_AP6210;
+    } else if (strcmp(wifi_chip_type_string, "ap6212") == 0) {
+        type = WIFI_AP6212;
+    } else if (strcmp(wifi_chip_type_string, "rk901") == 0) {
+        type = WIFI_RK901;    
+    } else if (strcmp(wifi_chip_type_string, "rk903") == 0) {
+        type = WIFI_RK903;  
+    } else if (strcmp(wifi_chip_type_string, "ap6181") == 0) {
+        type = WIFI_AP6181;
+    } else if (strcmp(wifi_chip_type_string, "ap6234") == 0) {
+        type = WIFI_AP6234;                            
+    } else if (strcmp(wifi_chip_type_string, "ap6330") == 0) {
+        type = WIFI_AP6330;
+    } else if (strcmp(wifi_chip_type_string, "ap6335") == 0) {
+        type = WIFI_AP6335;
+    } else if (strcmp(wifi_chip_type_string, "ap6354") == 0) {
+        type = WIFI_AP6354;
+    } else if (strcmp(wifi_chip_type_string, "ap6441") == 0) {
+        type = WIFI_AP6441;
+    } else if (strcmp(wifi_chip_type_string, "ap6476") == 0) {
+        type = WIFI_AP6476;    
+    } else if (strcmp(wifi_chip_type_string, "ap6493") == 0) {
+        type = WIFI_AP6493;                    
     } else if (strcmp(wifi_chip_type_string, "rtl8188eu") == 0) {
         type = WIFI_RTL8188EU;
+    } else if (strcmp(wifi_chip_type_string, "rtl8192du") == 0) {
+        type = WIFI_RTL8192DU;
+    } else if (strcmp(wifi_chip_type_string, "rtl8723as") == 0) {
+        type = WIFI_RTL8723AS;        
+    } else if (strcmp(wifi_chip_type_string, "rtl8723bs_vq0") == 0) {
+        type = WIFI_RTL8723BS_VQ0;        
+    } else if (strcmp(wifi_chip_type_string, "rtl8723bs") == 0) {
+        type = WIFI_RTL8723BS;
+    } else if (strcmp(wifi_chip_type_string, "rtl8723au") == 0) {
+        type = WIFI_RTL8723AU;        
+    } else if (strcmp(wifi_chip_type_string, "rtl8723bu") == 0) {
+        type = WIFI_RTL8723BU;
+    } else if (strcmp(wifi_chip_type_string, "rtl8189es") == 0) {
+        type = WIFI_RTL8189ES;
+    } else if (strcmp(wifi_chip_type_string, "rtl8812au") == 0) {
+        type = WIFI_RTL8812AU;                        
     } else if (strcmp(wifi_chip_type_string, "esp8089") == 0) {
         type = WIFI_ESP8089;
     } else {
-        type = WIFI_RKWIFI;
+        type = WIFI_AP6210;
     }
     return type;
 }
@@ -114,7 +161,7 @@ EXPORT_SYMBOL(get_wifi_chip_type);
  * 
  **********************************************************/
 #ifdef CONFIG_RKWIFI
-#define BCM_STATIC_MEMORY_SUPPORT 1
+#define BCM_STATIC_MEMORY_SUPPORT 0
 #else
 #define BCM_STATIC_MEMORY_SUPPORT 0
 #endif
@@ -226,107 +273,11 @@ int rfkill_get_wifi_power_state(int *power, int *vref_ctrl_enable)
         return -1;
     }
 
-    if (mrfkill->pdata->vref_ctrl_enble)
-        *vref_ctrl_enable = 1;
     *power = wifi_power_state;
 
     return 0;
 }
 
-/**************************************************************************
- *
- * wifi reference voltage control Func
- *
- *************************************************************************/
-int rockchip_wifi_ref_voltage(int on)
-{
-    struct rfkill_wlan_data *mrfkill = g_rfkill;
-    struct rksdmmc_gpio *vddio;
-    struct regulator *ldo = NULL;
-    int power = 0;
-    bool toggle = false;
-
-    LOG("%s: %d\n", __func__, on);
-
-    if (mrfkill == NULL) {
-        LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
-        return -1;
-    }
-
-    if (!mrfkill->pdata->vref_ctrl_enble) {
-        LOG("%s: wifi io reference voltage control is disabled.\n", __func__);
-        return 0;
-    }
-
-    if (!rfkill_get_bt_power_state(&power, &toggle)) {
-        if (power == 1) {
-            LOG("%s: wifi shouldn't control io reference voltage, BT is running!\n", __func__);
-            return 0;
-        }
-    }
-
-    if (mrfkill->pdata->ioregulator.power_ctrl_by_pmu) {
-        int ret = -1;
-        char *ldostr;
-        int level = mrfkill->pdata->ioregulator.enable;
-               int voltage = 1000 * mrfkill->pdata->sdio_vol;
-
-        ldostr = mrfkill->pdata->ioregulator.pmu_regulator;
-        if (ldostr == NULL) {
-            LOG("%s: wifi io reference voltage set to be controled by pmic, but which one?\n", __func__);
-            return -1;
-        }
-        ldo = regulator_get(NULL, ldostr);
-        if (ldo == NULL || IS_ERR(ldo)) {
-            LOG("\n\n\n%s get ldo error,please mod this\n\n\n", __func__);
-            return -1;
-        } else {
-            if (on == level) {
-               if(cpu_is_rk3036())
-               {
-                                       /*regulator_set_voltage(ldo, voltage, voltage);
-                                       LOG("%s: %s enabled, level = %d\n", __func__, ldostr, voltage);
-                                       ret = regulator_enable(ldo);
-                                       LOG("wifi turn on io reference voltage.\n");*/
-               }else{
-                                       regulator_set_voltage(ldo, voltage, voltage);
-                                       LOG("%s: %s enabled, level = %d\n", __func__, ldostr, voltage);
-                                       ret = regulator_enable(ldo);
-                                       LOG("wifi turn on io reference voltage.\n");
-               }
-            } else {
-                LOG("%s: %s disabled\n", __func__, ldostr);
-                while (regulator_is_enabled(ldo) > 0) {
-                    ret = regulator_disable(ldo);
-                }
-                LOG("wifi shut off io reference voltage.\n");
-            }
-            regulator_put(ldo);
-            msleep(100);
-        }
-    } else {
-        vddio = &mrfkill->pdata->power_n;
-
-        if (on){
-            if (gpio_is_valid(vddio->io)) {
-                gpio_set_value(vddio->io, vddio->enable);
-                msleep(100);
-            }
-
-            LOG("wifi turn on io reference voltage.\n");
-        }else{
-            if (gpio_is_valid(vddio->io)) {
-                gpio_set_value(vddio->io, !(vddio->enable));
-                msleep(100);
-            }
-
-            LOG("wifi shut off io reference voltage.\n");
-        }
-    }
-
-       return 0;
-}
-
 /**************************************************************************
  *
  * Wifi Power Control Func
@@ -344,20 +295,25 @@ int rockchip_wifi_power(int on)
 
     LOG("%s: %d\n", __func__, on);
 
+       if (!on && primary_sdio_host)
+               mmc_pwrseq_power_off(primary_sdio_host);
+
     if (mrfkill == NULL) {
         LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
         return -1;
     }
 
+    if (mrfkill->pdata->wifi_power_remain && power_set_time) {
+        LOG("%s: wifi power is setted to be remain on. skip anything to the power control", __func__);
+        return 0;
+    } else power_set_time++;
+
     if (!rfkill_get_bt_power_state(&power, &toggle)) {
         if (toggle == true && power == 1) {
             LOG("%s: wifi shouldn't control the power, it was enabled by BT!\n", __func__);
             return 0;
         }
     }
-    
-    if (on)
-        rockchip_wifi_ref_voltage(1);
 
     if (mrfkill->pdata->mregulator.power_ctrl_by_pmu) {
         int ret = -1;
@@ -423,9 +379,6 @@ int rockchip_wifi_power(int on)
                }
     }
 
-    if (!on)
-        rockchip_wifi_ref_voltage(0);
-
     return 0;
 }
 EXPORT_SYMBOL(rockchip_wifi_power);
@@ -435,11 +388,10 @@ EXPORT_SYMBOL(rockchip_wifi_power);
  * Wifi Sdio Detect Func
  *
  *************************************************************************/
-#include <linux/mmc/host.h>
-extern int mmc_host_rescan(struct mmc_host *host, int val);
+extern int mmc_host_rescan(struct mmc_host *host, int val, int irq_type);
 int rockchip_wifi_set_carddetect(int val)
 {
-    return mmc_host_rescan(NULL, val);//NULL => SDIO host
+       return mmc_host_rescan(NULL, val, 1);
 }
 EXPORT_SYMBOL(rockchip_wifi_set_carddetect);
 
@@ -489,50 +441,73 @@ EXPORT_SYMBOL(rockchip_wifi_reset);
  *
  *************************************************************************/
 #include <linux/etherdevice.h>
+#include <linux/errno.h>
 u8 wifi_custom_mac_addr[6] = {0,0,0,0,0,0};
-extern char GetSNSectorInfo(char * pbuf);
+
+//#define RANDOM_ADDRESS_SAVE
+static int get_wifi_addr_vendor(unsigned char *addr)
+{
+       int ret;
+
+       ret = rk_vendor_read(WIFI_MAC_ID, addr, 6);
+       if (ret != 6 || is_zero_ether_addr(addr)) {
+               LOG("%s: rk_vendor_read wifi mac address failed (%d)\n",
+                   __func__, ret);
+#ifdef RANDOM_ADDRESS_SAVE
+               random_ether_addr(addr);
+               LOG("%s: generate random wifi mac address: "
+                   "%02x:%02x:%02x:%02x:%02x:%02x\n",
+                   __func__, addr[0], addr[1], addr[2],
+                   addr[3], addr[4], addr[5]);
+               ret = rk_vendor_write(WIFI_MAC_ID, addr, 6);
+               if (ret != 0) {
+                       LOG("%s: rk_vendor_write"
+                               " wifi mac address failed (%d)\n",
+                               __func__, ret);
+                       memset(addr, 0, 6);
+                       return -1;
+               }
+#else
+               return -1;
+#endif
+       } else {
+               LOG("%s: rk_vendor_read wifi mac address: "
+                   "%02x:%02x:%02x:%02x:%02x:%02x\n",
+                   __func__, addr[0], addr[1], addr[2],
+                   addr[3], addr[4], addr[5]);
+       }
+       return 0;
+}
+
 int rockchip_wifi_mac_addr(unsigned char *buf)
 {
-    return -1;
-/*
-    char mac_buf[20] = {0};
-    LOG("%s: enter.\n", __func__);
-
-    // from vflash
-    if(is_zero_ether_addr(wifi_custom_mac_addr)) {
-        int i;
-        char *tempBuf = kmalloc(512, GFP_KERNEL);
-        if(tempBuf) {
-            GetSNSectorInfo(tempBuf);
-            for (i = 506; i <= 511; i++)
-                wifi_custom_mac_addr[i-506] = tempBuf[i];
-            kfree(tempBuf);
-        } else {
-            return -1;
-        }
-    }
+       char mac_buf[20] = {0};
 
-    sprintf(mac_buf,"%02x:%02x:%02x:%02x:%02x:%02x",wifi_custom_mac_addr[0],wifi_custom_mac_addr[1],
-    wifi_custom_mac_addr[2],wifi_custom_mac_addr[3],wifi_custom_mac_addr[4],wifi_custom_mac_addr[5]);
-    LOG("falsh wifi_custom_mac_addr=[%s]\n", mac_buf);
+       LOG("%s: enter.\n", __func__);
 
-    if (is_valid_ether_addr(wifi_custom_mac_addr)) {
-        if (2 == (wifi_custom_mac_addr[0] & 0x0F)) {
-            LOG("This mac address come into conflict with the address of direct, ignored...\n");
-            return -1;
-        }
-    } else {
-        LOG("This mac address is not valid, ignored...\n");
-        return -1;
-    }
+       // from vendor storage
+       if (is_zero_ether_addr(wifi_custom_mac_addr)) {
+               if (get_wifi_addr_vendor(wifi_custom_mac_addr) != 0)
+                       return -1;
+       }
 
-#if defined(CONFIG_RKWIFI)
-    memcpy(buf, wifi_custom_mac_addr, 6);
-#else
-    memcpy(buf, mac_buf, strlen(mac_buf));//realtek's wifi use this branch
-#endif
-    return 0;
-*/
+       sprintf(mac_buf, "%02x:%02x:%02x:%02x:%02x:%02x",
+               wifi_custom_mac_addr[0], wifi_custom_mac_addr[1],
+               wifi_custom_mac_addr[2], wifi_custom_mac_addr[3],
+               wifi_custom_mac_addr[4], wifi_custom_mac_addr[5]);
+       LOG("falsh wifi_custom_mac_addr=[%s]\n", mac_buf);
+
+       if (is_valid_ether_addr(wifi_custom_mac_addr)) {
+               if (!strncmp(wifi_chip_type_string, "rtl", 3))
+                       wifi_custom_mac_addr[0] &= ~0x2; // for p2p
+       } else {
+               LOG("This mac address is not valid, ignored...\n");
+               return -1;
+       }
+
+       memcpy(buf, wifi_custom_mac_addr, 6);
+
+       return 0;
 }
 EXPORT_SYMBOL(rockchip_wifi_mac_addr);
 
@@ -563,30 +538,6 @@ void *rockchip_wifi_country_code(char *ccode)
 EXPORT_SYMBOL(rockchip_wifi_country_code);
 /**************************************************************************/
 
-static int rockchip_wifi_voltage_select(void)
-{
-    struct rfkill_wlan_data *mrfkill = g_rfkill;
-    int voltage = 0;
-
-    if (mrfkill == NULL) {
-        LOG("%s: rfkill-wlan driver has not Successful initialized\n", __func__);
-        return -1;
-    }
-    voltage = mrfkill->pdata->sdio_vol;
-    if (voltage > 2700 && voltage < 3500) {
-        writel_relaxed(0x00100000, RK_GRF_VIRT+0x380); //3.3
-        LOG("%s: wifi & sdio reference voltage: 3.3V\n", __func__);
-    } else if (voltage  > 1500 && voltage < 1950) {
-        writel_relaxed(0x00100010, RK_GRF_VIRT+0x380); //1.8
-        LOG("%s: wifi & sdio reference voltage: 1.8V\n", __func__);
-    } else {
-        LOG("%s: unsupport wifi & sdio reference voltage!\n", __func__);
-        return -1;
-    }
-
-    return 0;
-}
-
 static int rfkill_rk_setup_gpio(struct rksdmmc_gpio *gpio, const char* prefix, const char* name)
 {
     if (gpio_is_valid(gpio->io)) {
@@ -617,69 +568,29 @@ static int wlan_platdata_parse_dt(struct device *dev,
 
     memset(data, 0, sizeof(*data));
 
+#ifdef CONFIG_MFD_SYSCON
+    data->grf = syscon_regmap_lookup_by_phandle(node, "rockchip,grf");
+    if (IS_ERR(data->grf)) {
+            LOG("can't find rockchip,grf property\n");
+            //return -1;
+    }
+#endif
+
     ret = of_property_read_string(node, "wifi_chip_type", &strings);
     if (ret) {
-        printk("%s: Can not read wifi_chip_type, set default to rkwifi.\n", __func__);
+        LOG("%s: Can not read wifi_chip_type, set default to rkwifi.\n", __func__);
         strcpy(wifi_chip_type_string, "rkwifi");
+    } else {
+        strcpy(wifi_chip_type_string, strings);
     }
-    strcpy(wifi_chip_type_string, strings);
-    printk("%s: wifi_chip_type = %s\n", __func__, wifi_chip_type_string);
+    LOG("%s: wifi_chip_type = %s\n", __func__, wifi_chip_type_string);
 
-       if(cpu_is_rk3036()){
-               /* ret = of_property_read_u32(node, "sdio_vref", &value);
-               if (ret < 0) {
-                       LOG("%s: Can't get sdio vref.", __func__);
-                       return -1;
-               }
-               data->sdio_vol = value;*/
-       }else{
-               ret = of_property_read_u32(node, "sdio_vref", &value);
-               if (ret < 0) {
-                       LOG("%s: Can't get sdio vref.", __func__);
-                       return -1;
-               }
-               data->sdio_vol = value;
-       }
-
-    if (of_find_property(node, "vref_ctrl_enable", NULL)) {
-        LOG("%s: enable wifi io reference voltage control.\n", __func__);
-        data->vref_ctrl_enble = true;
-        if (of_find_property(node, "vref_ctrl_gpio", NULL)) {
-            gpio = of_get_named_gpio_flags(node, "vref_ctrl_gpio", 0, &flags);
-            if (gpio_is_valid(gpio)){
-                data->vddio.io = gpio;
-                data->vddio.enable = (flags == GPIO_ACTIVE_HIGH)? 1:0;
-                data->ioregulator.power_ctrl_by_pmu = false;
-                LOG("%s: get property: vref_ctrl_gpio = %d, flags = %d.\n", __func__, gpio, flags);
-            } else {
-                data->vddio.io = -1;
-                data->vref_ctrl_enble = false;
-                LOG("%s: vref_ctrl_gpio defined invalid, disable wifi io reference voltage control.\n", __func__);
-            }
-        } else {
-            data->ioregulator.power_ctrl_by_pmu = true;
-            ret = of_property_read_string(node, "vref_pmu_regulator", &strings);
-            if (ret) {
-                LOG("%s: Can not read property: vref_pmu_regulator.\n", __func__);
-                data->vref_ctrl_enble = false;
-                data->ioregulator.power_ctrl_by_pmu = false;
-            } else {
-                LOG("%s: wifi io reference voltage controled by pmu(%s).\n", __func__, strings);
-                sprintf(data->ioregulator.pmu_regulator, "%s", strings);
-            }
-            ret = of_property_read_u32(node, "vref_pmu_enable_level", &value);
-            if (ret) {
-                LOG("%s: Can not read property: vref_pmu_enable_level.\n", __func__);
-                data->vref_ctrl_enble = false;
-                data->ioregulator.power_ctrl_by_pmu = false;
-            } else {
-                LOG("%s: wifi io reference voltage controled by pmu(level = %s).\n", __func__, (value == 1)?"HIGH":"LOW");
-                data->ioregulator.enable = value;
-            }
-        }
+    if (of_find_property(node, "keep_wifi_power_on", NULL)) {
+        data->wifi_power_remain = true;
+        LOG("%s: wifi power will enabled while kernel starting and keep on.\n", __func__);
     } else {
-        data->vref_ctrl_enble = false;
-        LOG("%s: disable wifi io reference voltage control.\n", __func__);
+        data->wifi_power_remain = false;
+        LOG("%s: enable wifi power control.\n", __func__);
     }
 
     if (of_find_property(node, "power_ctrl_by_pmu", NULL)) {
@@ -751,6 +662,47 @@ struct early_suspend wlan_early_suspend {
 }
 #endif
 
+static void rfkill_wlan_early_suspend(void)
+{
+    //LOG("%s :enter\n", __func__);
+
+    return;
+}
+
+static void rfkill_wlan_later_resume(void)
+{
+    //LOG("%s :enter\n", __func__);
+
+    return;
+}
+
+static int rfkill_wlan_fb_event_notify(struct notifier_block *self,
+                       unsigned long action, void *data)
+{
+
+    struct fb_event *event = data;
+    int blank_mode = *((int *)event->data);
+
+    switch (blank_mode) {
+    case FB_BLANK_UNBLANK:
+        rfkill_wlan_later_resume();
+        break;
+    case FB_BLANK_NORMAL:
+        rfkill_wlan_early_suspend();
+        break;
+    default:
+        rfkill_wlan_early_suspend();
+        break;
+    }
+
+    return 0;
+}
+
+static struct notifier_block rfkill_wlan_fb_notifier = {
+    .notifier_call = rfkill_wlan_fb_event_notify,
+};
+
+
 static int rfkill_wlan_probe(struct platform_device *pdev)
 {
        struct rfkill_wlan_data *rfkill;
@@ -800,7 +752,10 @@ static int rfkill_wlan_probe(struct platform_device *pdev)
         gpio_direction_output(pdata->power_n.io, !pdata->power_n.enable);
     }
 
-    rockchip_wifi_voltage_select();
+    if (pdata->wifi_power_remain)
+    {
+        rockchip_wifi_power(1);
+    }
 
 #if BCM_STATIC_MEMORY_SUPPORT
     rockchip_init_wifi_mem();
@@ -809,6 +764,8 @@ static int rfkill_wlan_probe(struct platform_device *pdev)
 #if defined(CONFIG_HAS_EARLYSUSPEND)
     register_early_suspend(wlan_early_suspend);
 #endif
+    
+    fb_register_client(&rfkill_wlan_fb_notifier);
 
     LOG("Exit %s\n", __func__);
 
@@ -831,6 +788,8 @@ static int rfkill_wlan_remove(struct platform_device *pdev)
     LOG("Enter %s\n", __func__);
 
     wake_lock_destroy(&rfkill->wlan_irq_wl);
+
+    fb_unregister_client(&rfkill_wlan_fb_notifier);
     
     if (gpio_is_valid(rfkill->pdata->power_n.io))
         gpio_free(rfkill->pdata->power_n.io);