patch-2.1.132 linux/net/irda/irlan/irlan_srv.c

Next file: linux/net/irda/irlan/irlan_srv_event.c
Previous file: linux/net/irda/irlan/irlan_event.c
Back to the patch index
Back to the overall index

diff -u --recursive --new-file v2.1.131/linux/net/irda/irlan/irlan_srv.c linux/net/irda/irlan/irlan_srv.c
@@ -0,0 +1,915 @@
+/*********************************************************************
+ *                
+ * Filename:      irlan_srv.c
+ * Version:       0.1
+ * Description:   IrDA LAN Access Protocol Implementation
+ * Status:        Experimental.
+ * Author:        Dag Brattli <dagb@cs.uit.no>
+ * Created at:    Sun Aug 31 20:14:37 1997
+ * Modified at:   Mon Dec 14 19:10:49 1998
+ * Modified by:   Dag Brattli <dagb@cs.uit.no>
+ * Sources:       skeleton.c by Donald Becker <becker@CESDIS.gsfc.nasa.gov>
+ *                slip.c by Laurence Culhane,   <loz@holmes.demon.co.uk>
+ *                          Fred N. van Kempen, <waltje@uwalt.nl.mugnet.org>
+ * 
+ *     Copyright (c) 1998 Dag Brattli <dagb@cs.uit.no>, All Rights Reserved.
+ *     
+ *     This program is free software; you can redistribute it and/or 
+ *     modify it under the terms of the GNU General Public License as 
+ *     published by the Free Software Foundation; either version 2 of 
+ *     the License, or (at your option) any later version.
+ *
+ *     Neither Dag Brattli nor University of Tromsų admit liability nor
+ *     provide warranty for any of this software. This material is 
+ *     provided "AS-IS" and at no charge.
+ *
+ ********************************************************************/
+
+#include <linux/module.h> 
+
+#include <linux/kernel.h>
+#include <linux/string.h>
+#include <linux/errno.h>
+#include <linux/netdevice.h>
+#include <linux/etherdevice.h>
+#include <linux/init.h>
+
+#include <asm/system.h>
+#include <asm/bitops.h>
+#include <asm/byteorder.h>
+
+
+#include <net/irda/irda.h>
+#include <net/irda/irttp.h>
+#include <net/irda/irlmp.h>
+#include <net/irda/irias_object.h>
+#include <net/irda/iriap.h>
+#include <net/irda/timer.h>
+
+#include <net/irda/irlan_common.h>
+#include <net/irda/irlan_eth.h>
+#include <net/irda/irlan_event.h>
+#include <net/irda/irlan_srv.h>
+
+/*
+ *  Private functions
+ */
+static void __irlan_server_close( struct irlan_cb *self);
+static int irlan_server_dev_init( struct device *dev);
+static int irlan_server_dev_open(struct device *dev);
+static int irlan_server_dev_close(struct device *dev);
+static void irlan_check_param( struct irlan_cb *self, char *param, char *value);
+
+/*
+ * Function irlan_server_init (dev)
+ *
+ *   Allocates the master array. Called by modprobe().
+ */
+__initfunc(int irlan_server_init( void))
+{
+	DEBUG( 4, "--> irlan_server_init\n");
+
+	/* Register with IrLMP as a service */
+	irlmp_register_layer( S_LAN, SERVER, FALSE, NULL);
+	
+ 	irlan_server_register();
+		
+	DEBUG( 4, "irlan_server_init -->\n");
+		
+	return 0;
+}
+
+/*
+ * Function irlan_server_cleanup (void)
+ *
+ *    Removes all instances of the IrLAN network device driver, and the
+ *    master array. Called by rmmod().
+ */
+void irlan_server_cleanup(void) 
+{
+	DEBUG( 4, "--> irlan_server_cleanup\n");
+
+	irlmp_unregister_layer( S_LAN, SERVER);
+
+	/*
+	 *  Delete hashbin and close all irlan client instances in it
+	 */
+	/* hashbin_delete( irlan, (FREE_FUNC) __irlan_server_close); */
+	
+	DEBUG( 4, "irlan_server_cleanup -->\n");
+}
+
+/*
+ * Function irlan_server_open (void)
+ *
+ *    This function allocates and opens a new instance of the IrLAN network
+ *    device driver.
+ */
+struct irlan_cb *irlan_server_open(void) 
+{
+	struct irlan_cb *self;
+	int result;
+
+	DEBUG( 4, __FUNCTION__ "()\n");
+
+	/* 
+	 *  Initialize the irlan_server structure. 
+	 */
+
+	self = kmalloc( sizeof(struct irlan_cb), GFP_ATOMIC);
+	if ( self == NULL) {
+		DEBUG( 0, __FUNCTION__ "(), Unable to kmalloc!\n");
+		return NULL;
+	}
+	memset( self, 0, sizeof(struct irlan_cb));
+
+	/*
+	 *  Initialize local device structure
+	 */
+	self->magic = IRLAN_MAGIC;
+
+	self->dev.name = self->ifname;
+	self->dev.init = irlan_server_dev_init;
+	self->dev.priv = (void *) self;
+	self->dev.next = NULL;
+
+	if (( result = register_netdev( &self->dev)) != 0) {
+		DEBUG( 0, __FUNCTION__ "(), register_netdev() failed!\n");
+		return NULL;
+	}
+
+	irlan_next_state( self, IRLAN_IDLE);
+
+	hashbin_insert( irlan , (QUEUE *) self, (int) self, NULL);
+	
+	return self;
+}
+
+/*
+ * Function irlan_server_dev_init (dev)
+ *
+ *    The network device initialization function. Called only once.
+ *
+ */
+static int irlan_server_dev_init( struct device *dev)
+{
+	DEBUG( 4, __FUNCTION__ "()\n");
+
+	ASSERT( dev != NULL, return -1;);
+       
+	irlan_eth_init( dev);
+
+	/* Overrride some functions */
+	dev->open               = irlan_server_dev_open;
+	dev->stop	        = irlan_server_dev_close;
+	
+	/*  
+	 *  OK, since we are emulating an IrLAN sever we will have to give
+	 *  ourself an ethernet address!
+	 *  FIXME: this must be more dynamically
+	 */
+	dev->dev_addr[0] = 0x40;
+	dev->dev_addr[1] = 0x00;
+	dev->dev_addr[2] = 0x00;
+	dev->dev_addr[3] = 0x00;
+	dev->dev_addr[4] = 0x23;
+	dev->dev_addr[5] = 0x45;
+
+	return 0;
+}
+
+/*
+ * Function irlan_server_dev_open (dev)
+ *
+ *    Start the Servers ether network device, this function will be called by
+ *    "ifconfig server0 up".  
+ */
+static int irlan_server_dev_open( struct device *dev)
+{
+	/* struct irlan_cb *self = (struct irlan_cb *) dev->priv; */
+	
+	DEBUG( 4, "irlan_server_dev_open()\n");
+
+	ASSERT( dev != NULL, return -1;);
+
+	dev->tbusy = 0;
+	dev->interrupt = 0;
+	dev->start = 1;
+
+	MOD_INC_USE_COUNT;
+	
+	return 0;
+}
+
+static void __irlan_server_close( struct irlan_cb *self)
+{
+	DEBUG( 4, "--> irlan_server_close()\n");
+	
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+	
+	/* 
+	 *  Disconnect open TSAP connections
+	 */
+	if ( self->tsap_data) {
+		irttp_disconnect_request( self->tsap_data, NULL, P_HIGH);
+		
+		/* FIXME: this will close the tsap before the disconenct
+		 * frame has been sent 
+		 */
+		/* irttp_close_tsap( self->tsap_data); */
+	}
+	if ( self->tsap_ctrl) {
+		irttp_disconnect_request( self->tsap_ctrl, NULL, P_HIGH);
+		
+		/* irttp_close_tsap( self->tsap_control); */
+	}
+
+	unregister_netdev( &self->dev);
+
+	self->magic = ~IRLAN_MAGIC;
+	
+	kfree( self);
+
+	DEBUG( 4, "irlan_server_close() -->\n");
+}
+
+/*
+ * Function irlan_server_close (self)
+ *
+ *    This function closes and marks the IrLAN instance as not in use. 
+ */
+void irlan_server_close( struct irlan_cb *self)
+{
+	struct irlan_cb *entry;
+
+	DEBUG( 4, "--> irlan_server_close()\n");
+	
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+	
+	entry = hashbin_remove( irlan, (int) self, NULL);
+
+	ASSERT( entry == self, return;);
+	
+	__irlan_server_close( self);
+
+	DEBUG( 4, "irlan_server_close() -->\n");	
+}
+
+/*
+ * Function irlan_server_dev_close (dev)
+ *
+ *    Stop the IrLAN ether network device, his function will be called by
+ *    ifconfig down.
+ */
+static int irlan_server_dev_close( struct device *dev)
+{
+	DEBUG( 4, __FUNCTION__ "()\n");
+
+	ASSERT( dev != NULL, return -1;);
+	
+	dev->tbusy = 1;
+	dev->start = 0;
+
+	MOD_DEC_USE_COUNT;
+	
+	return 0;
+}
+
+
+/*
+ * Function irlan_server_disconnect_indication (handle, reason, priv)
+ *
+ *    Callback function for the IrTTP layer. Indicates a disconnection of
+ *    the specified connection (handle)
+ *
+ */
+void irlan_server_disconnect_indication( void *instance, void *sap, 
+					 LM_REASON reason, 
+					 struct sk_buff *skb) 
+{
+	struct irlan_info info;
+	struct irlan_cb *self;
+	struct tsap_cb *tsap;
+	
+	DEBUG( 4, __FUNCTION__ "(), Reason=%d\n", reason);
+	
+	self = ( struct irlan_cb *) instance;
+	tsap = ( struct tsap_cb *) sap;
+	
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);	
+
+	info.daddr = self->daddr;
+	
+	if ( tsap == self->tsap_data) {
+		DEBUG( 0, "IrLAN, data channel disconnected by peer!\n");
+		self->connected = FALSE;
+	} else if ( tsap == self->tsap_ctrl) {
+		DEBUG( 0, "IrLAN, control channel disconnected by peer!\n");
+	} else {
+		DEBUG( 0, "Error, disconnect on unknown handle!\n");
+	}
+	
+	/* Stop IP from transmitting more packets */
+	/* irlan_flow_indication( handle, FLOW_STOP, priv); */
+
+	irlan_do_server_event( self, IRLAN_LMP_DISCONNECT, NULL, NULL);
+}
+	
+/*
+ * Function irlan_server_control_data_indication (handle, skb)
+ *
+ *    This function gets the data that is received on the control channel
+ *
+ */
+void irlan_server_control_data_indication( void *instance, void *sap, 
+					   struct sk_buff *skb) 
+{
+	struct irlan_cb *self;
+	__u8 code;
+	
+	DEBUG( 4, __FUNCTION__ "()\n");
+	
+	self = ( struct irlan_cb *) instance;
+
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	ASSERT( skb != NULL, return;);
+
+	code = skb->data[0];
+	switch( code) {
+	case CMD_GET_PROVIDER_INFO:
+		DEBUG( 4, "Got GET_PROVIDER_INFO command!\n");
+		irlan_do_server_event( self, IRLAN_GET_INFO_CMD, skb, NULL); 
+		break;
+
+	case CMD_GET_MEDIA_CHAR:
+		DEBUG( 4, "Got GET_MEDIA_CHAR command!\n");
+		irlan_do_server_event( self, IRLAN_GET_MEDIA_CMD, skb, NULL); 
+		break;
+	case CMD_OPEN_DATA_CHANNEL:
+		DEBUG( 4, "Got OPEN_DATA_CHANNEL command!\n");
+		irlan_do_server_event( self, IRLAN_OPEN_DATA_CMD, skb, NULL); 
+		break;
+	case CMD_FILTER_OPERATION:
+		DEBUG( 4, "Got FILTER_OPERATION command!\n");
+		irlan_do_server_event( self, IRLAN_FILTER_CONFIG_CMD, skb, 
+				       NULL);
+		break;
+	case CMD_RECONNECT_DATA_CHAN:
+		DEBUG( 0, __FUNCTION__"(), Got RECONNECT_DATA_CHAN command\n");
+		DEBUG( 0, __FUNCTION__"(), NOT IMPLEMENTED\n");
+		break;
+	case CMD_CLOSE_DATA_CHAN:
+		DEBUG( 0, "Got CLOSE_DATA_CHAN command!\n");
+		DEBUG( 0, __FUNCTION__"(), NOT IMPLEMENTED\n");
+		break;
+	default:
+		DEBUG( 0, __FUNCTION__ "(), Unknown command!\n");
+		break;
+	}
+}
+
+/*
+ * Function irlan_server_connect_indication (handle, skb, priv)
+ *
+ *    Got connection from peer IrLAN layer
+ *
+ */
+void irlan_server_connect_indication( void *instance, void *sap, 
+				      struct qos_info *qos, int max_sdu_size,
+				      struct sk_buff *skb)
+{
+	struct irlan_cb *self;
+	struct irlan_info info;
+	struct tsap_cb *tsap;
+
+	DEBUG( 4, __FUNCTION__ "()\n");
+	
+	self = ( struct irlan_cb *) instance;
+	tsap = ( struct tsap_cb *) sap;
+	
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+	
+	info.tsap = tsap;
+	
+	if ( tsap == self->tsap_data)
+		irlan_do_server_event( self, IRLAN_DATA_CONNECT_INDICATION, 
+				       NULL, &info);
+	else
+		irlan_do_server_event( self, IRLAN_CONNECT_INDICATION, NULL, 
+				       &info);
+}
+
+/*
+ * Function irlan_server_connect_response (handle)
+ *
+ *    Accept incomming connection
+ *
+ */
+void irlan_server_connect_response( struct irlan_cb *self, 
+				    struct tsap_cb *tsap)
+{
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	/* FIXME: define this value */
+	irttp_connect_response( tsap, 1518, NULL);
+}
+
+/*
+ * Function irlan_server_get_provider_info (self)
+ *
+ *    Send Get Provider Information command to peer IrLAN layer
+ *
+ */
+void irlan_server_get_provider_info( struct irlan_cb *self) 
+{
+	struct sk_buff *skb;
+	__u8 *frame;
+
+	DEBUG( 4, __FUNCTION__ "()\n");
+	
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	skb =  dev_alloc_skb( 64);
+	if (skb == NULL) {
+		DEBUG( 0,"irlan_server_get_provider_info: "
+		       "Could not allocate an sk_buff of length %d\n", 64);
+		return;
+	}
+
+	/* Reserve space for TTP, LMP, and LAP header */
+	skb_reserve( skb, TTP_HEADER+LMP_HEADER+LAP_HEADER);
+	skb_put( skb, 2);
+	
+	frame = skb->data;
+	
+ 	frame[0] = CMD_GET_PROVIDER_INFO;
+	frame[1] = 0x00;                 /* Zero parameters */
+	
+	irttp_data_request( self->tsap_ctrl, skb);
+}
+
+/*
+ * Function irlan_parse_open_data_cmd (self, skb)
+ *
+ *    
+ *
+ */
+int irlan_parse_open_data_cmd( struct irlan_cb *self, struct sk_buff *skb)
+{
+	int ret = RSP_SUCCESS;
+	
+	irlan_server_extract_params( self, CMD_OPEN_DATA_CHANNEL, skb);
+
+	return ret;
+}
+
+/*
+ * Function extract_params (skb)
+ *
+ *    Extract all parameters from received buffer, then feed them to 
+ *    check_params for parsing
+ *
+ */
+int irlan_server_extract_params( struct irlan_cb *self, int cmd,
+				struct sk_buff *skb) 
+{
+	__u8 *frame;
+	__u8 *ptr;
+	int count;
+	__u8 name_len;
+	__u16 val_len;
+	int i;
+	
+	ASSERT( skb != NULL, return -RSP_PROTOCOL_ERROR;);
+	
+	DEBUG( 4, __FUNCTION__ "(), skb->len=%d\n", (int)skb->len);
+
+	ASSERT( self != NULL, return -RSP_PROTOCOL_ERROR;);
+	ASSERT( self->magic == IRLAN_MAGIC, return -RSP_PROTOCOL_ERROR;);
+	
+	if ( skb == NULL) {
+		DEBUG( 0, "extract_params: Got NULL skb!\n");
+		return -RSP_PROTOCOL_ERROR;
+	}
+	frame = skb->data;
+
+	/* How many parameters? */
+	count = frame[1];
+
+	DEBUG( 4, "Got %d parameters\n", count);
+	
+	ptr = frame+2;
+
+	/* For all parameters */
+ 	for ( i=0; i<count;i++) {
+		/* get length of parameter name ( 1 byte) */
+		name_len = *ptr++;
+
+		if (name_len > 255) {
+			DEBUG( 0, "extract_params, name_len > 255\n");
+			return -RSP_PROTOCOL_ERROR;
+		}
+
+		/* get parameter name */
+		memcpy( self->name, ptr, name_len);
+		self->name[ name_len] = '\0';
+		ptr+=name_len;
+		
+		/*  
+		 *  Get length of parameter value ( 2 bytes in little endian 
+		 *  format) 
+		 */
+		val_len = *ptr++ & 0xff;	
+		val_len |= *ptr++ << 8;
+		
+		if (val_len > 1016) {
+			DEBUG( 0, 
+			       "extract_params, parameter length to long\n");
+			return -RSP_PROTOCOL_ERROR;
+		}
+		
+		/* get parameter value */
+ 		memcpy( self->value, ptr, val_len);
+ 		self->value[ val_len] = '\0';
+ 		ptr+=val_len;
+		
+ 		DEBUG( 4, "Parameter: %s ", self->name); 
+ 		DEBUG( 4, "Value: %s\n", self->value); 
+		
+		irlan_check_param( self, self->name, self->value);
+	}
+	return RSP_SUCCESS;
+}
+
+/*
+ * Function handle_filter_request (self, skb)
+ *
+ *    Handle filter request from client peer device
+ *
+ */
+void handle_filter_request( struct irlan_cb *self, struct sk_buff *skb)
+{
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	if (( self->t.server.filter_type == IR_DIRECTED) && 
+	    ( self->t.server.filter_operation == DYNAMIC))
+	{
+		DEBUG( 0, "Giving peer a dynamic Ethernet address\n");
+
+		self->t.server.mac_address[0] = 0x40;
+		self->t.server.mac_address[1] = 0x00;
+		self->t.server.mac_address[2] = 0x00;
+		self->t.server.mac_address[3] = 0x00;
+		self->t.server.mac_address[4] = 0x12;
+		self->t.server.mac_address[5] = 0x34;
+
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x03;
+		insert_param( skb, "FILTER_MODE", 1, "NONE", 0, 0);
+		insert_param( skb, "MAX_ENTRY", 3, NULL, 0, 0x0001);
+		insert_array_param( skb, "FILTER_ENTRY", self->t.server.mac_address, 6);
+		return;
+	}
+	
+	if (( self->t.server.filter_type == IR_DIRECTED) && 
+	    ( self->t.server.filter_mode == FILTER))
+	{
+		DEBUG( 0, "Directed filter on\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+	if (( self->t.server.filter_type == IR_DIRECTED) && 
+	    ( self->t.server.filter_mode == NONE))
+	{
+		DEBUG( 0, "Directed filter off\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+
+	if (( self->t.server.filter_type == IR_BROADCAST) && 
+	    ( self->t.server.filter_mode == FILTER))
+	{
+		DEBUG( 0, "Broadcast filter on\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+	if (( self->t.server.filter_type == IR_BROADCAST) && 
+	    ( self->t.server.filter_mode == NONE))
+	{
+		DEBUG( 0, "Broadcast filter off\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+	if (( self->t.server.filter_type == IR_MULTICAST) && 
+	    ( self->t.server.filter_mode == FILTER))
+	{
+		DEBUG( 0, "Multicast filter on\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+	if (( self->t.server.filter_type == IR_MULTICAST) && 
+	    ( self->t.server.filter_mode == NONE))
+	{
+		DEBUG( 0, "Multicast filter off\n");
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x00;
+		return;
+	}
+	if (( self->t.server.filter_type == IR_MULTICAST) && 
+	    ( self->t.server.filter_operation == GET))
+	{
+		DEBUG( 0, "Multicast filter get\n");
+		skb->data[0] = 0x00; /* Success? */
+		skb->data[1] = 0x02;
+		insert_param( skb, "FILTER_MODE", 1, "NONE", 0, 0);
+		insert_param( skb, "MAX_ENTRY", 3, NULL, 0, 16);
+		return;
+	}
+	skb->data[0] = 0x00; /* Command not supported */
+	skb->data[1] = 0x00;
+
+	DEBUG( 0, "Not implemented!\n");
+}
+
+/*
+ * Function check_request_param (self, param, value)
+ *
+ *    Check parameters in request from peer device
+ *
+ */
+static void irlan_check_param( struct irlan_cb *self, char *param, char *value)
+{
+	__u8 *bytes;
+
+	DEBUG( 4, __FUNCTION__ "()\n");
+
+	bytes = value;
+
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	DEBUG( 4, "%s, %s\n", param, value);
+
+	/*
+	 *  This is experimental!! DB.
+	 */
+	 if ( strcmp( param, "MODE") == 0) {
+		DEBUG( 0, __FUNCTION__ "()\n");
+		self->use_udata = TRUE;
+		return;
+	}
+
+	/*
+	 *  FILTER_TYPE
+	 */
+	if ( strcmp( param, "FILTER_TYPE") == 0) {
+		if ( strcmp( value, "DIRECTED") == 0) {
+			self->t.server.filter_type = IR_DIRECTED;
+			return;
+		}
+		if ( strcmp( value, "MULTICAST") == 0) {
+			self->t.server.filter_type = IR_MULTICAST;
+			return;
+		}
+		if ( strcmp( value, "BROADCAST") == 0) {
+			self->t.server.filter_type = IR_BROADCAST;
+			return;
+		}
+	}
+	/*
+	 *  FILTER_MODE
+	 */
+	if ( strcmp( param, "FILTER_MODE") == 0) {
+		if ( strcmp( value, "ALL") == 0) {
+			self->t.server.filter_mode = ALL;
+			return;
+		}
+		if ( strcmp( value, "FILTER") == 0) {
+			self->t.server.filter_mode = FILTER;
+			return;
+		}
+		if ( strcmp( value, "NONE") == 0) {
+			self->t.server.filter_mode = FILTER;
+			return;
+		}
+	}
+	/*
+	 *  FILTER_OPERATION
+	 */
+	if ( strcmp( param, "FILTER_OPERATION") == 0) {
+		if ( strcmp( value, "DYNAMIC") == 0) {
+			self->t.server.filter_operation = DYNAMIC;
+			return;
+		}
+		if ( strcmp( value, "GET") == 0) {
+			self->t.server.filter_operation = GET;
+			return;
+		}
+	}
+}
+
+/*
+ * Function irlan_server_send_reply (self, info)
+ *
+ *    Send reply to query to peer IrLAN layer
+ *
+ */
+void irlan_server_send_reply( struct irlan_cb *self, int command, int ret_code)
+{
+	struct sk_buff *skb;
+
+	DEBUG( 4, "irlan_server_send_reply()\n");
+
+	ASSERT( self != NULL, return;);
+	ASSERT( self->magic == IRLAN_MAGIC, return;);
+
+	skb =  dev_alloc_skb( 128);
+	if (skb == NULL) {
+		DEBUG( 0,"irlan_server_send_reply: "
+		       "Could not allocate an sk_buff of length %d\n", 128);
+		return;
+	}
+
+	/* Reserve space for TTP, LMP, and LAP header */
+	skb_reserve( skb, TTP_HEADER+LMP_HEADER+LAP_HEADER);
+	skb_put( skb, 2);
+       
+	switch ( command) {
+	case CMD_GET_PROVIDER_INFO:
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x02; /* 2 parameters */
+		insert_param( skb, "MEDIA", 1, "802.3", 0, 0);
+		insert_param( skb, "IRLAN_VER", 3, NULL, 0, 0x0101);
+		break;
+	case CMD_GET_MEDIA_CHAR:
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x05; /* 5 parameters */
+		insert_param( skb, "FILTER_TYPE", 1, "DIRECTED", 0, 0);
+		insert_param( skb, "FILTER_TYPE", 1, "BROADCAST", 0, 0);
+		insert_param( skb, "FILTER_TYPE", 1, "MULTICAST", 0, 0);
+		insert_param( skb, "ACCESS_TYPE", 1, "DIRECTED", 0, 0);
+		insert_param( skb, "MAX_FRAME", 3, NULL, 0, 0x05ee);
+		break;
+	case CMD_OPEN_DATA_CHANNEL:
+		skb->data[0] = 0x00; /* Success */
+		skb->data[1] = 0x02; /* 2 parameters */
+		insert_param( skb, "DATA_CHAN", 2, NULL, self->stsap_sel_data, 0);
+		insert_param( skb, "RECONNECT_KEY", 1, "LINUX RULES!", 0, 0);
+		break;
+	case CMD_FILTER_OPERATION:
+		handle_filter_request( self, skb);
+		break;
+	default:
+		DEBUG( 0, __FUNCTION__ "(), Unknown command!\n");
+		break;
+	}
+
+	irttp_data_request( self->tsap_ctrl, skb);
+}
+
+/*
+ * Function irlan_server_register(void)
+ *
+ *    Register server support so we can accept incomming connections. We
+ *    must register both a TSAP for control and data
+ * 
+ */
+void irlan_server_register(void)
+{
+	struct notify_t notify;
+	struct irlan_cb *self;
+	struct ias_object *obj;
+	struct tsap_cb *tsap;
+	
+	DEBUG( 4, __FUNCTION__ "()\n");
+
+	/*
+	 *  Open irlan_server instance
+	 */
+	self = irlan_server_open();
+	if ( !self || self->magic != IRLAN_MAGIC) {
+		DEBUG( 0, __FUNCTION__"(), Unable to open server!\n");
+		return;
+	}
+	/*
+	 *  First register well known control TSAP
+	 */
+	irda_notify_init( &notify);
+	notify.data_indication       = irlan_server_control_data_indication;
+	notify.connect_indication    = irlan_server_connect_indication;
+	notify.disconnect_indication = irlan_server_disconnect_indication;
+	notify.instance = self;
+	strncpy( notify.name, "IrLAN srv. ctrl", 16);
+
+	/* FIXME: should not use a static value here! */
+	tsap = irttp_open_tsap( TSAP_IRLAN, 1, &notify);
+	if ( tsap == NULL) {
+		DEBUG( 0, __FUNCTION__ "(), Got no handle!!\n");
+		return;
+	}
+	self->tsap_ctrl = tsap;
+
+	/*
+	 *  Now register data TSAP
+	 */
+	irda_notify_init( &notify);
+	notify.data_indication       = irlan_eth_rx;
+	notify.udata_indication      = irlan_eth_rx;
+	notify.connect_indication    = irlan_server_connect_indication;
+	notify.disconnect_indication = irlan_server_disconnect_indication;
+	notify.instance = self;
+	strncpy( notify.name, "IrLAN srv. data", 16);
+
+	/*
+	 *  Register well known address with IrTTP
+	 */ 
+	tsap = irttp_open_tsap( LSAP_ANY, DEFAULT_INITIAL_CREDIT, &notify);
+	if ( tsap == NULL) {
+		DEBUG( 0, __FUNCTION__ "(), Got no handle!\n");
+		return;
+	}
+	self->tsap_data = tsap;
+
+	/* 
+	 *  This is the data TSAP selector which we will pass to the client
+	 *  when the client ask for it.
+	 */
+	self->stsap_sel_data = tsap->stsap_sel;
+	ASSERT( self->stsap_sel_data > 0, return;);
+
+	DEBUG( 0, "irlan_server_register(), Using Source TSAP selector=%02x\n",
+	       self->stsap_sel_data);
+	
+	/* 
+	 *  Register with LM-IAS
+	 */
+	obj = irias_new_object( "IrLAN", IAS_IRLAN_ID);
+	irias_add_integer_attrib( obj, "IrDA:TinyTP:LsapSel", TSAP_IRLAN);
+	irias_insert_object( obj);
+
+	obj = irias_new_object( "PnP", IAS_PNP_ID);
+	irias_add_string_attrib( obj, "Name", "Linux");
+	irias_add_string_attrib( obj, "DeviceID", "HWP19F0");
+	irias_add_integer_attrib( obj, "CompCnt", 2);
+	irias_add_string_attrib( obj, "Comp#01", "PNP8294");
+	irias_add_string_attrib( obj, "Comp#01", "PNP8389");
+	irias_add_string_attrib( obj, "Manufacturer", "Linux/IR Project");
+	irias_insert_object( obj);
+}
+
+#ifdef MODULE
+
+MODULE_AUTHOR("Dag Brattli <dagb@cs.uit.no>");
+MODULE_DESCRIPTION("The Linux IrDA LAN Server protocol"); 
+
+/*
+ * Function init_module (void)
+ *
+ *    Initialize the IrLAN module, this function is called by the
+ *    modprobe(1) program.
+ */
+int init_module(void) 
+{
+/* 	int result; */
+
+	DEBUG( 4, "--> IrLAN irlan_server: init_module\n");
+
+	irlan_server_init();
+
+	DEBUG( 4, "IrLAN irlan_server: init_module -->\n");	
+
+	return 0;
+}
+
+/*
+ * Function cleanup_module (void)
+ *
+ *    Remove the IrLAN module, this function is called by the rmmod(1)
+ *    program
+ */
+void cleanup_module(void) 
+{
+	DEBUG( 4, "--> irlan_server, cleanup_module\n");
+	/* No need to check MOD_IN_USE, as sys_delete_module() checks. */
+
+	/* Free some memory */
+ 	irlan_server_cleanup();
+
+	DEBUG( 4, "irlan_server, cleanup_module -->\n");
+}
+
+#endif /* MODULE */
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen, slshen@lbl.gov