shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-04-10 23:18:10 +09:00
Code Issues Packages Projects Releases Wiki Activity

wifi: add wifi power manage driver rfkill-wlan.c.

Browse Source
This commit is contained in:
gwl
2014-02-27 16:19:40 +08:00
parent 51af772efb
commit a0e2bfba26
4 changed files with 712 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

46
include/linux/rfkill-wlan.h Executable file
View File

@@ -0,0 +1,46 @@
#ifndef __PLAT_BOARD_H
#define __PLAT_BOARD_H
#include <linux/types.h>
#include <linux/init.h>
#include <linux/device.h>
struct rksdmmc_iomux {
char *name; //set the MACRO of gpio
int fgpio;
int fmux;
};
struct rksdmmc_gpio {
int io; //set the address of gpio
char name[64]; //
int enable; // disable = !enable //set the default value,i.e,GPIO_HIGH or GPIO_LOW
struct rksdmmc_iomux iomux;
};
struct rksdmmc_pmu {
bool power_ctrl_by_pmu;
char pmu_regulator[20];
int enable;
};
struct rksdmmc_gpio_wifi_moudle {
int sdio_vol; //sdio reference voltage
struct rksdmmc_pmu mregulator;
struct rksdmmc_gpio power_n; //PMU_EN
struct rksdmmc_gpio reset_n; //SYSRET_B, DAIRST
struct rksdmmc_gpio vddio;
struct rksdmmc_gpio bgf_int_b;
struct rksdmmc_gpio wifi_int_b;
struct rksdmmc_gpio gps_sync;
struct rksdmmc_gpio ANTSEL2; //pin5--ANTSEL2
struct rksdmmc_gpio ANTSEL3; //pin6--ANTSEL3
struct rksdmmc_gpio GPS_LAN; //pin33--GPS_LAN
};
void *rk29sdk_mem_prealloc(int section, unsigned long size);
int rk29sdk_wifi_power(int on);
int rk29sdk_wifi_reset(int on);
int rk29sdk_wifi_mac_addr(unsigned char *buf);
void *rk29sdk_wifi_country_code(char *ccode);
#endif

6
net/rfkill/Kconfig
View File

@@ -47,3 +47,9 @@ config RFKILL_GPIO
If you say yes here you get support of a generic gpio RFKILL
driver. The platform should fill in the appropriate fields in the
rfkill_gpio_platform_data structure and pass that to the driver.
config RFKILL_RK
bool "Rockchips RFKILL driver"
depends on RFKILL
help
rockchips rfkill driver for rk29/rk3X

1
net/rfkill/Makefile
View File

@@ -7,3 +7,4 @@ rfkill-$(CONFIG_RFKILL_INPUT) += input.o
obj-$(CONFIG_RFKILL) += rfkill.o
obj-$(CONFIG_RFKILL_REGULATOR) += rfkill-regulator.o
obj-$(CONFIG_RFKILL_GPIO) += rfkill-gpio.o
obj-$(CONFIG_RFKILL_RK) += rfkill-wlan.o

659
net/rfkill/rfkill-wlan.c Executable file
View File

