diff options
Diffstat (limited to 'drivers/net/wireless/rda/rda_wlan/wlan_nvram.c')
| -rwxr-xr-x | drivers/net/wireless/rda/rda_wlan/wlan_nvram.c | 209 |
1 files changed, 209 insertions, 0 deletions
diff --git a/drivers/net/wireless/rda/rda_wlan/wlan_nvram.c b/drivers/net/wireless/rda/rda_wlan/wlan_nvram.c new file mode 100755 index 00000000..a48ba72b --- /dev/null +++ b/drivers/net/wireless/rda/rda_wlan/wlan_nvram.c @@ -0,0 +1,209 @@ +#include <linux/fs.h> +#include <asm/uaccess.h> +#include "wlan_includes.h" + +#ifdef USE_MAC_FROM_RDA_NVRAM +#include <plat/md_sys.h> +#endif + +#define WIFI_NVRAM_FILE_NAME "/data/misc/wifi/WLANMAC" + +static int nvram_read(char *filename, char *buf, ssize_t len, int offset) +{ + struct file *fd; + int retLen = -1; + + mm_segment_t old_fs = get_fs(); + set_fs(KERNEL_DS); + fd = filp_open(filename, O_WRONLY|O_CREAT, 0644); + + if(IS_ERR(fd)){ + printk("[wlan][nvram_read] : failed to open!!\n"); + return -1; + } + + do{ + if ((fd->f_op == NULL) || (fd->f_op->read == NULL)){ + printk("[wlan][nvram_read] : file can not be read!!\n"); + break; + } + + if (fd->f_pos != offset){ + if (fd->f_op->llseek){ + if(fd->f_op->llseek(fd, offset, 0) != offset){ + printk("[wlan][nvram_read] : failed to seek!!\n"); + break; + } + }else{ + fd->f_pos = offset; + } + } + + retLen = fd->f_op->read(fd, buf, len, &fd->f_pos); + }while(false); + + filp_close(fd, NULL); + set_fs(old_fs); + + return retLen; +} + +static int nvram_write(char *filename, char *buf, ssize_t len, int offset) +{ + struct file *fd; + int retLen = -1; + + mm_segment_t old_fs = get_fs(); + set_fs(KERNEL_DS); + + fd = filp_open(filename, O_WRONLY|O_CREAT, 0644); + + if(IS_ERR(fd)){ + printk("[wlan][nvram_write] : failed to open!!\n"); + return -1; + } + + do{ + if ((fd->f_op == NULL) || (fd->f_op->write == NULL)){ + printk("[wlan][nvram_write] : file can not be write!!\n"); + break; + } + + if (fd->f_pos != offset){ + if (fd->f_op->llseek){ + if(fd->f_op->llseek(fd, offset, 0) != offset){ + printk("[wlan][nvram_write] : failed to seek!!\n"); + break; + } + }else{ + fd->f_pos = offset; + } + } + + retLen = fd->f_op->write(fd, buf, len, &fd->f_pos); + + }while(false); + + filp_close(fd, NULL); + set_fs(old_fs); + + return retLen; +} + +int wlan_read_mac_from_file(char* buf) +{ + return nvram_read(WIFI_NVRAM_FILE_NAME, buf, 6, 0); +} + +int wlan_write_mac_to_file(char * buf) +{ + return nvram_write(WIFI_NVRAM_FILE_NAME, buf, 6, 0); +} + +#ifdef USE_MAC_FROM_RDA_NVRAM +int wlan_read_mac_from_nvram(char *buf) +{ + int ret; + struct msys_device *wlan_msys = NULL; + struct wlan_mac_info wlan_info; + struct client_cmd cmd_set; + + wlan_msys = rda_msys_alloc_device(); + if (!wlan_msys) { + WLAN_ERRP("nvram: can not allocate wlan_msys device\n"); + ret = -ENOMEM; + goto err_handle_sys; + } + + wlan_msys->module = SYS_GEN_MOD; + wlan_msys->name = "rda-wlan"; + rda_msys_register_device(wlan_msys); + + memset(&wlan_info, sizeof(wlan_info), 0); + cmd_set.pmsys_dev = wlan_msys; + cmd_set.mod_id = SYS_GEN_MOD; + cmd_set.mesg_id = SYS_GEN_CMD_GET_WIFI_INFO; + cmd_set.pdata = NULL; + cmd_set.data_size = 0; + cmd_set.pout_data = &wlan_info; + cmd_set.out_size = sizeof(wlan_info); + + ret = rda_msys_send_cmd(&cmd_set); + if (ret) { + WLAN_ERRP("nvram:can not get wifi mac from nvram \n"); + ret = -EBUSY; + goto err_handle_cmd; + } + + if (wlan_info.activated != WIFI_MAC_ACTIVATED_FLAG) { + WLAN_ERRP("nvram:get invalid wifi mac address from nvram\n"); + ret = -EINVAL; + goto err_invalid_mac; + } + + memcpy(buf, wlan_info.mac_addr, ETH_ALEN); + WLAN_DBGLAP(WLAN_DA_MAIN, WLAN_DL_CRIT, + "nvram:get wifi mac address [%02x:%02x:%02x:%02x:%02x:%02x] from nvram success.\n", + buf[0], buf[1], buf[2], + buf[3], buf[4], buf[5]); + ret = 0; /* success*/ + +err_invalid_mac: +err_handle_cmd: + rda_msys_unregister_device(wlan_msys); + rda_msys_free_device(wlan_msys); +err_handle_sys: + return ret; +} + +int wlan_write_mac_to_nvram(const char *buf) +{ + int ret; + struct msys_device *wlan_msys = NULL; + struct wlan_mac_info wlan_info; + struct client_cmd cmd_set; + + wlan_msys = rda_msys_alloc_device(); + if (!wlan_msys) { + WLAN_ERRP("nvram: can not allocate wlan_msys device\n"); + ret = -ENOMEM; + goto err_handle_sys; + } + + wlan_msys->module = SYS_GEN_MOD; + wlan_msys->name = "rda-wlan"; + rda_msys_register_device(wlan_msys); + + memset(&wlan_info, sizeof(wlan_info), 0); + wlan_info.activated = WIFI_MAC_ACTIVATED_FLAG; + memcpy(wlan_info.mac_addr, buf, ETH_ALEN); + + cmd_set.pmsys_dev = wlan_msys; + cmd_set.mod_id = SYS_GEN_MOD; + cmd_set.mesg_id = SYS_GEN_CMD_SET_WIFI_INFO; + cmd_set.pdata = &wlan_info; + cmd_set.data_size = sizeof(wlan_info); + cmd_set.pout_data = NULL; + cmd_set.out_size = 0; + + ret = rda_msys_send_cmd(&cmd_set); + if (ret) { + WLAN_ERRP("nvram:can not set wifi mac to nvram \n"); + ret = -EBUSY; + goto err_handle_cmd; + } + + WLAN_DBGLAP(WLAN_DA_MAIN, WLAN_DL_CRIT, + "nvram:set wifi mac address [%02x:%02x:%02x:%02x:%02x:%02x] to nvram success.\n", + buf[0], buf[1], buf[2], + buf[3], buf[4], buf[5]); + ret = 0; /* success*/ + +err_handle_cmd: + rda_msys_unregister_device(wlan_msys); + rda_msys_free_device(wlan_msys); +err_handle_sys: + return ret; +} +#endif /*USE_MAC_FROM_RDA_NVRAM*/ + |