drivers/staging/rtl8188eu/os_dep/rtw_android.c - kernel/quantenna - Git at Google

 /******************************************************************************
  *
  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms of version 2 of the GNU General Public License as
  * published by the Free Software Foundation.
  *
  * 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.
  *
  ******************************************************************************/

 #include <linux/module.h>
 #include <linux/netdevice.h>

 #include <rtw_android.h>
 #include <osdep_service.h>
 #include <rtw_debug.h>
 #include <rtw_ioctl_set.h>

 static const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = {
 	"START",
 	"STOP",
 	"SCAN-ACTIVE",
 	"SCAN-PASSIVE",
 	"RSSI",
 	"LINKSPEED",
 	"RXFILTER-START",
 	"RXFILTER-STOP",
 	"RXFILTER-ADD",
 	"RXFILTER-REMOVE",
 	"BTCOEXSCAN-START",
 	"BTCOEXSCAN-STOP",
 	"BTCOEXMODE",
 	"SETSUSPENDOPT",
 	"P2P_DEV_ADDR",
 	"SETFWPATH",
 	"SETBAND",
 	"GETBAND",
 	"COUNTRY",
 	"P2P_SET_NOA",
 	"P2P_GET_NOA",
 	"P2P_SET_PS",
 	"SET_AP_WPS_P2P_IE",
 	"MACADDR",
 	"BLOCK",
 	"WFD-ENABLE",
 	"WFD-DISABLE",
 	"WFD-SET-TCPPORT",
 	"WFD-SET-MAXTPUT",
 	"WFD-SET-DEVTYPE",
 };

 struct android_wifi_priv_cmd {
 	const char __user *buf;
 	int used_len;
 	int total_len;
 };

 /**
  * Local (static) functions and variables
  */

 /* Initialize g_wifi_on to 1 so dhd_bus_start will be called for the first
  * time (only) in dhd_open, subsequential wifi on will be handled by
  * wl_android_wifi_on
  */
 static int g_wifi_on = true;

 int rtw_android_cmdstr_to_num(char *cmdstr)
 {
 	int cmd_num;
 	for (cmd_num = 0; cmd_num < ANDROID_WIFI_CMD_MAX; cmd_num++)
 		if (0 == strncasecmp(cmdstr, android_wifi_cmd_str[cmd_num],
 				  strlen(android_wifi_cmd_str[cmd_num])))
 			break;
 	return cmd_num;
 }

 static int rtw_android_get_rssi(struct net_device *net, char *command,
 				int total_len)
 {
 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(net);
 	struct	mlme_priv	*pmlmepriv = &(padapter->mlmepriv);
 	struct	wlan_network	*pcur_network = &pmlmepriv->cur_network;
 	int bytes_written = 0;

 	if (check_fwstate(pmlmepriv, _FW_LINKED)) {
 		bytes_written += snprintf(&command[bytes_written], total_len,
 					  "%s rssi %d",
 					  pcur_network->network.Ssid.Ssid,
 					  padapter->recvpriv.rssi);
 	}
 	return bytes_written;
 }

 static int rtw_android_get_link_speed(struct net_device *net, char *command,
 				      int total_len)
 {
 	struct adapter *padapter = (struct adapter *)rtw_netdev_priv(net);
 	u16 link_speed;

 	link_speed = rtw_get_cur_max_rate(padapter) / 10;
 	return snprintf(command, total_len, "LinkSpeed %d",
 				 link_speed);
 }

 static int rtw_android_get_macaddr(struct net_device *net, char *command,
 				   int total_len)
 {
 	return snprintf(command, total_len, "Macaddr = %pM",
 				 net->dev_addr);
 }

 static int android_set_cntry(struct net_device *net, char *command,
 			     int total_len)
 {
 	struct adapter *adapter = (struct adapter *)rtw_netdev_priv(net);
 	char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1;
 	int ret;

 	ret = rtw_set_country(adapter, country_code);
 	return (ret == _SUCCESS) ? 0 : -1;
 }

 static int android_get_p2p_addr(struct net_device *net, char *command,
 					int total_len)
 {
 	/* We use the same address as our HW MAC address */
 	memcpy(command, net->dev_addr, ETH_ALEN);
 	return ETH_ALEN;
 }

 static int rtw_android_set_block(struct net_device *net, char *command,
 				 int total_len)
 {
 	return 0;
 }

 int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd)
 {
 	int ret = 0;
 	char *command;
 	int cmd_num;
 	int bytes_written = 0;
 	struct android_wifi_priv_cmd priv_cmd;

 	if (!ifr->ifr_data)
 		return -EINVAL;
 	if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(priv_cmd)))
 		return -EFAULT;
 	if (priv_cmd.total_len < 1)
 		return -EINVAL;
 	command = memdup_user(priv_cmd.buf, priv_cmd.total_len);
 	if (IS_ERR(command))
 		return PTR_ERR(command);
 	command[priv_cmd.total_len - 1] = 0;
 	DBG_88E("%s: Android private cmd \"%s\" on %s\n",
 		__func__, command, ifr->ifr_name);
 	cmd_num = rtw_android_cmdstr_to_num(command);
 	switch (cmd_num) {
 	case ANDROID_WIFI_CMD_START:
 		goto response;
 	case ANDROID_WIFI_CMD_SETFWPATH:
 		goto response;
 	}
 	if (!g_wifi_on) {
 		DBG_88E("%s: Ignore private cmd \"%s\" - iface %s is down\n",
 			__func__, command, ifr->ifr_name);
 		ret = 0;
 		goto free;
 	}
 	switch (cmd_num) {
 	case ANDROID_WIFI_CMD_STOP:
 		break;
 	case ANDROID_WIFI_CMD_SCAN_ACTIVE:
 		break;
 	case ANDROID_WIFI_CMD_SCAN_PASSIVE:
 		break;
 	case ANDROID_WIFI_CMD_RSSI:
 		bytes_written = rtw_android_get_rssi(net, command,
 						     priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_LINKSPEED:
 		bytes_written = rtw_android_get_link_speed(net, command,
 							   priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_MACADDR:
 		bytes_written = rtw_android_get_macaddr(net, command,
 							priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_BLOCK:
 		bytes_written = rtw_android_set_block(net, command,
 						      priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_RXFILTER_START:
 		break;
 	case ANDROID_WIFI_CMD_RXFILTER_STOP:
 		break;
 	case ANDROID_WIFI_CMD_RXFILTER_ADD:
 		break;
 	case ANDROID_WIFI_CMD_RXFILTER_REMOVE:
 		break;
 	case ANDROID_WIFI_CMD_BTCOEXSCAN_START:
 		/* TBD: BTCOEXSCAN-START */
 		break;
 	case ANDROID_WIFI_CMD_BTCOEXSCAN_STOP:
 		/* TBD: BTCOEXSCAN-STOP */
 		break;
 	case ANDROID_WIFI_CMD_BTCOEXMODE:
 		break;
 	case ANDROID_WIFI_CMD_SETSUSPENDOPT:
 		break;
 	case ANDROID_WIFI_CMD_SETBAND:
 		break;
 	case ANDROID_WIFI_CMD_GETBAND:
 		break;
 	case ANDROID_WIFI_CMD_COUNTRY:
 		bytes_written = android_set_cntry(net, command,
 						  priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_P2P_DEV_ADDR:
 		bytes_written = android_get_p2p_addr(net, command,
 						     priv_cmd.total_len);
 		break;
 	case ANDROID_WIFI_CMD_P2P_SET_NOA:
 		break;
 	case ANDROID_WIFI_CMD_P2P_GET_NOA:
 		break;
 	case ANDROID_WIFI_CMD_P2P_SET_PS:
 		break;
 	default:
 		DBG_88E("Unknown PRIVATE command %s - ignored\n", command);
 		snprintf(command, 3, "OK");
 		bytes_written = strlen("OK");
 	}

 response:
 	if (bytes_written >= 0) {
 		if ((bytes_written == 0) && (priv_cmd.total_len > 0))
 			command[0] = '\0';
 		if (bytes_written >= priv_cmd.total_len) {
 			DBG_88E("%s: bytes_written = %d\n", __func__,
 				bytes_written);
 			bytes_written = priv_cmd.total_len;
 		} else {
 			bytes_written++;
 		}
 		priv_cmd.used_len = bytes_written;
 		if (copy_to_user((char __user *)priv_cmd.buf, command,
 				 bytes_written)) {
 			DBG_88E("%s: failed to copy data to user buffer\n",
 				__func__);
 			ret = -EFAULT;
 		}
 	} else {
 		ret = bytes_written;
 	}
 free:
 	kfree(command);
 	return ret;
 }
	/******************************************************************************
	*
	* Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
	*
	* This program is free software; you can redistribute it and/or modify it
	* under the terms of version 2 of the GNU General Public License as
	* published by the Free Software Foundation.
	*
	* 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.
	*
	******************************************************************************/

	#include <linux/module.h>
	#include <linux/netdevice.h>

	#include <rtw_android.h>
	#include <osdep_service.h>
	#include <rtw_debug.h>
	#include <rtw_ioctl_set.h>

	static const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = {
	"START",
	"STOP",
	"SCAN-ACTIVE",
	"SCAN-PASSIVE",
	"RSSI",
	"LINKSPEED",
	"RXFILTER-START",
	"RXFILTER-STOP",
	"RXFILTER-ADD",
	"RXFILTER-REMOVE",
	"BTCOEXSCAN-START",
	"BTCOEXSCAN-STOP",
	"BTCOEXMODE",
	"SETSUSPENDOPT",
	"P2P_DEV_ADDR",
	"SETFWPATH",
	"SETBAND",
	"GETBAND",
	"COUNTRY",
	"P2P_SET_NOA",
	"P2P_GET_NOA",
	"P2P_SET_PS",
	"SET_AP_WPS_P2P_IE",
	"MACADDR",
	"BLOCK",
	"WFD-ENABLE",
	"WFD-DISABLE",
	"WFD-SET-TCPPORT",
	"WFD-SET-MAXTPUT",
	"WFD-SET-DEVTYPE",
	};

	struct android_wifi_priv_cmd {
	const char __user *buf;
	int used_len;
	int total_len;
	};

	/**
	* Local (static) functions and variables
	*/

	/* Initialize g_wifi_on to 1 so dhd_bus_start will be called for the first
	* time (only) in dhd_open, subsequential wifi on will be handled by
	* wl_android_wifi_on
	*/
	static int g_wifi_on = true;

	int rtw_android_cmdstr_to_num(char *cmdstr)
	{
	int cmd_num;
	for (cmd_num = 0; cmd_num < ANDROID_WIFI_CMD_MAX; cmd_num++)
	if (0 == strncasecmp(cmdstr, android_wifi_cmd_str[cmd_num],
	strlen(android_wifi_cmd_str[cmd_num])))
	break;
	return cmd_num;
	}

	static int rtw_android_get_rssi(struct net_device net, char command,
	int total_len)
	{
	struct adapter padapter = (struct adapter )rtw_netdev_priv(net);
	struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
	struct wlan_network *pcur_network = &pmlmepriv->cur_network;
	int bytes_written = 0;

	if (check_fwstate(pmlmepriv, _FW_LINKED)) {
	bytes_written += snprintf(&command[bytes_written], total_len,
	"%s rssi %d",
	pcur_network->network.Ssid.Ssid,
	padapter->recvpriv.rssi);
	}
	return bytes_written;
	}

	static int rtw_android_get_link_speed(struct net_device net, char command,
	int total_len)
	{
	struct adapter padapter = (struct adapter )rtw_netdev_priv(net);
	u16 link_speed;

	link_speed = rtw_get_cur_max_rate(padapter) / 10;
	return snprintf(command, total_len, "LinkSpeed %d",
	link_speed);
	}

	static int rtw_android_get_macaddr(struct net_device net, char command,
	int total_len)
	{
	return snprintf(command, total_len, "Macaddr = %pM",
	net->dev_addr);
	}

	static int android_set_cntry(struct net_device net, char command,
	int total_len)
	{
	struct adapter adapter = (struct adapter )rtw_netdev_priv(net);
	char *country_code = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_COUNTRY]) + 1;
	int ret;

	ret = rtw_set_country(adapter, country_code);
	return (ret == _SUCCESS) ? 0 : -1;
	}

	static int android_get_p2p_addr(struct net_device net, char command,
	int total_len)
	{
	/* We use the same address as our HW MAC address */
	memcpy(command, net->dev_addr, ETH_ALEN);
	return ETH_ALEN;
	}

	static int rtw_android_set_block(struct net_device net, char command,
	int total_len)
	{
	return 0;
	}

	int rtw_android_priv_cmd(struct net_device net, struct ifreq ifr, int cmd)
	{
	int ret = 0;
	char *command;
	int cmd_num;
	int bytes_written = 0;
	struct android_wifi_priv_cmd priv_cmd;

	if (!ifr->ifr_data)
	return -EINVAL;
	if (copy_from_user(&priv_cmd, ifr->ifr_data, sizeof(priv_cmd)))
	return -EFAULT;
	if (priv_cmd.total_len < 1)
	return -EINVAL;
	command = memdup_user(priv_cmd.buf, priv_cmd.total_len);
	if (IS_ERR(command))
	return PTR_ERR(command);
	command[priv_cmd.total_len - 1] = 0;
	DBG_88E("%s: Android private cmd \"%s\" on %s\n",
	__func__, command, ifr->ifr_name);
	cmd_num = rtw_android_cmdstr_to_num(command);
	switch (cmd_num) {
	case ANDROID_WIFI_CMD_START:
	goto response;
	case ANDROID_WIFI_CMD_SETFWPATH:
	goto response;
	}
	if (!g_wifi_on) {
	DBG_88E("%s: Ignore private cmd \"%s\" - iface %s is down\n",
	__func__, command, ifr->ifr_name);
	ret = 0;
	goto free;
	}
	switch (cmd_num) {
	case ANDROID_WIFI_CMD_STOP:
	break;
	case ANDROID_WIFI_CMD_SCAN_ACTIVE:
	break;
	case ANDROID_WIFI_CMD_SCAN_PASSIVE:
	break;
	case ANDROID_WIFI_CMD_RSSI:
	bytes_written = rtw_android_get_rssi(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_LINKSPEED:
	bytes_written = rtw_android_get_link_speed(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_MACADDR:
	bytes_written = rtw_android_get_macaddr(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_BLOCK:
	bytes_written = rtw_android_set_block(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_RXFILTER_START:
	break;
	case ANDROID_WIFI_CMD_RXFILTER_STOP:
	break;
	case ANDROID_WIFI_CMD_RXFILTER_ADD:
	break;
	case ANDROID_WIFI_CMD_RXFILTER_REMOVE:
	break;
	case ANDROID_WIFI_CMD_BTCOEXSCAN_START:
	/* TBD: BTCOEXSCAN-START */
	break;
	case ANDROID_WIFI_CMD_BTCOEXSCAN_STOP:
	/* TBD: BTCOEXSCAN-STOP */
	break;
	case ANDROID_WIFI_CMD_BTCOEXMODE:
	break;
	case ANDROID_WIFI_CMD_SETSUSPENDOPT:
	break;
	case ANDROID_WIFI_CMD_SETBAND:
	break;
	case ANDROID_WIFI_CMD_GETBAND:
	break;
	case ANDROID_WIFI_CMD_COUNTRY:
	bytes_written = android_set_cntry(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_P2P_DEV_ADDR:
	bytes_written = android_get_p2p_addr(net, command,
	priv_cmd.total_len);
	break;
	case ANDROID_WIFI_CMD_P2P_SET_NOA:
	break;
	case ANDROID_WIFI_CMD_P2P_GET_NOA:
	break;
	case ANDROID_WIFI_CMD_P2P_SET_PS:
	break;
	default:
	DBG_88E("Unknown PRIVATE command %s - ignored\n", command);
	snprintf(command, 3, "OK");
	bytes_written = strlen("OK");
	}

	response:
	if (bytes_written >= 0) {
	if ((bytes_written == 0) && (priv_cmd.total_len > 0))
	command[0] = '\0';
	if (bytes_written >= priv_cmd.total_len) {
	DBG_88E("%s: bytes_written = %d\n", __func__,
	bytes_written);
	bytes_written = priv_cmd.total_len;
	} else {
	bytes_written++;
	}
	priv_cmd.used_len = bytes_written;
	if (copy_to_user((char __user *)priv_cmd.buf, command,
	bytes_written)) {
	DBG_88E("%s: failed to copy data to user buffer\n",
	__func__);
	ret = -EFAULT;
	}
	} else {
	ret = bytes_written;
	}
	free:
	kfree(command);
	return ret;
	}