Blame view

kernel/linux-rt-4.4.41/drivers/net/ethernet/dec/tulip/timer.c 4.8 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
  /*
  	drivers/net/ethernet/dec/tulip/timer.c
  
  	Copyright 2000,2001  The Linux Kernel Team
  	Written/copyright 1994-2001 by Donald Becker.
  
  	This software may be used and distributed according to the terms
  	of the GNU General Public License, incorporated herein by reference.
  
  	Please submit bugs to http://bugzilla.kernel.org/ .
  */
  
  
  #include "tulip.h"
  
  
  void tulip_media_task(struct work_struct *work)
  {
  	struct tulip_private *tp =
  		container_of(work, struct tulip_private, media_work);
  	struct net_device *dev = tp->dev;
  	void __iomem *ioaddr = tp->base_addr;
  	u32 csr12 = ioread32(ioaddr + CSR12);
  	int next_tick = 2*HZ;
  	unsigned long flags;
  
  	if (tulip_debug > 2) {
  		netdev_dbg(dev, "Media selection tick, %s, status %08x mode %08x SIA %08x %08x %08x %08x
  ",
  			   medianame[dev->if_port],
  			   ioread32(ioaddr + CSR5), ioread32(ioaddr + CSR6),
  			   csr12, ioread32(ioaddr + CSR13),
  			   ioread32(ioaddr + CSR14), ioread32(ioaddr + CSR15));
  	}
  	switch (tp->chip_id) {
  	case DC21140:
  	case DC21142:
  	case MX98713:
  	case COMPEX9881:
  	case DM910X:
  	default: {
  		struct medialeaf *mleaf;
  		unsigned char *p;
  		if (tp->mtable == NULL) {	/* No EEPROM info, use generic code. */
  			/* Not much that can be done.
  			   Assume this a generic MII or SYM transceiver. */
  			next_tick = 60*HZ;
  			if (tulip_debug > 2)
  				netdev_dbg(dev, "network media monitor CSR6 %08x CSR12 0x%02x
  ",
  					   ioread32(ioaddr + CSR6),
  					   csr12 & 0xff);
  			break;
  		}
  		mleaf = &tp->mtable->mleaf[tp->cur_index];
  		p = mleaf->leafdata;
  		switch (mleaf->type) {
  		case 0: case 4: {
  			/* Type 0 serial or 4 SYM transceiver.  Check the link beat bit. */
  			int offset = mleaf->type == 4 ? 5 : 2;
  			s8 bitnum = p[offset];
  			if (p[offset+1] & 0x80) {
  				if (tulip_debug > 1)
  					netdev_dbg(dev, "Transceiver monitor tick CSR12=%#02x, no media sense
  ",
  						   csr12);
  				if (mleaf->type == 4) {
  					if (mleaf->media == 3 && (csr12 & 0x02))
  						goto select_next_media;
  				}
  				break;
  			}
  			if (tulip_debug > 2)
  				netdev_dbg(dev, "Transceiver monitor tick: CSR12=%#02x bit %d is %d, expecting %d
  ",
  					   csr12, (bitnum >> 1) & 7,
  					   (csr12 & (1 << ((bitnum >> 1) & 7))) != 0,
  					   (bitnum >= 0));
  			/* Check that the specified bit has the proper value. */
  			if ((bitnum < 0) !=
  				((csr12 & (1 << ((bitnum >> 1) & 7))) != 0)) {
  				if (tulip_debug > 2)
  					netdev_dbg(dev, "Link beat detected for %s
  ",
  						   medianame[mleaf->media & MEDIA_MASK]);
  				if ((p[2] & 0x61) == 0x01)	/* Bogus Znyx board. */
  					goto actually_mii;
  				netif_carrier_on(dev);
  				break;
  			}
  			netif_carrier_off(dev);
  			if (tp->medialock)
  				break;
  	  select_next_media:
  			if (--tp->cur_index < 0) {
  				/* We start again, but should instead look for default. */
  				tp->cur_index = tp->mtable->leafcount - 1;
  			}
  			dev->if_port = tp->mtable->mleaf[tp->cur_index].media;
  			if (tulip_media_cap[dev->if_port] & MediaIsFD)
  				goto select_next_media; /* Skip FD entries. */
  			if (tulip_debug > 1)
  				netdev_dbg(dev, "No link beat on media %s, trying transceiver type %s
  ",
  					   medianame[mleaf->media & MEDIA_MASK],
  					   medianame[tp->mtable->mleaf[tp->cur_index].media]);
  			tulip_select_media(dev, 0);
  			/* Restart the transmit process. */
  			tulip_restart_rxtx(tp);
  			next_tick = (24*HZ)/10;
  			break;
  		}
  		case 1:  case 3:		/* 21140, 21142 MII */
  		actually_mii:
  			if (tulip_check_duplex(dev) < 0) {
  				netif_carrier_off(dev);
  				next_tick = 3*HZ;
  			} else {
  				netif_carrier_on(dev);
  				next_tick = 60*HZ;
  			}
  			break;
  		case 2:					/* 21142 serial block has no link beat. */
  		default:
  			break;
  		}
  	}
  	break;
  	}
  
  
  	spin_lock_irqsave(&tp->lock, flags);
  	if (tp->timeout_recovery) {
  		tulip_tx_timeout_complete(tp, ioaddr);
  		tp->timeout_recovery = 0;
  	}
  	spin_unlock_irqrestore(&tp->lock, flags);
  
  	/* mod_timer synchronizes us with potential add_timer calls
  	 * from interrupts.
  	 */
  	mod_timer(&tp->timer, RUN_AT(next_tick));
  }
  
  
  void mxic_timer(unsigned long data)
  {
  	struct net_device *dev = (struct net_device *)data;
  	struct tulip_private *tp = netdev_priv(dev);
  	void __iomem *ioaddr = tp->base_addr;
  	int next_tick = 60*HZ;
  
  	if (tulip_debug > 3) {
  		dev_info(&dev->dev, "MXIC negotiation status %08x
  ",
  			 ioread32(ioaddr + CSR12));
  	}
  	if (next_tick) {
  		mod_timer(&tp->timer, RUN_AT(next_tick));
  	}
  }
  
  
  void comet_timer(unsigned long data)
  {
  	struct net_device *dev = (struct net_device *)data;
  	struct tulip_private *tp = netdev_priv(dev);
  	int next_tick = 2*HZ;
  
  	if (tulip_debug > 1)
  		netdev_dbg(dev, "Comet link status %04x partner capability %04x
  ",
  			   tulip_mdio_read(dev, tp->phys[0], 1),
  			   tulip_mdio_read(dev, tp->phys[0], 5));
  	/* mod_timer synchronizes us with potential add_timer calls
  	 * from interrupts.
  	 */
  	if (tulip_check_duplex(dev) < 0)
  		{ netif_carrier_off(dev); }
  	else
  		{ netif_carrier_on(dev); }
  	mod_timer(&tp->timer, RUN_AT(next_tick));
  }