sdla_fr.c

powerpc内核mpc8241linux系统下net驱动程序

		u.cfg.n393 = 4;
	if (fr_configure(card, &u.cfg))
		return -EIO;
	if (card->hw.fwid == SFID_FR508) 
	{
		fr_buf_info_t *buf_info =
		(void *) (card->hw.dpmbase + FR508_RXBC_OFFS);
		card->rxmb = (void *) (buf_info->rse_next - FR_MB_VECTOR + card->hw.dpmbase);
		card->u.f.rxmb_base = (void *) (buf_info->rse_base - FR_MB_VECTOR + card->hw.dpmbase);
		card->u.f.rxmb_last = (void *) (buf_info->rse_base + (buf_info->rse_num - 1) * 
				sizeof(fr_buf_ctl_t) - FR_MB_VECTOR + card->hw.dpmbase);
		card->u.f.rx_base = buf_info->buf_base;
		card->u.f.rx_top = buf_info->buf_top;
	}
	card->wandev.mtu = conf->mtu;
	card->wandev.bps = conf->bps;
	card->wandev.interface = conf->interface;
	card->wandev.clocking = conf->clocking;
	card->wandev.station = conf->station;
	card->poll = &wpf_poll;
	card->exec = &wpf_exec;
	card->wandev.update = &update;
	card->wandev.new_if = &new_if;
	card->wandev.del_if = &del_if;
	card->wandev.state = WAN_DISCONNECTED;
	card->wandev.ttl = conf->ttl;
	card->wandev.udp_port = conf->udp_port;
	card->wandev.enable_tx_int = 0;
	card->irq_dis_if_send_count = 0;
	card->irq_dis_poll_count = 0;
	card->wandev.enable_IPX = conf->enable_IPX;
	if (conf->network_number)
		card->wandev.network_number = conf->network_number;
	else
		card->wandev.network_number = 0xDEADBEEF;
	/* Intialize global statistics for a card */
	init_global_statistics(card);
	TracingEnabled = 0;
	return 0;
}

/******* WAN Device Driver Entry Points *************************************/

/*============================================================================
 * Update device status & statistics.
 */

static int update(wan_device_t * wandev)
{
	sdla_t *card;
	/* sanity checks */
	if ((wandev == NULL) || (wandev->private == NULL))
		return -EFAULT;
	if (wandev->state == WAN_UNCONFIGURED)
		return -ENODEV;
	if (test_and_set_bit(0, (void *) &wandev->critical))
		return -EAGAIN;
	card = wandev->private;
	fr_get_err_stats(card);
	fr_get_stats(card);
	wandev->critical = 0;
	return 0;
}

/*============================================================================
 * Create new logical channel.
 * This routine is called by the router when ROUTER_IFNEW IOCTL is being
 * handled.
 * o parse media- and hardware-specific configuration
 * o make sure that a new channel can be created
 * o allocate resources, if necessary
 * o prepare network device structure for registaration.
 *
 * Return:	0	o.k.
 *		< 0	failure (channel will not be created)
 */

static int new_if(wan_device_t * wandev, struct device *dev, wanif_conf_t * conf)
{
	sdla_t *card = wandev->private;
	fr_channel_t *chan;
	int err = 0;
	if ((conf->name[0] == '\0') || (strlen(conf->name) > WAN_IFNAME_SZ)) 
	{
		printk(KERN_INFO "%s: invalid interface name!\n",
		       card->devname);
		return -EINVAL;
	}
	/* allocate and initialize private data */
	chan = kmalloc(sizeof(fr_channel_t), GFP_KERNEL);
	if (chan == NULL)
		return -ENOMEM;
	memset(chan, 0, sizeof(fr_channel_t));
	strcpy(chan->name, conf->name);
	chan->card = card;
	/* verify media address */
	if (is_digit(conf->addr[0])) 
	{
		int dlci = dec_to_uint(conf->addr, 0);
		if (dlci && (dlci <= 4095)) 
		{
			chan->dlci = dlci;
		}
		else
		{
			printk(KERN_ERR "%s: invalid DLCI %u on interface %s!\n",
			       wandev->name, dlci, chan->name);
			err = -EINVAL;
		}
	} 
	else 
	{
		printk(KERN_ERR "%s: invalid media address on interface %s!\n",
		       wandev->name, chan->name);
		err = -EINVAL;
	}
	if (err) 
	{
		kfree(chan);
		return err;
	}
	/* place cir,be,bc and other channel specific information into the
	 * chan structure 
	 */
	if (conf->cir) 
	{
		chan->cir = max(1, min(conf->cir, 512));
		chan->cir_status = CIR_ENABLED;
		if (conf->bc)
			chan->bc = max(1, min(conf->bc, 512));
		if (conf->be)
			chan->be = max(0, min(conf->be, 511));
	}
	else
		chan->cir_status = CIR_DISABLED;
	chan->mc = conf->mc;
	chan->dlci_configured = DLCI_NOT_CONFIGURED;
	chan->tx_int_status = DISABLED;
	init_chan_statistics(chan);
	/* prepare network device data space for registration */
	dev->name = chan->name;
	dev->init = &if_init;
	dev->priv = chan;
	return 0;
}
/*============================================================================
 * Delete logical channel.
 */