@@ -0,0 +1,659 @@
/*
* Copyright (C) 2012 ROCKCHIP, Inc.
*
* This software is licensed under the terms of the GNU General Public
* License version 2, as published by the Free Software Foundation, and
* may be copied, distributed, and modified under those terms.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
/* Rock-chips rfkill driver for wifi
*/
#include <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/module.h>
#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-rk.h>
#include <linux/rfkill-wlan.h>
#include <linux/wakelock.h>
#include <linux/interrupt.h>
#include <asm/irq.h>
#include <linux/suspend.h>
#include <linux/proc_fs.h>
#include <linux/uaccess.h>
#include <linux/gpio.h>
#ifdef CONFIG_OF
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/of_gpio.h>
#endif
#if 0
#define DBG(x...) printk(KERN_INFO "[WLAN_RFKILL]: "x)
#else
#define DBG(x...)
#endif
#define LOG(x...) printk(KERN_INFO "[WLAN_RFKILL]: "x)
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 const char wlan_name[] =
#if defined (CONFIG_BCM4330)
#if defined (CONFIG_BT_MODULE_NH660)
"nh660"
#else
"bcm4330"
#endif
#elif defined (CONFIG_RK903)
#if defined(CONFIG_RKWIFI_26M)
"rk903_26M"
#else
"rk903"
#endif
#elif defined(CONFIG_BCM4329)
"bcm4329"
#elif defined(CONFIG_MV8787)
"mv8787"
#elif defined(CONFIG_AP6210)
#if defined(CONFIG_RKWIFI_26M)
"ap6210"
#else
"ap6210_24M"
#endif
#elif defined(CONFIG_AP6330)
"ap6330"
#elif defined(CONFIG_AP6476)
"ap6476"
#elif defined(CONFIG_AP6493)
"ap6493"
#else
"wlan_default"
#endif
;
/***********************************************************
*
* Broadcom Wifi Static Memory
*
**********************************************************/
#define BCM_STATIC_MEMORY_SUPPORT 0
//===========================
#if BCM_STATIC_MEMORY_SUPPORT
#define PREALLOC_WLAN_SEC_NUM 4
#define PREALLOC_WLAN_BUF_NUM 160
#define PREALLOC_WLAN_SECTION_HEADER 24
#define WLAN_SKB_BUF_NUM 16
#define WLAN_SECTION_SIZE_0 (PREALLOC_WLAN_BUF_NUM * 128)
#define WLAN_SECTION_SIZE_1 (PREALLOC_WLAN_BUF_NUM * 128)
#define WLAN_SECTION_SIZE_2 (PREALLOC_WLAN_BUF_NUM * 512)
#define WLAN_SECTION_SIZE_3 (PREALLOC_WLAN_BUF_NUM * 1024)
#define WLAN_SECTION_SIZE_5 (PREALLOC_WLAN_BUF_NUM * 512)
static struct sk_buff *wlan_static_skb[WLAN_SKB_BUF_NUM];
struct wifi_mem_prealloc {
void *mem_ptr;
unsigned long size;
};
static struct wifi_mem_prealloc wifi_mem_array[5] = {
{NULL, (WLAN_SECTION_SIZE_0 + PREALLOC_WLAN_SECTION_HEADER)},
{NULL, (WLAN_SECTION_SIZE_1 + PREALLOC_WLAN_SECTION_HEADER)},
{NULL, (WLAN_SECTION_SIZE_2 + PREALLOC_WLAN_SECTION_HEADER)},
{NULL, (WLAN_SECTION_SIZE_3 + PREALLOC_WLAN_SECTION_HEADER)},
{NULL, (WLAN_SECTION_SIZE_5 + PREALLOC_WLAN_SECTION_HEADER)}
};
static int __init rk29sdk_init_wifi_mem(void)
{
int i;
int j;
for (i = 0 ; i < WLAN_SKB_BUF_NUM ; i++) {
wlan_static_skb[i] = dev_alloc_skb(
((i < (WLAN_SKB_BUF_NUM / 2)) ? 4096 : 8192));
if (!wlan_static_skb[i])
goto err_skb_alloc;
}
for (i = 0 ; i < 5; i++) {
wifi_mem_array[i].mem_ptr =
kmalloc(wifi_mem_array[i].size, GFP_KERNEL);
if (!wifi_mem_array[i].mem_ptr)
goto err_mem_alloc;
}
return 0;
err_mem_alloc:
pr_err("Failed to mem_alloc for WLAN\n");
for (j = 0 ; j < i ; j++)
kfree(wifi_mem_array[j].mem_ptr);
i = WLAN_SKB_BUF_NUM;
err_skb_alloc:
pr_err("Failed to skb_alloc for WLAN\n");
for (j = 0 ; j < i ; j++)
dev_kfree_skb(wlan_static_skb[j]);
return -ENOMEM;
}
void *rk29sdk_mem_prealloc(int section, unsigned long size)
{
if (section == PREALLOC_WLAN_SEC_NUM)
return wlan_static_skb;
if ((section < 0) || (section > 5))
return NULL;
if (section == 5)
return wifi_mem_array[4].mem_ptr;
if (wifi_mem_array[section].size < size)
return NULL;
return wifi_mem_array[section].mem_ptr;
}
#else
void *rk29sdk_mem_prealloc(int section, unsigned long size) { return NULL;}
#endif
EXPORT_SYMBOL(rk29sdk_mem_prealloc);
/**************************************************************************
*
* Wifi Power Control Func
* 0 -> power off
* 1 -> power on
*
*************************************************************************/
int rk29sdk_wifi_power(int on)
{
struct rfkill_wlan_data *mrfkill = g_rfkill;
struct rksdmmc_gpio *poweron, *reset;
struct regulator *ldo = NULL;
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->mregulator.power_ctrl_by_pmu) {
char *ldostr;
int ret = -1;
int level = mrfkill->pdata->mregulator.enable;
ldostr = mrfkill->pdata->mregulator.pmu_regulator;
if (ldostr == NULL) {
LOG("%s: wifi power set to be controled by pmic, but which one?\n", __func__);
return -1;
}
ldo = regulator_get(NULL, ldostr);
if (ldo == NULL) {
LOG("\n\n\n%s get ldo error,please mod this\n\n\n", __func__);
} else {
if (on == level) {
regulator_set_voltage(ldo, 3000000, 3000000);
LOG("%s: %s enabled\n", __func__, ldostr);
ret = regulator_enable(ldo);
if(ret != 0){
LOG("%s: faild to enable %s\n", __func__, ldostr);
}
LOG("wifi turn on power.\n");
} else {
LOG("wifi shut off power.\n");
LOG("%s: %s disabled\n", __func__, ldostr);
ret = regulator_disable(ldo);
if(ret != 0){
LOG("%s: faild to disable %s\n", __func__, ldostr);
}
}
regulator_put(ldo);
mdelay(100);
}
} else {
poweron = &mrfkill->pdata->power_n;
reset = &mrfkill->pdata->reset_n;
if (on){
if (gpio_is_valid(poweron->io)) {
gpio_set_value(poweron->io, !(poweron->enable));
}
mdelay(100);
if (gpio_is_valid(reset->io)) {
gpio_set_value(reset->io, !(reset->enable));
}
mdelay(100);
LOG("wifi turn on power. %d\n", poweron->io);
}else{
if (gpio_is_valid(poweron->io)) {
gpio_set_value(poweron->io, poweron->enable);
}
mdelay(100);
if (gpio_is_valid(reset->io)) {
gpio_set_value(reset->io, reset->enable);
}
LOG("wifi shut off power.\n");
}
}
return 0;
}
EXPORT_SYMBOL(rk29sdk_wifi_power);
/**************************************************************************
*
* Wifi Reset Func
*
*************************************************************************/
int rk29sdk_wifi_reset(int on)
{
return 0;
}
EXPORT_SYMBOL(rk29sdk_wifi_reset);
/**************************************************************************
*
* Wifi MAC custom Func
*
*************************************************************************/
#include <linux/etherdevice.h>
u8 wifi_custom_mac_addr[6] = {0,0,0,0,0,0};
extern char GetSNSectorInfo(char * pbuf);
int rk29sdk_wifi_mac_addr(unsigned char *buf)
{
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;
}
}
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 (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;
}
#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;
}
EXPORT_SYMBOL(rk29sdk_wifi_mac_addr);
/**************************************************************************
*
* wifi get country code func
*
*************************************************************************/
struct cntry_locales_custom {
char iso_abbrev[4]; /* ISO 3166-1 country abbreviation */
char custom_locale[4]; /* Custom firmware locale */
int custom_locale_rev; /* Custom local revisin default -1 */
};
static struct cntry_locales_custom country_cloc;
void *rk29sdk_wifi_country_code(char *ccode)
{
struct cntry_locales_custom *mcloc;
LOG("%s: set country code [%s]\n", __func__, ccode);
mcloc = &country_cloc;
memcpy(mcloc->custom_locale, ccode, 4);
mcloc->custom_locale_rev = 0;
return mcloc;
}
/**************************************************************************/
static int rfkill_rk_setup_gpio(struct rksdmmc_gpio *gpio, const char* prefix, const char* name)
{
if (gpio_is_valid(gpio->io)) {
int ret=0;
sprintf(gpio->name, "%s_%s", prefix, name);
ret = gpio_request(gpio->io, gpio->name);
if (ret) {
LOG("Failed to get %s gpio.\n", gpio->name);
return -1;
}
}
return 0;
}
#ifdef CONFIG_OF
static int wlan_platdata_parse_dt(struct device *dev,
struct rksdmmc_gpio_wifi_moudle *data)
{
struct device_node *node = dev->of_node;
struct device_node *childnode, *grandchildnode;
const char *pin_funcs, *strings;
u32 value;
int gpio,ret;
enum of_gpio_flags flags;
if (!node)
return -ENODEV;
memset(data, 0, sizeof(*data));
ret = of_property_read_u32(node, "sdio_vref", &value);
if (ret < 0)
LOG("%s: Can't get sdio vref.", __func__);
data->sdio_vol = value;
childnode = of_get_child_by_name(node, "wlan_ctrl_pmic");
if (!childnode) {
LOG("%s: Can not get child => wlan_ctrl_pmic.\n", __func__);
} else {
ret = of_property_read_string(childnode, "power_ctrl_by_pmu", &strings);
if (ret) {
LOG("%s: Can not read property: power_ctrl_by_pmu.\n", __func__);
data->mregulator.power_ctrl_by_pmu = false;
}
if (0 == strcmp(strings, "true")) {
data->mregulator.power_ctrl_by_pmu = true;
ret = of_property_read_string(childnode, "pmu_regulator", &strings);
if (ret) {
LOG("%s: Can not read property: pmu_regulator.\n", __func__);
data->mregulator.power_ctrl_by_pmu = false;
} else {
LOG("%s: wifi power controled by pmu(%s).\n", __func__, strings);
sprintf(data->mregulator.pmu_regulator, "%s", strings);
}
ret = of_property_read_u32(childnode, "pmu_enable_level", &value);
if (ret) {
LOG("%s: Can not read property: pmu_enable_level.\n", __func__);
data->mregulator.power_ctrl_by_pmu = false;
} else {
LOG("%s: wifi power controled by pmu(level = %s).\n", __func__, (value == 1)?"HIGH":"LOW");
data->mregulator.enable = value;
}
} else {
data->mregulator.power_ctrl_by_pmu = false;
LOG("%s: wifi power controled by gpio.\n", __func__);
}
}
childnode = of_get_child_by_name(node, "wlan_ctrl_gpios");
if (!childnode) {
LOG("%s: Can not get child => wlan_ctrl_gpios.\n", __func__);
return -EINVAL;
}
for_each_child_of_node(childnode, grandchildnode) {
ret = of_property_read_string(grandchildnode, "pin-func", &pin_funcs);
if (ret) {
LOG("%s: Can not read property: pin-func.\n", __func__);
continue;
}
gpio = of_get_named_gpio_flags(grandchildnode, "gpios", 0, &flags);
if (!gpio_is_valid(gpio)){
LOG("%s: Can not read property: %s->gpios.\n", __func__, pin_funcs);
continue;
}
if (0 == strcmp(pin_funcs, "wlan_poweren")) {
data->power_n.io = gpio;
data->power_n.enable = flags;
LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
} else if (0 == strcmp(pin_funcs, "wlan_reset")) {
data->reset_n.io = gpio;
data->reset_n.enable = flags;
LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
} else if (0 == strcmp(pin_funcs, "wlan_wake_host_irq")) {
data->wifi_int_b.io = gpio;
data->wifi_int_b.enable = flags;
LOG("pin_funcs = %s, gpio = %d, flags = %d", pin_funcs, gpio, flags);
}
}
return 0;
}
#endif //CONFIG_OF
#if defined(CONFIG_HAS_EARLYSUSPEND)
#include <linux/earlysuspend.h>
static void wlan_early_suspend(struct early_suspend *h)
{
LOG("%s :enter\n", __func__);
return;
}
static void wlan_late_resume(struct early_suspend *h)
{
LOG("%s :enter\n", __func__);
return;
}
struct early_suspend wlan_early_suspend {
.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN - 20;
.suspend = wlan_early_suspend;
.resume = wlan_late_resume;
}
#endif
static int rfkill_wlan_probe(struct platform_device *pdev)
{
struct rfkill_wlan_data *rfkill;
struct rksdmmc_gpio_wifi_moudle *pdata = pdev->dev.platform_data;
int ret = -1;
LOG("Enter %s\n", __func__);
if (!pdata) {
#ifdef CONFIG_OF
pdata = kzalloc(sizeof(struct rksdmmc_gpio_wifi_moudle), GFP_KERNEL);
if (!pdata)
return -ENOMEM;
ret = wlan_platdata_parse_dt(&pdev->dev, pdata);
if (ret < 0) {
#endif
LOG("%s: No platform data specified\n", __func__);
return ret;
#ifdef CONFIG_OF
}
#endif
}
rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL);
if (!rfkill)
goto rfkill_alloc_fail;
rfkill->pdata = pdata;
g_rfkill = rfkill;
LOG("%s: init gpio\n", __func__);
ret = rfkill_rk_setup_gpio(&pdata->power_n, wlan_name, "wlan_poweren");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->reset_n, wlan_name, "wlan_reset");
if (ret) goto fail_alloc;
/*
ret = rfkill_rk_setup_gpio(&pdata->vddio, IOMUX_FGPIO, wlan_name, "wlan-vddio");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->bgf_int_b, IOMUX_FGPIO, wlan_name, "bgf_int_b");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->gps_sync, IOMUX_FGPIO, wlan_name, "gps_sync");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->ANTSEL2, IOMUX_FGPIO, wlan_name, "ANTSEL2");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->ANTSEL3, IOMUX_FGPIO, wlan_name, "ANTSEL3");
if (ret) goto fail_alloc;
ret = rfkill_rk_setup_gpio(&pdata->GPS_LAN, IOMUX_FGPIO, wlan_name, "GPS_LAN");
if (ret) goto fail_alloc;
*/
wake_lock_init(&(rfkill->wlan_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_wlan_wake");
// Turn off wifi power as default
if (gpio_is_valid(pdata->power_n.io))
{
gpio_direction_output(pdata->power_n.io, pdata->power_n.enable);
}
#if BCM_STATIC_MEMORY_SUPPORT
rk29sdk_init_wifi_mem();
#endif
#if defined(CONFIG_HAS_EARLYSUSPEND)
register_early_suspend(wlan_early_suspend);
#endif
LOG("Exit %s\n", __func__);
return 0;
fail_alloc:
kfree(rfkill);
rfkill_alloc_fail:
kfree(pdata);
g_rfkill = NULL;
return ret;
}
static int rfkill_wlan_remove(struct platform_device *pdev)
{
struct rfkill_wlan_data *rfkill = platform_get_drvdata(pdev);
LOG("Enter %s\n", __func__);
wake_lock_destroy(&rfkill->wlan_irq_wl);
if (gpio_is_valid(rfkill->pdata->power_n.io))
gpio_free(rfkill->pdata->power_n.io);
if (gpio_is_valid(rfkill->pdata->reset_n.io))
gpio_free(rfkill->pdata->reset_n.io);
// if (gpio_is_valid(rfkill->pdata->vddio.io))
// gpio_free(rfkill->pdata->vddio.io);
//
// if (gpio_is_valid(rfkill->pdata->bgf_int_b.io))
// gpio_free(rfkill->pdata->bgf_int_b.io);
//
// if (gpio_is_valid(rfkill->pdata->gps_sync.io))
// gpio_free(rfkill->pdata->gps_sync.io);
//
// if (gpio_is_valid(rfkill->pdata->ANTSEL2.io))
// gpio_free(rfkill->pdata->ANTSEL2.io);
//
// if (gpio_is_valid(rfkill->pdata->ANTSEL3.io))
// gpio_free(rfkill->pdata->ANTSEL3.io);
//
// if (gpio_is_valid(rfkill->pdata->GPS_LAN.io))
// gpio_free(rfkill->pdata->GPS_LAN.io);
kfree(rfkill);
g_rfkill = NULL;
return 0;
}
static int rfkill_wlan_suspend(struct platform_device *pdev, pm_message_t state)
{
LOG("Enter %s\n", __func__);
return 0;
}
static int rfkill_wlan_resume(struct platform_device *pdev)
{
LOG("Enter %s\n", __func__);
return 0;
}
#ifdef CONFIG_OF
static struct of_device_id pwm_backlight_of_match[] = {
{ .compatible = "wlan-platdata" },
{ }
};
MODULE_DEVICE_TABLE(of, pwm_backlight_of_match);
#endif //CONFIG_OF
static struct platform_driver rfkill_wlan_driver = {
.probe = rfkill_wlan_probe,
.remove = rfkill_wlan_remove,
.suspend = rfkill_wlan_suspend,
.resume = rfkill_wlan_resume,
.driver = {
.name = "wlan-platdata",
.owner = THIS_MODULE,
.of_match_table = of_match_ptr(pwm_backlight_of_match),
},
};
static int __init rfkill_wlan_init(void)
{
LOG("Enter %s\n", __func__);
return platform_driver_register(&rfkill_wlan_driver);
}
static void __exit rfkill_wlan_exit(void)
{
LOG("Enter %s\n", __func__);
platform_driver_unregister(&rfkill_wlan_driver);
}
module_init(rfkill_wlan_init);
module_exit(rfkill_wlan_exit);
MODULE_DESCRIPTION("rock-chips rfkill for wifi v0.1");
MODULE_AUTHOR("gwl@rock-chips.com");
MODULE_LICENSE("GPL");