bcmdhd.101.10.361.x/dhd_gpio.c - manifest_repos/dhd-driver - Git at Google


 #include <osl.h>
 #include <dhd_linux.h>
 #include <linux/gpio.h>

 #if defined(BUS_POWER_RESTORE) && defined(BCMSDIO)
 #include <linux/mmc/core.h>
 #include <linux/mmc/card.h>
 #include <linux/mmc/host.h>
 #include <linux/mmc/sdio_func.h>
 #endif /* defined(BUS_POWER_RESTORE) && defined(BCMSDIO) */

 #ifdef CONFIG_DHD_USE_STATIC_BUF
 #ifdef DHD_STATIC_IN_DRIVER
 extern int dhd_static_buf_init(void);
 extern void dhd_static_buf_exit(void);
 #endif /* DHD_STATIC_IN_DRIVER */
 #ifdef BCMDHD_MDRIVER
 extern void *bcmdhd_mem_prealloc(uint bus_type, int index,
 	int section, unsigned long size);
 #else
 extern void *bcmdhd_mem_prealloc(int section, unsigned long size);
 #endif
 #endif /* CONFIG_DHD_USE_STATIC_BUF */

 #ifdef BCMDHD_DTS
 /* This is sample code in dts file.
 bcmdhd {
 	compatible = "android,bcmdhd_wlan";
 	gpio_wl_reg_on = <&gpio GPIOH_4 GPIO_ACTIVE_HIGH>;
 	gpio_wl_host_wake = <&gpio GPIOZ_15 GPIO_ACTIVE_HIGH>;
 };
 */
 #define DHD_DT_COMPAT_ENTRY		"android,bcmdhd_wlan"
 #define GPIO_WL_REG_ON_PROPNAME		"gpio_wl_reg_on"
 #define GPIO_WL_HOST_WAKE_PROPNAME	"gpio_wl_host_wake"
 #endif

 #ifdef CUSTOMER_HW_AMLOGIC
 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0))
 #include <linux/amlogic/aml_gpio_consumer.h>
 extern int wifi_irq_trigger_level(void);
 extern u8 *wifi_get_mac(void);
 extern u8 *wifi_get_ap_mac(void);
 #endif
 extern void sdio_reinit(void);
 extern void set_usb_bt_power(int is_power);
 extern void set_usb_wifi_power(int is_power);
 extern void extern_wifi_set_enable(int is_on);
 extern void pci_remove_reinit(unsigned int vid, unsigned int pid, int delBus);
 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0))
 extern int wifi_irq_num(void);
 #endif
 int dhd_pwr_ctrl = 1;
 module_param(dhd_pwr_ctrl, int, 0);
 #endif

 static int
 dhd_wlan_set_power(int on, wifi_adapter_info_t *adapter)
 {
 	int gpio_wl_reg_on = adapter->gpio_wl_reg_on;
 	int err = 0;

 #ifdef CUSTOMER_HW_AMLOGIC
     printf("######### dhd_pwr_ctrl=%d #########\n", dhd_pwr_ctrl);
 #endif

 	if (on) {
 		printf("======== PULL WL_REG_ON(%d) HIGH! ========\n", gpio_wl_reg_on);
 		if (gpio_wl_reg_on >= 0) {
 			err = gpio_direction_output(gpio_wl_reg_on, 1);
 			if (err) {
 				printf("%s: WL_REG_ON didn't output high\n", __FUNCTION__);
 				return -EIO;
 			}
 		}
 #ifdef CUSTOMER_HW_AMLOGIC
 #ifdef BCMSDIO
 		extern_wifi_set_enable(0);
 		mdelay(200);
 		extern_wifi_set_enable(1);
 		mdelay(200);
 //		sdio_reinit();
 #endif
 #ifdef BCMDBUS
     if (dhd_pwr_ctrl) {
 		set_usb_wifi_power(0);
 		mdelay(200);
 		set_usb_wifi_power(1);
 		mdelay(200);
     }
 #endif
 #endif
 #ifdef BUS_POWER_RESTORE
 #ifdef BCMSDIO
 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 19, 0)
 		if (adapter->sdio_func && adapter->sdio_func->card && adapter->sdio_func->card->host) {
 			mdelay(100);
 			printf("======== mmc_power_restore_host! ========\n");
 			mmc_power_restore_host(adapter->sdio_func->card->host);
 		}
 #endif
 #elif defined(BCMPCIE)
 		if (adapter->pci_dev) {
 			mdelay(100);
 			printf("======== pci_set_power_state PCI_D0! ========\n");
 			pci_set_power_state(adapter->pci_dev, PCI_D0);
 			if (adapter->pci_saved_state)
 				pci_load_and_free_saved_state(adapter->pci_dev, &adapter->pci_saved_state);
 			pci_restore_state(adapter->pci_dev);
 			err = pci_enable_device(adapter->pci_dev);
 			if (err < 0)
 				printf("%s: PCI enable device failed", __FUNCTION__);
 			pci_set_master(adapter->pci_dev);
 		}
 #endif /* BCMPCIE */
 #endif /* BUS_POWER_RESTORE */
 		/* Lets customer power to get stable */
 		mdelay(100);
 	} else {
 #ifdef BUS_POWER_RESTORE
 #ifdef BCMSDIO
 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 19, 0)
 		if (adapter->sdio_func && adapter->sdio_func->card && adapter->sdio_func->card->host) {
 			printf("======== mmc_power_save_host! ========\n");
 			mmc_power_save_host(adapter->sdio_func->card->host);
 		}
 #endif
 #elif defined(BCMPCIE)
 		if (adapter->pci_dev) {
 			printf("======== pci_set_power_state PCI_D3hot! ========\n");
 			pci_save_state(adapter->pci_dev);
 			adapter->pci_saved_state = pci_store_saved_state(adapter->pci_dev);
 			if (pci_is_enabled(adapter->pci_dev))
 				pci_disable_device(adapter->pci_dev);
 			pci_set_power_state(adapter->pci_dev, PCI_D3hot);
 		}
 #endif /* BCMPCIE */
 #endif /* BUS_POWER_RESTORE */
 		printf("======== PULL WL_REG_ON(%d) LOW! ========\n", gpio_wl_reg_on);
 		if (gpio_wl_reg_on >= 0) {
 			err = gpio_direction_output(gpio_wl_reg_on, 0);
 			if (err) {
 				printf("%s: WL_REG_ON didn't output low\n", __FUNCTION__);
 				return -EIO;
 			}
 		}
 #ifdef CUSTOMER_HW_AMLOGIC
 #ifdef BCMSDIO
 		extern_wifi_set_enable(0);
 		mdelay(200);
 #endif
 #ifdef BCMDBUS
     if (dhd_pwr_ctrl) {
 		set_usb_wifi_power(0);
 		mdelay(200);
     }
 #endif
 #endif
 	}

 	return err;
 }

 static int dhd_wlan_set_reset(int onoff)
 {
 	return 0;
 }

 static int dhd_wlan_set_carddetect(int present)
 {
 	int err = 0;

 #if !defined(BUS_POWER_RESTORE)
 	if (present) {
 #if defined(BCMSDIO)
 		printf("======== Card detection to detect SDIO card! ========\n");
 #ifdef CUSTOMER_HW_PLATFORM
 		err = sdhci_force_presence_change(&sdmmc_channel, 1);
 #endif /* CUSTOMER_HW_PLATFORM */
 #ifdef CUSTOMER_HW_AMLOGIC
 		sdio_reinit();
 #endif
 #elif defined(BCMPCIE)
 		printf("======== Card detection to detect PCIE card! ========\n");
 #endif
 	} else {
 #if defined(BCMSDIO)
 		printf("======== Card detection to remove SDIO card! ========\n");
 #ifdef CUSTOMER_HW_PLATFORM
 		err = sdhci_force_presence_change(&sdmmc_channel, 0);
 #endif /* CUSTOMER_HW_PLATFORM */
 #ifdef CUSTOMER_HW_AMLOGIC
 		extern_wifi_set_enable(0);
 		mdelay(200);
 #endif
 #elif defined(BCMPCIE)
 		printf("======== Card detection to remove PCIE card! ========\n");
 #ifdef CUSTOMER_HW_AMLOGIC
 		//extern_wifi_set_enable(0);
 		//mdelay(200);
 #endif
 #endif
 	}
 #endif /* BUS_POWER_RESTORE */

 	return err;
 }

 static int dhd_wlan_get_mac_addr(unsigned char *buf, int ifidx)
 {
 	int err = 0;

 	if (ifidx == 1) {
 #ifdef EXAMPLE_GET_MAC
 		struct ether_addr ea_example = {{0x00, 0x11, 0x22, 0x33, 0x44, 0xFF}};
 		bcopy((char *)&ea_example, buf, sizeof(struct ether_addr));
 #endif /* EXAMPLE_GET_MAC */
 #ifdef CUSTOMER_HW_AMLOGIC
 #ifdef CUSTOM_AP_MAC
 		bcopy((char *)wifi_get_ap_mac(), buf, sizeof(struct ether_addr));
 		if (buf[0] == 0xff) {
 			printf("custom wifi ap mac is not set\n");
 			err = -1;
 		} else
 			printf("custom wifi ap mac-addr: %02x:%02x:%02x:%02x:%02x:%02x\n",
 				buf[0], buf[1], buf[2],
 				buf[3], buf[4], buf[5]);
 #else
 		err = -1;
 #endif
 #endif
 	} else {
 #ifdef EXAMPLE_GET_MAC
 		struct ether_addr ea_example = {{0x02, 0x11, 0x22, 0x33, 0x44, 0x55}};
 		bcopy((char *)&ea_example, buf, sizeof(struct ether_addr));
 #endif /* EXAMPLE_GET_MAC */
 #ifdef CUSTOMER_HW_AMLOGIC
 		bcopy((char *)wifi_get_mac(), buf, sizeof(struct ether_addr));
 		if (buf[0] == 0xff) {
 			printf("custom wifi mac is not set\n");
 			err = -1;
 		} else
 			printf("custom wifi mac-addr: %02x:%02x:%02x:%02x:%02x:%02x\n",
 				buf[0], buf[1], buf[2],
 				buf[3], buf[4], buf[5]);
 #endif
 	}

 #ifdef EXAMPLE_GET_MAC_VER2
 	/* EXAMPLE code */
 	{
 		char macpad[56]= {
 		0x00,0xaa,0x9c,0x84,0xc7,0xbc,0x9b,0xf6,
 		0x02,0x33,0xa9,0x4d,0x5c,0xb4,0x0a,0x5d,
 		0xa8,0xef,0xb0,0xcf,0x8e,0xbf,0x24,0x8a,
 		0x87,0x0f,0x6f,0x0d,0xeb,0x83,0x6a,0x70,
 		0x4a,0xeb,0xf6,0xe6,0x3c,0xe7,0x5f,0xfc,
 		0x0e,0xa7,0xb3,0x0f,0x00,0xe4,0x4a,0xaf,
 		0x87,0x08,0x16,0x6d,0x3a,0xe3,0xc7,0x80};
 		bcopy(macpad, buf+6, sizeof(macpad));
 	}
 #endif /* EXAMPLE_GET_MAC_VER2 */

 	printf("======== %s err=%d ========\n", __FUNCTION__, err);

 	return err;
 }

 static struct cntry_locales_custom brcm_wlan_translate_custom_table[] = {
 	/* Table should be filled out based on custom platform regulatory requirement */
 #ifdef EXAMPLE_TABLE
 	{"",   "XT", 49},  /* Universal if Country code is unknown or empty */
 	{"US", "US", 0},
 #endif /* EXMAPLE_TABLE */
 };

 #ifdef CUSTOM_FORCE_NODFS_FLAG
 struct cntry_locales_custom brcm_wlan_translate_nodfs_table[] = {
 #ifdef EXAMPLE_TABLE
 	{"",   "XT", 50},  /* Universal if Country code is unknown or empty */
 	{"US", "US", 0},
 #endif /* EXMAPLE_TABLE */
 };
 #endif

 static void *dhd_wlan_get_country_code(char *ccode
 #ifdef CUSTOM_FORCE_NODFS_FLAG
 	, u32 flags
 #endif
 )
 {
 	struct cntry_locales_custom *locales;
 	int size;
 	int i;

 	if (!ccode)
 		return NULL;

 #ifdef CUSTOM_FORCE_NODFS_FLAG
 	if (flags & WLAN_PLAT_NODFS_FLAG) {
 		locales = brcm_wlan_translate_nodfs_table;
 		size = ARRAY_SIZE(brcm_wlan_translate_nodfs_table);
 	} else {
 #endif
 		locales = brcm_wlan_translate_custom_table;
 		size = ARRAY_SIZE(brcm_wlan_translate_custom_table);
 #ifdef CUSTOM_FORCE_NODFS_FLAG
 	}
 #endif

 	for (i = 0; i < size; i++)
 		if (strcmp(ccode, locales[i].iso_abbrev) == 0)
 			return &locales[i];
 	return NULL;
 }

 struct wifi_platform_data dhd_wlan_control = {
 	.set_power	= dhd_wlan_set_power,
 	.set_reset	= dhd_wlan_set_reset,
 	.set_carddetect	= dhd_wlan_set_carddetect,
 	.get_mac_addr	= dhd_wlan_get_mac_addr,
 #ifdef CONFIG_DHD_USE_STATIC_BUF
 	.mem_prealloc	= bcmdhd_mem_prealloc,
 #endif /* CONFIG_DHD_USE_STATIC_BUF */
 	.get_country_code = dhd_wlan_get_country_code,
 };

 int dhd_wlan_init_gpio(wifi_adapter_info_t *adapter)
 {
 #ifdef BCMDHD_DTS
 	char wlan_node[32];
 	struct device_node *root_node = NULL;
 #endif
 	int err = 0;
 	int gpio_wl_reg_on;
 #ifdef CUSTOMER_OOB
 	int gpio_wl_host_wake;
 	int host_oob_irq = -1;
 	uint host_oob_irq_flags = 0;
 #endif

 	/* Please check your schematic and fill right GPIO number which connected to
 	* WL_REG_ON and WL_HOST_WAKE.
 	*/
 #ifdef BCMDHD_DTS
 	strcpy(wlan_node, DHD_DT_COMPAT_ENTRY);
 	printf("======== Get GPIO from DTS(%s) ========\n", wlan_node);
 	root_node = of_find_compatible_node(NULL, NULL, wlan_node);
 	if (root_node) {
 		gpio_wl_reg_on = of_get_named_gpio(root_node, GPIO_WL_REG_ON_PROPNAME, 0);
 #ifdef CUSTOMER_OOB
 		gpio_wl_host_wake = of_get_named_gpio(root_node, GPIO_WL_HOST_WAKE_PROPNAME, 0);
 #endif
 	} else
 #endif
 	{
 		gpio_wl_reg_on = -1;
 #ifdef CUSTOMER_OOB
 		gpio_wl_host_wake = -1;
 #endif
 	}

 #ifdef CUSTOMER_HW_AMLOGIC
 #if defined(BCMPCIE)
 	printf("======== Card detection to detect PCIE card! ========\n");
 //	pci_remove_reinit(0x14e4, 0x43ec, 1);
 #endif
 #endif

 	if (gpio_wl_reg_on >= 0) {
 		err = gpio_request(gpio_wl_reg_on, "WL_REG_ON");
 		if (err < 0) {
 			printf("%s: gpio_request(%d) for WL_REG_ON failed\n",
 				__FUNCTION__, gpio_wl_reg_on);
 			gpio_wl_reg_on = -1;
 		}
 	}
 	adapter->gpio_wl_reg_on = gpio_wl_reg_on;

 #ifdef CUSTOMER_OOB
 	if (gpio_wl_host_wake >= 0) {
 		err = gpio_request(gpio_wl_host_wake, "bcmdhd");
 		if (err < 0) {
 			printf("%s: gpio_request(%d) for WL_HOST_WAKE failed\n",
 				__FUNCTION__, gpio_wl_host_wake);
 			return -1;
 		}
 		adapter->gpio_wl_host_wake = gpio_wl_host_wake;
 		err = gpio_direction_input(gpio_wl_host_wake);
 		if (err < 0) {
 			printf("%s: gpio_direction_input(%d) for WL_HOST_WAKE failed\n",
 				__FUNCTION__, gpio_wl_host_wake);
 			gpio_free(gpio_wl_host_wake);
 			return -1;
 		}
 		host_oob_irq = gpio_to_irq(gpio_wl_host_wake);
 		if (host_oob_irq < 0) {
 			printf("%s: gpio_to_irq(%d) for WL_HOST_WAKE failed\n",
 				__FUNCTION__, gpio_wl_host_wake);
 			gpio_free(gpio_wl_host_wake);
 			return -1;
 		}
 	}
 #ifdef CUSTOMER_HW_AMLOGIC
 #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0))
 	host_oob_irq = INT_GPIO_4;
 #else
 	host_oob_irq = wifi_irq_num();
 #endif
 #endif

 #ifdef HW_OOB
 #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0))
 	if (wifi_irq_trigger_level() == GPIO_IRQ_LOW)
 		host_oob_irq_flags = IORESOURCE_IRQ | IORESOURCE_IRQ_LOWLEVEL | IORESOURCE_IRQ_SHAREABLE;
 	else
 		host_oob_irq_flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHLEVEL | IORESOURCE_IRQ_SHAREABLE;
 #else
 #ifdef HW_OOB_LOW_LEVEL
 	host_oob_irq_flags = IORESOURCE_IRQ | IORESOURCE_IRQ_LOWLEVEL | IORESOURCE_IRQ_SHAREABLE;
 #else
 	host_oob_irq_flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHLEVEL | IORESOURCE_IRQ_SHAREABLE;
 #endif
 #endif
 #else
 	host_oob_irq_flags = IORESOURCE_IRQ | IORESOURCE_IRQ_HIGHEDGE | IORESOURCE_IRQ_SHAREABLE;
 #endif
 	host_oob_irq_flags &= IRQF_TRIGGER_MASK;

 	adapter->irq_num = host_oob_irq;
 	adapter->intr_flags = host_oob_irq_flags;
 	printf("%s: WL_HOST_WAKE=%d, oob_irq=%d, oob_irq_flags=0x%x\n", __FUNCTION__,
 		gpio_wl_host_wake, host_oob_irq, host_oob_irq_flags);
 #endif /* CUSTOMER_OOB */
 	printf("%s: WL_REG_ON=%d\n", __FUNCTION__, gpio_wl_reg_on);

 	return 0;
 }

 static void dhd_wlan_deinit_gpio(wifi_adapter_info_t *adapter)
 {
 	int gpio_wl_reg_on = adapter->gpio_wl_reg_on;
 #ifdef CUSTOMER_OOB
 	int gpio_wl_host_wake = adapter->gpio_wl_host_wake;
 #endif

 	if (gpio_wl_reg_on >= 0) {
 		printf("%s: gpio_free(WL_REG_ON %d)\n", __FUNCTION__, gpio_wl_reg_on);
 		gpio_free(gpio_wl_reg_on);
 		gpio_wl_reg_on = -1;
 	}
 #ifdef CUSTOMER_OOB
 	if (gpio_wl_host_wake >= 0) {
 		printf("%s: gpio_free(WL_HOST_WAKE %d)\n", __FUNCTION__, gpio_wl_host_wake);
 		gpio_free(gpio_wl_host_wake);
 		gpio_wl_host_wake = -1;
 	}
 #endif /* CUSTOMER_OOB */
 }

 int dhd_wlan_init_plat_data(wifi_adapter_info_t *adapter)
 {
 	int err = 0;

 	printf("======== %s ========\n", __FUNCTION__);
 	if (adapter->index == -1) {
 		adapter->index = 0;
 	}
 	err = dhd_wlan_init_gpio(adapter);

 #ifdef DHD_STATIC_IN_DRIVER
 	dhd_static_buf_init();
 #endif
 	return err;
 }

 void dhd_wlan_deinit_plat_data(wifi_adapter_info_t *adapter)
 {
 	printf("======== %s ========\n", __FUNCTION__);
 #ifdef DHD_STATIC_IN_DRIVER
 	dhd_static_buf_exit();
 #endif
 	dhd_wlan_deinit_gpio(adapter);
 }

	#include <osl.h>
	#include <dhd_linux.h>
	#include <linux/gpio.h>

	#if defined(BUS_POWER_RESTORE) && defined(BCMSDIO)
	#include <linux/mmc/core.h>
	#include <linux/mmc/card.h>
	#include <linux/mmc/host.h>
	#include <linux/mmc/sdio_func.h>
	#endif /* defined(BUS_POWER_RESTORE) && defined(BCMSDIO) */

	#ifdef CONFIG_DHD_USE_STATIC_BUF
	#ifdef DHD_STATIC_IN_DRIVER
	extern int dhd_static_buf_init(void);
	extern void dhd_static_buf_exit(void);
	#endif /* DHD_STATIC_IN_DRIVER */
	#ifdef BCMDHD_MDRIVER
	extern void *bcmdhd_mem_prealloc(uint bus_type, int index,
	int section, unsigned long size);
	#else
	extern void *bcmdhd_mem_prealloc(int section, unsigned long size);
	#endif
	#endif /* CONFIG_DHD_USE_STATIC_BUF */

	#ifdef BCMDHD_DTS
	/* This is sample code in dts file.
	bcmdhd {
	compatible = "android,bcmdhd_wlan";
	gpio_wl_reg_on = <&gpio GPIOH_4 GPIO_ACTIVE_HIGH>;
	gpio_wl_host_wake = <&gpio GPIOZ_15 GPIO_ACTIVE_HIGH>;
	};
	*/
	#define DHD_DT_COMPAT_ENTRY "android,bcmdhd_wlan"
	#define GPIO_WL_REG_ON_PROPNAME "gpio_wl_reg_on"
	#define GPIO_WL_HOST_WAKE_PROPNAME "gpio_wl_host_wake"
	#endif

	#ifdef CUSTOMER_HW_AMLOGIC
	#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0))
	#include <linux/amlogic/aml_gpio_consumer.h>
	extern int wifi_irq_trigger_level(void);
	extern u8 *wifi_get_mac(void);
	extern u8 *wifi_get_ap_mac(void);
	#endif
	extern void sdio_reinit(void);
	extern void set_usb_bt_power(int is_power);
	extern void set_usb_wifi_power(int is_power);
	extern void extern_wifi_set_enable(int is_on);
	extern void pci_remove_reinit(unsigned int vid, unsigned int pid, int delBus);
	#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0))
	extern int wifi_irq_num(void);
	#endif
	int dhd_pwr_ctrl = 1;
	module_param(dhd_pwr_ctrl, int, 0);
	#endif

	static int
	dhd_wlan_set_power(int on, wifi_adapter_info_t *adapter)
	{
	int gpio_wl_reg_on = adapter->gpio_wl_reg_on;
	int err = 0;

	#ifdef CUSTOMER_HW_AMLOGIC
	printf("######### dhd_pwr_ctrl=%d #########\n", dhd_pwr_ctrl);
	#endif

	if (on) {
	printf("======== PULL WL_REG_ON(%d) HIGH! ========\n", gpio_wl_reg_on);
	if (gpio_wl_reg_on >= 0) {
	err = gpio_direction_output(gpio_wl_reg_on, 1);
	if (err) {
	printf("%s: WL_REG_ON didn't output high\n", __FUNCTION__);
	return -EIO;
	}
	}
	#ifdef CUSTOMER_HW_AMLOGIC
	#ifdef BCMSDIO
	extern_wifi_set_enable(0);
	mdelay(200);
	extern_wifi_set_enable(1);
	mdelay(200);
	// sdio_reinit();
	#endif
	#ifdef BCMDBUS
	if (dhd_pwr_ctrl) {
	set_usb_wifi_power(0);
	mdelay(200);
	set_usb_wifi_power(1);
	mdelay(200);
	}
	#endif
	#endif
	#ifdef BUS_POWER_RESTORE
	#ifdef BCMSDIO
	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 19, 0)
	if (adapter->sdio_func && adapter->sdio_func->card && adapter->sdio_func->card->host) {
	mdelay(100);
	printf("======== mmc_power_restore_host! ========\n");
	mmc_power_restore_host(adapter->sdio_func->card->host);
	}
	#endif
	#elif defined(BCMPCIE)
	if (adapter->pci_dev) {
	mdelay(100);
	printf("======== pci_set_power_state PCI_D0! ========\n");
	pci_set_power_state(adapter->pci_dev, PCI_D0);
	if (adapter->pci_saved_state)
	pci_load_and_free_saved_state(adapter->pci_dev, &adapter->pci_saved_state);
	pci_restore_state(adapter->pci_dev);
	err = pci_enable_device(adapter->pci_dev);
	if (err < 0)
	printf("%s: PCI enable device failed", __FUNCTION__);
	pci_set_master(adapter->pci_dev);
	}
	#endif /* BCMPCIE */
	#endif /* BUS_POWER_RESTORE */
	/* Lets customer power to get stable */
	mdelay(100);
	} else {
	#ifdef BUS_POWER_RESTORE
	#ifdef BCMSDIO
	#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32) && LINUX_VERSION_CODE < KERNEL_VERSION(4, 19, 0)
	if (adapter->sdio_func && adapter->sdio_func->card && adapter->sdio_func->card->host) {
	printf("======== mmc_power_save_host! ========\n");
	mmc_power_save_host(adapter->sdio_func->card->host);
	}
	#endif
	#elif defined(BCMPCIE)
	if (adapter->pci_dev) {
	printf("======== pci_set_power_state PCI_D3hot! ========\n");
	pci_save_state(adapter->pci_dev);
	adapter->pci_saved_state = pci_store_saved_state(adapter->pci_dev);
	if (pci_is_enabled(adapter->pci_dev))
	pci_disable_device(adapter->pci_dev);
	pci_set_power_state(adapter->pci_dev, PCI_D3hot);
	}
	#endif /* BCMPCIE */
	#endif /* BUS_POWER_RESTORE */
	printf("======== PULL WL_REG_ON(%d) LOW! ========\n", gpio_wl_reg_on);
	if (gpio_wl_reg_on >= 0) {
	err = gpio_direction_output(gpio_wl_reg_on, 0);
	if (err) {
	printf("%s: WL_REG_ON didn't output low\n", __FUNCTION__);
	return -EIO;
	}
	}
	#ifdef CUSTOMER_HW_AMLOGIC
	#ifdef BCMSDIO
	extern_wifi_set_enable(0);
	mdelay(200);
	#endif
	#ifdef BCMDBUS
	if (dhd_pwr_ctrl) {
	set_usb_wifi_power(0);
	mdelay(200);
	}
	#endif
	#endif
	}

	return err;
	}

	static int dhd_wlan_set_reset(int onoff)
	{
	return 0;
	}

	static int dhd_wlan_set_carddetect(int present)
	{
	int err = 0;

	#if !defined(BUS_POWER_RESTORE)
	if (present) {
	#if defined(BCMSDIO)
	printf("======== Card detection to detect SDIO card! ========\n");
	#ifdef CUSTOMER_HW_PLATFORM
	err = sdhci_force_presence_change(&sdmmc_channel, 1);
	#endif /* CUSTOMER_HW_PLATFORM */
	#ifdef CUSTOMER_HW_AMLOGIC
	sdio_reinit();
	#endif
	#elif defined(BCMPCIE)
	printf("======== Card detection to detect PCIE card! ========\n");
	#endif
	} else {
	#if defined(BCMSDIO)
	printf("======== Card detection to remove SDIO card! ========\n");
	#ifdef CUSTOMER_HW_PLATFORM
	err = sdhci_force_presence_change(&sdmmc_channel, 0);
	#endif /* CUSTOMER_HW_PLATFORM */
	#ifdef CUSTOMER_HW_AMLOGIC
	extern_wifi_set_enable(0);
	mdelay(200);
	#endif
	#elif defined(BCMPCIE)
	printf("======== Card detection to remove PCIE card! ========\n");
	#ifdef CUSTOMER_HW_AMLOGIC
	//extern_wifi_set_enable(0);
	//mdelay(200);
	#endif
	#endif
	}
	#endif /* BUS_POWER_RESTORE */

	return err;
	}

	static int dhd_wlan_get_mac_addr(unsigned char *buf, int ifidx)
	{
	int err = 0;

	if (ifidx == 1) {
	#ifdef EXAMPLE_GET_MAC
	struct ether_addr ea_example = {{0x00, 0x11, 0x22, 0x33, 0x44, 0xFF}};
	bcopy((char *)&ea_example, buf, sizeof(struct ether_addr));
	#endif /* EXAMPLE_GET_MAC */
	#ifdef CUSTOMER_HW_AMLOGIC
	#ifdef CUSTOM_AP_MAC
	bcopy((char *)wifi_get_ap_mac(), buf, sizeof(struct ether_addr));
	if (buf[0] == 0xff) {
	printf("custom wifi ap mac is not set\n");
	err = -1;
	} else
	printf("custom wifi ap mac-addr: %02x:%02x:%02x:%02x:%02x:%02x\n",
	buf[0], buf[1], buf[2],
	buf[3], buf[4], buf[5]);
	#else
	err = -1;
	#endif
	#endif
	} else {
	#ifdef EXAMPLE_GET_MAC
	struct ether_addr ea_example = {{0x02, 0x11, 0x22, 0x33, 0x44, 0x55}};
	bcopy((char *)&ea_example, buf, sizeof(struct ether_addr));
	#endif /* EXAMPLE_GET_MAC */
	#ifdef CUSTOMER_HW_AMLOGIC
	bcopy((char *)wifi_get_mac(), buf, sizeof(struct ether_addr));
	if (buf[0] == 0xff) {
	printf("custom wifi mac is not set\n");
	err = -1;
	} else
	printf("custom wifi mac-addr: %02x:%02x:%02x:%02x:%02x:%02x\n",
	buf[0], buf[1], buf[2],
	buf[3], buf[4], buf[5]);
	#endif
	}

	#ifdef EXAMPLE_GET_MAC_VER2
	/* EXAMPLE code */
	{
	char macpad[56]= {
	0x00,0xaa,0x9c,0x84,0xc7,0xbc,0x9b,0xf6,
	0x02,0x33,0xa9,0x4d,0x5c,0xb4,0x0a,0x5d,
	0xa8,0xef,0xb0,0xcf,0x8e,0xbf,0x24,0x8a,
	0x87,0x0f,0x6f,0x0d,0xeb,0x83,0x6a,0x70,
	0x4a,0xeb,0xf6,0xe6,0x3c,0xe7,0x5f,0xfc,
	0x0e,0xa7,0xb3,0x0f,0x00,0xe4,0x4a,0xaf,
	0x87,0x08,0x16,0x6d,0x3a,0xe3,0xc7,0x80};
	bcopy(macpad, buf+6, sizeof(macpad));
	}
	#endif /* EXAMPLE_GET_MAC_VER2 */

	printf("======== %s err=%d ========\n", __FUNCTION__, err);

	return err;
	}

	static struct cntry_locales_custom brcm_wlan_translate_custom_table[] = {
	/* Table should be filled out based on custom platform regulatory requirement */
	#ifdef EXAMPLE_TABLE
	{"", "XT", 49}, /* Universal if Country code is unknown or empty */
	{"US", "US", 0},
	#endif /* EXMAPLE_TABLE */
	};

	#ifdef CUSTOM_FORCE_NODFS_FLAG
	struct cntry_locales_custom brcm_wlan_translate_nodfs_table[] = {
	#ifdef EXAMPLE_TABLE
	{"", "XT", 50}, /* Universal if Country code is unknown or empty */
	{"US", "US", 0},
	#endif /* EXMAPLE_TABLE */
	};
	#endif

	static void dhd_wlan_get_country_code(char ccode
	#ifdef CUSTOM_FORCE_NODFS_FLAG
	, u32 flags
	#endif
	)
	{
	struct cntry_locales_custom *locales;
	int size;
	int i;

	if (!ccode)
	return NULL;

	#ifdef CUSTOM_FORCE_NODFS_FLAG
	if (flags & WLAN_PLAT_NODFS_FLAG) {
	locales = brcm_wlan_translate_nodfs_table;
	size = ARRAY_SIZE(brcm_wlan_translate_nodfs_table);
	} else {
	#endif
	locales = brcm_wlan_translate_custom_table;
	size = ARRAY_SIZE(brcm_wlan_translate_custom_table);
	#ifdef CUSTOM_FORCE_NODFS_FLAG
	}
	#endif

	for (i = 0; i < size; i++)
	if (strcmp(ccode, locales[i].iso_abbrev) == 0)
	return &locales[i];
	return NULL;
	}

	struct wifi_platform_data dhd_wlan_control = {
	.set_power = dhd_wlan_set_power,
	.set_reset = dhd_wlan_set_reset,
	.set_carddetect = dhd_wlan_set_carddetect,
	.get_mac_addr = dhd_wlan_get_mac_addr,
	#ifdef CONFIG_DHD_USE_STATIC_BUF
	.mem_prealloc = bcmdhd_mem_prealloc,
	#endif /* CONFIG_DHD_USE_STATIC_BUF */
	.get_country_code = dhd_wlan_get_country_code,
	};

	int dhd_wlan_init_gpio(wifi_adapter_info_t *adapter)
	{
	#ifdef BCMDHD_DTS
	char wlan_node[32];
	struct device_node *root_node = NULL;
	#endif
	int err = 0;
	int gpio_wl_reg_on;
	#ifdef CUSTOMER_OOB
	int gpio_wl_host_wake;
	int host_oob_irq = -1;
	uint host_oob_irq_flags = 0;
	#endif

	/* Please check your schematic and fill right GPIO number which connected to
	* WL_REG_ON and WL_HOST_WAKE.
	*/
	#ifdef BCMDHD_DTS
	strcpy(wlan_node, DHD_DT_COMPAT_ENTRY);
	printf("======== Get GPIO from DTS(%s) ========\n", wlan_node);
	root_node = of_find_compatible_node(NULL, NULL, wlan_node);
	if (root_node) {
	gpio_wl_reg_on = of_get_named_gpio(root_node, GPIO_WL_REG_ON_PROPNAME, 0);
	#ifdef CUSTOMER_OOB
	gpio_wl_host_wake = of_get_named_gpio(root_node, GPIO_WL_HOST_WAKE_PROPNAME, 0);
	#endif
	} else
	#endif
	{
	gpio_wl_reg_on = -1;
	#ifdef CUSTOMER_OOB
	gpio_wl_host_wake = -1;
	#endif
	}

	#ifdef CUSTOMER_HW_AMLOGIC
	#if defined(BCMPCIE)
	printf("======== Card detection to detect PCIE card! ========\n");
	// pci_remove_reinit(0x14e4, 0x43ec, 1);
	#endif
	#endif

	if (gpio_wl_reg_on >= 0) {
	err = gpio_request(gpio_wl_reg_on, "WL_REG_ON");
	if (err < 0) {
	printf("%s: gpio_request(%d) for WL_REG_ON failed\n",
	__FUNCTION__, gpio_wl_reg_on);
	gpio_wl_reg_on = -1;
	}
	}
	adapter->gpio_wl_reg_on = gpio_wl_reg_on;

	#ifdef CUSTOMER_OOB
	if (gpio_wl_host_wake >= 0) {
	err = gpio_request(gpio_wl_host_wake, "bcmdhd");
	if (err < 0) {
	printf("%s: gpio_request(%d) for WL_HOST_WAKE failed\n",
	__FUNCTION__, gpio_wl_host_wake);
	return -1;
	}
	adapter->gpio_wl_host_wake = gpio_wl_host_wake;
	err = gpio_direction_input(gpio_wl_host_wake);
	if (err < 0) {
	printf("%s: gpio_direction_input(%d) for WL_HOST_WAKE failed\n",
	__FUNCTION__, gpio_wl_host_wake);
	gpio_free(gpio_wl_host_wake);
	return -1;
	}
	host_oob_irq = gpio_to_irq(gpio_wl_host_wake);
	if (host_oob_irq < 0) {
	printf("%s: gpio_to_irq(%d) for WL_HOST_WAKE failed\n",
	__FUNCTION__, gpio_wl_host_wake);
	gpio_free(gpio_wl_host_wake);
	return -1;
	}
	}
	#ifdef CUSTOMER_HW_AMLOGIC
	#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0))
	host_oob_irq = INT_GPIO_4;
	#else
	host_oob_irq = wifi_irq_num();
	#endif
	#endif

	#ifdef HW_OOB
	#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0))
	if (wifi_irq_trigger_level() == GPIO_IRQ_LOW)
	host_oob_irq_flags = IORESOURCE_IRQ \| IORESOURCE_IRQ_LOWLEVEL \| IORESOURCE_IRQ_SHAREABLE;
	else
	host_oob_irq_flags = IORESOURCE_IRQ \| IORESOURCE_IRQ_HIGHLEVEL \| IORESOURCE_IRQ_SHAREABLE;
	#else
	#ifdef HW_OOB_LOW_LEVEL
	host_oob_irq_flags = IORESOURCE_IRQ \| IORESOURCE_IRQ_LOWLEVEL \| IORESOURCE_IRQ_SHAREABLE;
	#else
	host_oob_irq_flags = IORESOURCE_IRQ \| IORESOURCE_IRQ_HIGHLEVEL \| IORESOURCE_IRQ_SHAREABLE;
	#endif
	#endif
	#else
	host_oob_irq_flags = IORESOURCE_IRQ \| IORESOURCE_IRQ_HIGHEDGE \| IORESOURCE_IRQ_SHAREABLE;
	#endif
	host_oob_irq_flags &= IRQF_TRIGGER_MASK;

	adapter->irq_num = host_oob_irq;
	adapter->intr_flags = host_oob_irq_flags;
	printf("%s: WL_HOST_WAKE=%d, oob_irq=%d, oob_irq_flags=0x%x\n", __FUNCTION__,
	gpio_wl_host_wake, host_oob_irq, host_oob_irq_flags);
	#endif /* CUSTOMER_OOB */
	printf("%s: WL_REG_ON=%d\n", __FUNCTION__, gpio_wl_reg_on);

	return 0;
	}

	static void dhd_wlan_deinit_gpio(wifi_adapter_info_t *adapter)
	{
	int gpio_wl_reg_on = adapter->gpio_wl_reg_on;
	#ifdef CUSTOMER_OOB
	int gpio_wl_host_wake = adapter->gpio_wl_host_wake;
	#endif

	if (gpio_wl_reg_on >= 0) {
	printf("%s: gpio_free(WL_REG_ON %d)\n", __FUNCTION__, gpio_wl_reg_on);
	gpio_free(gpio_wl_reg_on);
	gpio_wl_reg_on = -1;
	}
	#ifdef CUSTOMER_OOB
	if (gpio_wl_host_wake >= 0) {
	printf("%s: gpio_free(WL_HOST_WAKE %d)\n", __FUNCTION__, gpio_wl_host_wake);
	gpio_free(gpio_wl_host_wake);
	gpio_wl_host_wake = -1;
	}
	#endif /* CUSTOMER_OOB */
	}

	int dhd_wlan_init_plat_data(wifi_adapter_info_t *adapter)
	{
	int err = 0;

	printf("======== %s ========\n", __FUNCTION__);
	if (adapter->index == -1) {
	adapter->index = 0;
	}
	err = dhd_wlan_init_gpio(adapter);

	#ifdef DHD_STATIC_IN_DRIVER
	dhd_static_buf_init();
	#endif
	return err;
	}

	void dhd_wlan_deinit_plat_data(wifi_adapter_info_t *adapter)
	{
	printf("======== %s ========\n", __FUNCTION__);
	#ifdef DHD_STATIC_IN_DRIVER
	dhd_static_buf_exit();
	#endif
	dhd_wlan_deinit_gpio(adapter);
	}