static int del_if(wan_device_t * wandev, struct device *dev)
{
	if (dev->priv) 
	{
		kfree(dev->priv);
		dev->priv = NULL;
	}
	return 0;
}

/****** WANPIPE-specific entry points ***************************************/

/*============================================================================
 * Execute adapter interface command.
 */
static int wpf_exec(struct sdla *card, void *u_cmd, void *u_data)
{
	fr_mbox_t *mbox = card->mbox;
	int retry = MAX_CMD_RETRY;
	int err, len;
	fr_cmd_t cmd;
	if(copy_from_user((void *) &cmd, u_cmd, sizeof(cmd)))
		return -EFAULT;		
	/* execute command */
	do 
	{
		memcpy(&mbox->cmd, &cmd, sizeof(cmd));
		if (cmd.length)
		{
			if(copy_from_user((void *) &mbox->data, u_data, cmd.length))
				return -EFAULT;
		}
		if (sdla_exec(mbox))
			err = mbox->cmd.result;
		else
			return -EIO;
	} 
	while (err && retry-- && fr_event(card, err, mbox));

	/* return result */

	if(copy_to_user(u_cmd, (void *) &mbox->cmd, sizeof(fr_cmd_t)))
		return -EFAULT;
	len = mbox->cmd.length;
	if (len && u_data && copy_to_user(u_data, (void *) &mbox->data, len))
		return -EFAULT;
	return 0;
}

/****** Network Device Interface ********************************************/
/*============================================================================
 * Initialize Linux network interface.
 *
 * This routine is called only once for each interface, during Linux network
 * interface registration.  Returning anything but zero will fail interface
 * registration.
 */
static int if_init(struct device *dev)
{
	fr_channel_t *chan = dev->priv;
	sdla_t *card = chan->card;
	wan_device_t *wandev = &card->wandev;

	/* Initialize device driver entry points */
	dev->open = &if_open;
	dev->stop = &if_close;
	dev->hard_header = &if_header;
	dev->rebuild_header = &if_rebuild_hdr;
	dev->hard_start_xmit = &if_send;
	dev->get_stats = &if_stats;
	/* Initialize media-specific parameters */
	dev->type = ARPHRD_DLCI;			/* ARP h/w type */
	dev->mtu = FR_CHANNEL_MTU;
	dev->hard_header_len = FR_HEADER_LEN;		/* media header length */
	dev->addr_len = 2;				/* hardware address length */
	*(unsigned short *) dev->dev_addr = htons(chan->dlci);
	/* Initialize hardware parameters (just for reference) */
	dev->irq = wandev->irq;
	dev->dma = wandev->dma;
	dev->base_addr = wandev->ioport;
	dev->mem_start = (unsigned long)wandev->maddr;
	dev->mem_end = dev->mem_start + wandev->msize - 1;
	/* Set transmit buffer queue length */
	dev->tx_queue_len = 10;
	/* Initialize socket buffers */
	dev_init_buffers(dev);
	set_chan_state(dev, WAN_DISCONNECTED);
	return 0;
}

/*============================================================================
 * Open network interface.
 * o if this is the first open, then enable communications and interrupts.
 * o prevent module from unloading by incrementing use count
 *
 * Return 0 if O.k. or errno.
 */

