/*  * RNDIS MSG parser *  * Version:     $Id: rndis.c,v 1.19 2004/03/25 21:33:46 robert Exp $ *  * Authors:	Benedikt Spranger, Pengutronix * 		Robert Schwebel, Pengutronix *  *              This program is free software; you can redistribute it and/or *              modify it under the terms of the GNU General Public License *              version 2, as published by the Free Software Foundation.  *  *		This software was originally developed in conformance with *		Microsoft's Remote NDIS Specification License Agreement. *               * 03/12/2004 Kai-Uwe Bloem <linux-development@auerswald.de> *		Fixed message length bug in init_response *  * 03/25/2004 Kai-Uwe Bloem <linux-development@auerswald.de> * 		Fixed rndis_rm_hdr length bug. */#include <linux/config.h>#include <linux/module.h>#include <linux/moduleparam.h>#include <linux/kernel.h>#include <linux/errno.h>#include <linux/version.h>#include <linux/init.h>#include <linux/list.h>#include <linux/proc_fs.h>#include <linux/netdevice.h>#include <asm/io.h>#include <asm/byteorder.h>#include <asm/system.h>#include "rndis.h"/* The driver for your USB chip needs to support ep0 OUT to work with * RNDIS, plus the same three descriptors as CDC Ethernet. * * Windows hosts need an INF file like Documentation/usb/linux.inf */#ifndef	__LITTLE_ENDIAN#warning this code is missing all cpu_to_leXX() calls ...#endif#if 0#define DEBUG if (rndis_debug) printk static int rndis_debug = 0;module_param (rndis_debug, bool, 0);MODULE_PARM_DESC (rndis_debug, "enable debugging");#else#define DEBUG(str,args...) do{}while(0)#endif#define RNDIS_MAX_CONFIGS	1static struct proc_dir_entry *rndis_connect_dir;static struct proc_dir_entry *rndis_connect_state [RNDIS_MAX_CONFIGS];static rndis_params rndis_per_dev_params [RNDIS_MAX_CONFIGS];/* Driver Version */static const u32 rndis_driver_version = __constant_cpu_to_le32 (1);/* Function Prototypes */static int rndis_init_response (int configNr, rndis_init_msg_type *buf);static int rndis_query_response (int configNr, rndis_query_msg_type *buf);static int rndis_set_response (int configNr, rndis_set_msg_type *buf);static int rndis_reset_response (int configNr, rndis_reset_msg_type *buf);static int rndis_keepalive_response (int configNr, 				     rndis_keepalive_msg_type *buf);static rndis_resp_t *rndis_add_response (int configNr, u32 length);/* FIXME OMITTED OIDs, that RNDIS-on-USB "must" support, include *  - power management (OID_PNP_CAPABILITIES, ...) *  - network wakeup (OID_PNP_ENABLE_WAKE_UP, ...) *//* NDIS Functions */static int gen_ndis_query_resp (int configNr, u32 OID, rndis_resp_t *r){	int 			retval = -ENOTSUPP;	u32 			length = 0;	rndis_query_cmplt_type	*resp;	if (!r) return -ENOMEM;	resp = (rndis_query_cmplt_type *) r->buf;	if (!resp) return -ENOMEM;		switch (OID) {	/* mandatory */	case OID_GEN_SUPPORTED_LIST:		DEBUG ("%s: OID_GEN_SUPPORTED_LIST\n", __FUNCTION__);		length = sizeof (oid_supported_list);		memcpy ((u8 *) resp + 24, oid_supported_list, length); 		retval = 0;		break;			/* mandatory */	case OID_GEN_HARDWARE_STATUS:		DEBUG("%s: OID_GEN_HARDWARE_STATUS\n", __FUNCTION__);		length = 4;		/* Bogus question! 		 * Hardware must be ready to recieve high level protocols.		 * BTW: 		 * reddite ergo quae sunt Caesaris Caesari		 * et quae sunt Dei Deo!		 */		*((u32 *) resp + 6) = 0;		retval = 0;		break;			/* mandatory */	case OID_GEN_MEDIA_SUPPORTED:		DEBUG("%s: OID_GEN_MEDIA_SUPPORTED\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = rndis_per_dev_params [configNr].medium;		retval = 0;		break;			/* mandatory */	case OID_GEN_MEDIA_IN_USE:		DEBUG("%s: OID_GEN_MEDIA_IN_USE\n", __FUNCTION__);		length = 4;		/* one medium, one transport... (maybe you do it better) */		*((u32 *) resp + 6) = rndis_per_dev_params [configNr].medium;		retval = 0;		break;			case OID_GEN_MAXIMUM_LOOKAHEAD:		DEBUG("%s: OID_GEN_MAXIMUM_LOOKAHEAD\n", __FUNCTION__);		break;			/* mandatory */	case OID_GEN_MAXIMUM_FRAME_SIZE:		DEBUG("%s: OID_GEN_MAXIMUM_FRAME_SIZE\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].dev) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr]						.dev->mtu;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_LINK_SPEED:		DEBUG("%s: OID_GEN_LINK_SPEED\n", __FUNCTION__);		length = 4;		if (rndis_per_dev_params [configNr].media_state			== NDIS_MEDIA_STATE_DISCONNECTED)		    *((u32 *) resp + 6) = 0;		else		    *((u32 *) resp + 6) = rndis_per_dev_params [configNr].speed;		retval = 0;		break;			case OID_GEN_TRANSMIT_BUFFER_SPACE:		DEBUG("%s: OID_GEN_TRANSMIT_BUFFER_SPACE\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = 0;		retval = 0;		break;			case OID_GEN_RECEIVE_BUFFER_SPACE:		DEBUG("%s: OID_GEN_RECEIVE_BUFFER_SPACE\n", __FUNCTION__);		break;			/* mandatory */	case OID_GEN_TRANSMIT_BLOCK_SIZE:		DEBUG("%s: OID_GEN_TRANSMIT_BLOCK_SIZE\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].dev) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr]						.dev->mtu;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_RECEIVE_BLOCK_SIZE:		DEBUG("%s: OID_GEN_RECEIVE_BLOCK_SIZE\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].dev) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr]						.dev->mtu;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_VENDOR_ID:		DEBUG("%s: OID_GEN_VENDOR_ID\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = rndis_per_dev_params [configNr].vendorID;		retval = 0;		break;			/* mandatory */	case OID_GEN_VENDOR_DESCRIPTION:		DEBUG("%s: OID_GEN_VENDOR_DESCRIPTION\n", __FUNCTION__);		length = strlen (rndis_per_dev_params [configNr].vendorDescr);		memcpy ((u8 *) resp + 24, 			rndis_per_dev_params [configNr].vendorDescr, length);		retval = 0;		break;	/* mandatory */	case OID_GEN_CURRENT_PACKET_FILTER:		DEBUG("%s: OID_GEN_CURRENT_PACKET_FILTER\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = rndis_per_dev_params[configNr].filter;		retval = 0;		break;			case OID_GEN_CURRENT_LOOKAHEAD:		DEBUG("%s: OID_GEN_CURRENT_LOOKAHEAD\n", __FUNCTION__);		break;			case OID_GEN_DRIVER_VERSION:		DEBUG("%s: OID_GEN_DRIVER_VERSION\n", __FUNCTION__);		break;			/* mandatory */	case OID_GEN_MAXIMUM_TOTAL_SIZE:		DEBUG("%s: OID_GEN_MAXIMUM_TOTAL_SIZE\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = RNDIS_MAX_TOTAL_SIZE;		retval = 0;		break;			case OID_GEN_PROTOCOL_OPTIONS:		DEBUG("%s: OID_GEN_PROTOCOL_OPTIONS\n", __FUNCTION__);		break;			case OID_GEN_MAC_OPTIONS:		DEBUG("%s: OID_GEN_MAC_OPTIONS\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = NDIS_MAC_OPTION_RECEIVE_SERIALIZED | 		    NDIS_MAC_OPTION_FULL_DUPLEX;		retval = 0;		break;			/* mandatory */	case OID_GEN_MEDIA_CONNECT_STATUS:		DEBUG("%s: OID_GEN_MEDIA_CONNECT_STATUS\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = rndis_per_dev_params [configNr]						.media_state;		retval = 0;		break;			case OID_GEN_MAXIMUM_SEND_PACKETS:		DEBUG("%s: OID_GEN_MAXIMUM_SEND_PACKETS\n", __FUNCTION__);		break;			/* mandatory */	case OID_GEN_VENDOR_DRIVER_VERSION:		DEBUG("%s: OID_GEN_VENDOR_DRIVER_VERSION\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = rndis_driver_version;		retval = 0;		break;			case OID_GEN_SUPPORTED_GUIDS:		DEBUG("%s: OID_GEN_SUPPORTED_GUIDS\n", __FUNCTION__);		break;			case OID_GEN_NETWORK_LAYER_ADDRESSES:		DEBUG("%s: OID_GEN_NETWORK_LAYER_ADDRESSES\n", __FUNCTION__);		break;			case OID_GEN_TRANSPORT_HEADER_OFFSET:		DEBUG("%s: OID_GEN_TRANSPORT_HEADER_OFFSET\n", __FUNCTION__);		break;			case OID_GEN_MACHINE_NAME:		DEBUG("%s: OID_GEN_MACHINE_NAME\n", __FUNCTION__);		break;			case OID_GEN_RNDIS_CONFIG_PARAMETER:		DEBUG("%s: OID_GEN_RNDIS_CONFIG_PARAMETER\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = 0;		retval = 0;		break;			case OID_GEN_VLAN_ID:		DEBUG("%s: OID_GEN_VLAN_ID\n", __FUNCTION__);		break;			case OID_GEN_MEDIA_CAPABILITIES:		DEBUG("%s: OID_GEN_MEDIA_CAPABILITIES\n", __FUNCTION__);		break;			case OID_GEN_PHYSICAL_MEDIUM:		DEBUG("%s: OID_GEN_PHYSICAL_MEDIUM\n", __FUNCTION__);		length = 4;		*((u32 *) resp + 6) = 0;		retval = 0;		break;			/* mandatory */	case OID_GEN_XMIT_OK:		DEBUG("%s: OID_GEN_XMIT_OK\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr]					.stats->tx_packets - 			    rndis_per_dev_params [configNr].stats->tx_errors -			    rndis_per_dev_params [configNr].stats->tx_dropped;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_RCV_OK:		DEBUG("%s: OID_GEN_RCV_OK\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->rx_packets - 			    rndis_per_dev_params [configNr].stats->rx_errors -			    rndis_per_dev_params [configNr].stats->rx_dropped;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_XMIT_ERROR:		DEBUG("%s: OID_GEN_XMIT_ERROR\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			length = 4;			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->tx_errors;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_RCV_ERROR:		DEBUG("%s: OID_GEN_RCV_ERROR\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->rx_errors;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			/* mandatory */	case OID_GEN_RCV_NO_BUFFER:		DEBUG("%s: OID_GEN_RCV_NO_BUFFER\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->rx_dropped;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_DIRECTED_BYTES_XMIT:		DEBUG("%s: OID_GEN_DIRECTED_BYTES_XMIT\n", __FUNCTION__);		/* 		 * Aunt Tilly's size of shoes		 * minus antarctica count of penguins		 * divided by weight of Alpha Centauri		 */		if (rndis_per_dev_params [configNr].stats) {			length = 4;			*((u32 *) resp + 6) = (rndis_per_dev_params [configNr].					stats->tx_packets - 			    rndis_per_dev_params [configNr].stats->tx_errors -			    rndis_per_dev_params [configNr].stats->tx_dropped)					*123;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_DIRECTED_FRAMES_XMIT:		DEBUG("%s: OID_GEN_DIRECTED_FRAMES_XMIT\n", __FUNCTION__);		/* dito */		if (rndis_per_dev_params [configNr].stats) {			length = 4;			*((u32 *) resp + 6) = (rndis_per_dev_params [configNr].					stats->tx_packets - 			    rndis_per_dev_params [configNr].stats->tx_errors -			    rndis_per_dev_params [configNr].stats->tx_dropped)			    		/123;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_MULTICAST_BYTES_XMIT:		DEBUG("%s: OID_GEN_MULTICAST_BYTES_XMIT\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->multicast*1234;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_MULTICAST_FRAMES_XMIT:		DEBUG("%s: OID_GEN_MULTICAST_FRAMES_XMIT\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->multicast;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_BROADCAST_BYTES_XMIT:		DEBUG("%s: OID_GEN_BROADCAST_BYTES_XMIT\n", __FUNCTION__);		if (rndis_per_dev_params [configNr].stats) {			*((u32 *) resp + 6) = rndis_per_dev_params [configNr].					stats->tx_packets/42*255;			retval = 0;		} else {			*((u32 *) resp + 6) = 0;			retval = 0;		}		break;			case OID_GEN_BROADCAST_FRAMES_XMIT: