sb1250-mac.c

来自「linux 内核源代码」· C语言 代码 · 共 2,649 行 · 第 1/5 页

C
2,649 行
字号
#ifdef CONFIG_SBMAC_COALESCE	__raw_writeq(((M_MAC_INT_EOP_COUNT | M_MAC_INT_EOP_TIMER) << S_MAC_TX_CH0) |		       ((M_MAC_INT_EOP_COUNT | M_MAC_INT_EOP_TIMER) << S_MAC_RX_CH0), s->sbm_imr);#else	__raw_writeq((M_MAC_INT_CHANNEL << S_MAC_TX_CH0) |		       (M_MAC_INT_CHANNEL << S_MAC_RX_CH0), s->sbm_imr);#endif	/*	 * Enable receiving unicasts and broadcasts	 */	__raw_writeq(M_MAC_UCAST_EN | M_MAC_BCAST_EN, s->sbm_rxfilter);	/*	 * we're running now.	 */	s->sbm_state = sbmac_state_on;	/*	 * Program multicast addresses	 */	sbmac_setmulti(s);	/*	 * If channel was in promiscuous mode before, turn that on	 */	if (s->sbm_devflags & IFF_PROMISC) {		sbmac_promiscuous_mode(s,1);	}}/********************************************************************** *  SBMAC_CHANNEL_STOP(s) * *  Stop packet processing on this MAC. * *  Input parameters: *  	   s - sbmac structure * *  Return value: *  	   nothing ********************************************************************* */static void sbmac_channel_stop(struct sbmac_softc *s){	/* don't do this if already stopped */	if (s->sbm_state == sbmac_state_off)		return;	/* don't accept any packets, disable all interrupts */	__raw_writeq(0, s->sbm_rxfilter);	__raw_writeq(0, s->sbm_imr);	/* Turn off ticker */	/* XXX */	/* turn off receiver and transmitter */	__raw_writeq(0, s->sbm_macenable);	/* We're stopped now. */	s->sbm_state = sbmac_state_off;	/*	 * Stop DMA channels (rings should be ok now)	 */	sbdma_channel_stop(&(s->sbm_rxdma));	sbdma_channel_stop(&(s->sbm_txdma));	/* Empty the receive and transmit rings */	sbdma_emptyring(&(s->sbm_rxdma));	sbdma_emptyring(&(s->sbm_txdma));}/********************************************************************** *  SBMAC_SET_CHANNEL_STATE(state) * *  Set the channel's state ON or OFF * *  Input parameters: *  	   state - new state * *  Return value: *  	   old state ********************************************************************* */static enum sbmac_state sbmac_set_channel_state(struct sbmac_softc *sc,						enum sbmac_state state){	enum sbmac_state oldstate = sc->sbm_state;	/*	 * If same as previous state, return	 */	if (state == oldstate) {		return oldstate;	}	/*	 * If new state is ON, turn channel on	 */	if (state == sbmac_state_on) {		sbmac_channel_start(sc);	}	else {		sbmac_channel_stop(sc);	}	/*	 * Return previous state	 */	return oldstate;}/********************************************************************** *  SBMAC_PROMISCUOUS_MODE(sc,onoff) * *  Turn on or off promiscuous mode * *  Input parameters: *  	   sc - softc *      onoff - 1 to turn on, 0 to turn off * *  Return value: *  	   nothing ********************************************************************* */static void sbmac_promiscuous_mode(struct sbmac_softc *sc,int onoff){	uint64_t reg;	if (sc->sbm_state != sbmac_state_on)		return;	if (onoff) {		reg = __raw_readq(sc->sbm_rxfilter);		reg |= M_MAC_ALLPKT_EN;		__raw_writeq(reg, sc->sbm_rxfilter);	}	else {		reg = __raw_readq(sc->sbm_rxfilter);		reg &= ~M_MAC_ALLPKT_EN;		__raw_writeq(reg, sc->sbm_rxfilter);	}}/********************************************************************** *  SBMAC_SETIPHDR_OFFSET(sc,onoff) * *  Set the iphdr offset as 15 assuming ethernet encapsulation * *  Input parameters: *  	   sc - softc * *  Return value: *  	   nothing ********************************************************************* */static void sbmac_set_iphdr_offset(struct sbmac_softc *sc){	uint64_t reg;	/* Hard code the off set to 15 for now */	reg = __raw_readq(sc->sbm_rxfilter);	reg &= ~M_MAC_IPHDR_OFFSET | V_MAC_IPHDR_OFFSET(15);	__raw_writeq(reg, sc->sbm_rxfilter);	/* BCM1250 pass1 didn't have hardware checksum.  Everything	   later does.  */	if (soc_type == K_SYS_SOC_TYPE_BCM1250 && periph_rev < 2) {		sc->rx_hw_checksum = DISABLE;	} else {		sc->rx_hw_checksum = ENABLE;	}}/********************************************************************** *  SBMAC_ADDR2REG(ptr) * *  Convert six bytes into the 64-bit register value that *  we typically write into the SBMAC's address/mcast registers * *  Input parameters: *  	   ptr - pointer to 6 bytes * *  Return value: *  	   register value ********************************************************************* */static uint64_t sbmac_addr2reg(unsigned char *ptr){	uint64_t reg = 0;	ptr += 6;	reg |= (uint64_t) *(--ptr);	reg <<= 8;	reg |= (uint64_t) *(--ptr);	reg <<= 8;	reg |= (uint64_t) *(--ptr);	reg <<= 8;	reg |= (uint64_t) *(--ptr);	reg <<= 8;	reg |= (uint64_t) *(--ptr);	reg <<= 8;	reg |= (uint64_t) *(--ptr);	return reg;}/********************************************************************** *  SBMAC_SET_SPEED(s,speed) * *  Configure LAN speed for the specified MAC. *  Warning: must be called when MAC is off! * *  Input parameters: *  	   s - sbmac structure *  	   speed - speed to set MAC to (see enum sbmac_speed) * *  Return value: *  	   1 if successful *      0 indicates invalid parameters ********************************************************************* */static int sbmac_set_speed(struct sbmac_softc *s, enum sbmac_speed speed){	uint64_t cfg;	uint64_t framecfg;	/*	 * Save new current values	 */	s->sbm_speed = speed;	if (s->sbm_state == sbmac_state_on)		return 0;	/* save for next restart */	/*	 * Read current register values	 */	cfg = __raw_readq(s->sbm_maccfg);	framecfg = __raw_readq(s->sbm_framecfg);	/*	 * Mask out the stuff we want to change	 */	cfg &= ~(M_MAC_BURST_EN | M_MAC_SPEED_SEL);	framecfg &= ~(M_MAC_IFG_RX | M_MAC_IFG_TX | M_MAC_IFG_THRSH |		      M_MAC_SLOT_SIZE);	/*	 * Now add in the new bits	 */	switch (speed) {	case sbmac_speed_10:		framecfg |= V_MAC_IFG_RX_10 |			V_MAC_IFG_TX_10 |			K_MAC_IFG_THRSH_10 |			V_MAC_SLOT_SIZE_10;		cfg |= V_MAC_SPEED_SEL_10MBPS;		break;	case sbmac_speed_100:		framecfg |= V_MAC_IFG_RX_100 |			V_MAC_IFG_TX_100 |			V_MAC_IFG_THRSH_100 |			V_MAC_SLOT_SIZE_100;		cfg |= V_MAC_SPEED_SEL_100MBPS ;		break;	case sbmac_speed_1000:		framecfg |= V_MAC_IFG_RX_1000 |			V_MAC_IFG_TX_1000 |			V_MAC_IFG_THRSH_1000 |			V_MAC_SLOT_SIZE_1000;		cfg |= V_MAC_SPEED_SEL_1000MBPS | M_MAC_BURST_EN;		break;	default:		return 0;	}	/*	 * Send the bits back to the hardware	 */	__raw_writeq(framecfg, s->sbm_framecfg);	__raw_writeq(cfg, s->sbm_maccfg);	return 1;}/********************************************************************** *  SBMAC_SET_DUPLEX(s,duplex,fc) * *  Set Ethernet duplex and flow control options for this MAC *  Warning: must be called when MAC is off! * *  Input parameters: *  	   s - sbmac structure *  	   duplex - duplex setting (see enum sbmac_duplex) *  	   fc - flow control setting (see enum sbmac_fc) * *  Return value: *  	   1 if ok *  	   0 if an invalid parameter combination was specified ********************************************************************* */static int sbmac_set_duplex(struct sbmac_softc *s, enum sbmac_duplex duplex,			    enum sbmac_fc fc){	uint64_t cfg;	/*	 * Save new current values	 */	s->sbm_duplex = duplex;	s->sbm_fc = fc;	if (s->sbm_state == sbmac_state_on)		return 0;	/* save for next restart */	/*	 * Read current register values	 */	cfg = __raw_readq(s->sbm_maccfg);	/*	 * Mask off the stuff we're about to change	 */	cfg &= ~(M_MAC_FC_SEL | M_MAC_FC_CMD | M_MAC_HDX_EN);	switch (duplex) {	case sbmac_duplex_half:		switch (fc) {		case sbmac_fc_disabled:			cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_DISABLED;			break;		case sbmac_fc_collision:			cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_ENABLED;			break;		case sbmac_fc_carrier:			cfg |= M_MAC_HDX_EN | V_MAC_FC_CMD_ENAB_FALSECARR;			break;		case sbmac_fc_frame:		/* not valid in half duplex */		default:			/* invalid selection */			return 0;		}		break;	case sbmac_duplex_full:		switch (fc) {		case sbmac_fc_disabled:			cfg |= V_MAC_FC_CMD_DISABLED;			break;		case sbmac_fc_frame:			cfg |= V_MAC_FC_CMD_ENABLED;			break;		case sbmac_fc_collision:	/* not valid in full duplex */		case sbmac_fc_carrier:		/* not valid in full duplex */		default:			return 0;		}		break;	default:		return 0;	}	/*	 * Send the bits back to the hardware	 */	__raw_writeq(cfg, s->sbm_maccfg);	return 1;}/********************************************************************** *  SBMAC_INTR() * *  Interrupt handler for MAC interrupts * *  Input parameters: *  	   MAC structure * *  Return value: *  	   nothing ********************************************************************* */static irqreturn_t sbmac_intr(int irq,void *dev_instance){	struct net_device *dev = (struct net_device *) dev_instance;	struct sbmac_softc *sc = netdev_priv(dev);	uint64_t isr;	int handled = 0;	/*	 * Read the ISR (this clears the bits in the real	 * register, except for counter addr)	 */	isr = __raw_readq(sc->sbm_isr) & ~M_MAC_COUNTER_ADDR;	if (isr == 0)		return IRQ_RETVAL(0);	handled = 1;	/*	 * Transmits on channel 0	 */	if (isr & (M_MAC_INT_CHANNEL << S_MAC_TX_CH0))		sbdma_tx_process(sc,&(sc->sbm_txdma), 0);	if (isr & (M_MAC_INT_CHANNEL << S_MAC_RX_CH0)) {		if (netif_rx_schedule_prep(dev, &sc->napi)) {			__raw_writeq(0, sc->sbm_imr);			__netif_rx_schedule(dev, &sc->napi);			/* Depend on the exit from poll to reenable intr */		}		else {			/* may leave some packets behind */			sbdma_rx_process(sc,&(sc->sbm_rxdma),					 SBMAC_MAX_RXDESCR * 2, 0);		}	}	return IRQ_RETVAL(handled);}/********************************************************************** *  SBMAC_START_TX(skb,dev) * *  Start output on the specified interface.  Basically, we *  queue as many buffers as we can until the ring fills up, or *  we run off the end of the queue, whichever comes first. * *  Input parameters: * * *  Return value: *  	   nothing ********************************************************************* */static int sbmac_start_tx(struct sk_buff *skb, struct net_device *dev){	struct sbmac_softc *sc = netdev_priv(dev);	/* lock eth irq */	spin_lock_irq (&sc->sbm_lock);	/*	 * Put the buffer on the transmit ring.  If we	 * don't have room, stop the queue.	 */	if (sbdma_add_txbuffer(&(sc->sbm_txdma),skb)) {		/* XXX save skb that we could not send */		netif_stop_queue(dev);		spin_unlock_irq(&sc->sbm_lock);		return 1;	}	dev->trans_start = jiffies;	spin_unlock_irq (&sc->sbm_lock);	return 0;}/********************************************************************** *  SBMAC_SETMULTI(sc) * *  Reprogram the multicast table into the hardware, given *  the list of multicasts associated with the interface *  structure. * *  Input parameters: *  	   sc - softc * *  Return value: *  	   nothing ********************************************************************* */static void sbmac_setmulti(struct sbmac_softc *sc){	uint64_t reg;	void __iomem *port;	int idx;	struct dev_mc_list *mclist;	struct net_device *dev = sc->sbm_dev;	/*	 * Clear out entire multicast table.  We do this by nuking	 * the entire hash table and all the direct matches except	 * the first one, which is used for our station address	 */

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?