static int if_open(struct device *dev)
{
	fr_channel_t *chan = dev->priv;
	sdla_t *card = chan->card;
	struct device *dev2;
	int err = 0;
	fr508_flags_t *flags = card->flags;
	struct timeval tv;
	if (dev->start)
		return -EBUSY;	/* only one open is allowed */
	if (test_and_set_bit(0, (void *) &card->wandev.critical))
		return -EAGAIN;
	if (!card->open_cnt) 
	{
		Intr_test_counter = 0;
		card->intr_mode = INTR_TEST_MODE;
		err = intr_test(card);
		if ((err) || (Intr_test_counter != (MAX_INTR_TEST_COUNTER + 1))) {
			printk(KERN_INFO
			       "%s: Interrupt Test Failed, Counter: %i\n",
			       card->devname, Intr_test_counter);
			err = -EIO;
			card->wandev.critical = 0;
			return err;
		}
		printk(KERN_INFO "%s: Interrupt Test Passed, Counter: %i\n"
		       ,card->devname, Intr_test_counter);
		/* The following allocates and intializes a circular
		 * link list of interfaces per card.
		 */
		card->devs_struct = kmalloc(sizeof(load_sharing_t), GFP_KERNEL);
		if (card->devs_struct == NULL)
			return -ENOMEM;
		card->dev_to_devtint_next = card->devs_struct;
		for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave) {
			(card->devs_struct)->dev_ptr = dev2;
			if (dev2->slave == NULL)
				(card->devs_struct)->next = card->dev_to_devtint_next;
			else {
				(card->devs_struct)->next = kmalloc(
				     sizeof(load_sharing_t), GFP_KERNEL);
				if ((card->devs_struct)->next == NULL)
					return -ENOMEM;
				card->devs_struct = (card->devs_struct)->next;
			}
		}
		card->devs_struct = card->dev_to_devtint_next;
		card->intr_mode = BUFFER_INTR_MODE;
		/* 
		   check all the interfaces for the device to see if CIR has
		   been enabled for any DLCI(s). If so then use the DLCI list
		   Interrupt mode for fr_set_intr_mode(), otherwise use the                     default global interrupt mode
		 */
		for (dev2 = card->wandev.dev; dev2; dev2 = dev2->slave) {
			if (((fr_channel_t *) dev2->priv)->cir_status
			    == CIR_ENABLED) {
				card->intr_mode = DLCI_LIST_INTR_MODE;
				break;
			}
		}
		/* 
		   If you enable comms and then set ints, you get a Tx int as you
		   perform the SET_INT_TRIGGERS command. So, we only set int
		   triggers and then adjust the interrupt mask (to disable Tx ints)             before enabling comms. 
		 */
		if (card->intr_mode == BUFFER_INTR_MODE) {
			if (fr_set_intr_mode(card, 0x03, card->wandev.mtu)) {
				err = -EIO;
				card->wandev.critical = 0;
				return err;
			}
			printk(KERN_INFO
			       "%s: Global Buffering Tx Interrupt Mode\n"
			       ,card->devname);
		} else if (card->intr_mode == DLCI_LIST_INTR_MODE) {
			if (fr_set_intr_mode(card, 0x83, card->wandev.mtu)) {
				err = -EIO;
				card->wandev.critical = 0;
				return err;
			}
			printk(KERN_INFO
			       "%s: DLCI list Tx Interrupt Mode\n",
			       card->devname);
		}
		flags->imask &= ~0x02;
		if (fr_comm_enable(card)) {
			err = -EIO;
			card->wandev.critical = 0;
			return err;
		}
		wanpipe_set_state(card, WAN_CONNECTED);
		if (card->wandev.station == WANOPT_CPE) {
			/* CPE: issue full status enquiry */
			fr_issue_isf(card, FR_ISF_FSE);
		} else {	/* FR switch: activate DLCI(s) */
			/* For Switch emulation we have to ADD and ACTIVATE
			 * the DLCI(s) that were configured with the SET_DLCI_
			 * CONFIGURATION command. Add and Activate will fail if
			 * DLCI specified is not included in the list.
			 *
			 * Also If_open is called once for each interface. But
			 * it does not get in here for all the interface. So
			 * we have to pass the entire list of DLCI(s) to add 
			 * activate routines.  
			 */
			fr_add_dlci(card,
			     card->u.f.node_dlci[0], card->u.f.dlci_num);
			fr_activate_dlci(card,
			     card->u.f.node_dlci[0], card->u.f.dlci_num);
		}
	}
	dev->mtu = min(dev->mtu, card->wandev.mtu - FR_HEADER_LEN);
	dev->interrupt = 0;
	dev->tbusy = 0;
	dev->start = 1;
	wanpipe_open(card);
	update_chan_state(dev);
	do_gettimeofday(&tv);
	chan->router_start_time = tv.tv_sec;
	card->wandev.critical = 0;
	return err;
}

/*============================================================================
 * Close network interface.
 * o if this is the last open, then disable communications and interrupts.
 * o reset flags.
 */

static int if_close(struct device *dev)
{
	fr_channel_t *chan = dev->priv;
	sdla_t *card = chan->card;
	if (test_and_set_bit(0, (void *) &card->wandev.critical))
		return -EAGAIN;
	dev->start = 0;
	wanpipe_close(card);
	if (!card->open_cnt) 
	{
		wanpipe_set_state(card, WAN_DISCONNECTED);
		fr_set_intr_mode(card, 0, 0);
		fr_comm_disable(card);
	}
	card->wandev.critical = 0;
	return 0;
}

/*============================================================================
 * Build media header.
 * o encapsulate packet according to encapsulation type.
 *
 * The trick here is to put packet type (Ethertype) into 'protocol' field of
 * the socket buffer, so that we don't forget it.  If encapsulation fails,
 * set skb->protocol to 0 and discard packet later.
 *
 * Return:	media header length.
 */

static int if_header(struct sk_buff *skb, struct device *dev,
	     unsigned short type, void *daddr, void *saddr, unsigned len)
{
	int hdr_len = 0;
	skb->protocol = type;
	hdr_len = wanrouter_encapsulate(skb, dev);
	if (hdr_len < 0) 
	{
		hdr_len = 0;
		skb->protocol = 0;
	}
	skb_push(skb, 1);
	skb->data[0] = Q922_UI;
	++hdr_len;
	return hdr_len;
}

/*============================================================================
 * Re-build media header.
 *