rndis.c

优龙2410linux2.6.8内核源代码

/* 
 * 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 <[e-mail]>
 *		Fixed message length bug in init_response
 * 
 * 03/25/2004 Kai-Uwe Bloem <[e-mail]>
 * 		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	1

static 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: