1 | /*
|
---|
2 | ** File: eth.c Version 1.00, Jan. 14, 1997
|
---|
3 | **
|
---|
4 | ** Author: Giovanni Falzoni <gfalzoni@inwind.it>
|
---|
5 | **
|
---|
6 | ** This file contains the ethernet device driver main task.
|
---|
7 | ** It has to be integrated with the board specific drivers.
|
---|
8 | ** It is a rewriting of Minix 2.0.0 ethernet driver (dp8390.c)
|
---|
9 | ** to remove bord specific code. It should operate (I hope)
|
---|
10 | ** with any board driver.
|
---|
11 | **
|
---|
12 | ** The valid messages and their parameters are:
|
---|
13 | **
|
---|
14 | ** m_type DL_PORT DL_PROC DL_COUNT DL_MODE DL_ADDR
|
---|
15 | ** +------------+---------+---------+--------+-------+---------+
|
---|
16 | ** | HARD_INT | | | | | |
|
---|
17 | ** +------------+---------+---------+--------+-------+---------+
|
---|
18 | ** | SYN_ALARM | | | | | |
|
---|
19 | ** +------------+---------+---------+--------+-------+---------+
|
---|
20 | ** | HARD_STOP | | | | | |
|
---|
21 | ** +------------+---------+---------+--------+-------+---------+
|
---|
22 | ** | FKEY_PRESSED | | | | | (99)
|
---|
23 | ** +------------+---------+---------+--------+-------+---------+
|
---|
24 | ** | DL_WRITE | port nr | proc nr | count | mode | address | (3)
|
---|
25 | ** +------------+---------+---------+--------+-------+---------+
|
---|
26 | ** | DL_WRITEV | port nr | proc nr | count | mode | address | (4)
|
---|
27 | ** +------------+---------+---------+--------+-------+---------+
|
---|
28 | ** | DL_READ | port nr | proc nr | count | | address | (5)
|
---|
29 | ** +------------+---------+---------+--------+-------+---------+
|
---|
30 | ** | DL_READV | port nr | proc nr | count | | address | (6)
|
---|
31 | ** +------------+---------+---------+--------+-------+---------+
|
---|
32 | ** | DL_INIT | port nr | proc nr | | mode | address | (7)
|
---|
33 | ** +------------+---------+---------+--------+-------+---------+
|
---|
34 | ** | DL_STOP | port_nr | | | | | (8)
|
---|
35 | ** +------------+---------+---------+--------+-------+---------+
|
---|
36 | ** | DL_GETSTAT | port nr | proc nr | | | address | (9)
|
---|
37 | ** +------------+---------+---------+--------+-------+---------+
|
---|
38 | **
|
---|
39 | ** The messages sent are:
|
---|
40 | **
|
---|
41 | ** m-type DL_PORT DL_PROC DL_COUNT DL_STAT DL_CLCK
|
---|
42 | ** +------------+---------+---------+--------+---------+---------+
|
---|
43 | ** |DL_TASK_REPL| port nr | proc nr |rd-count| err|stat| clock | (21)
|
---|
44 | ** +------------+---------+---------+--------+---------+---------+
|
---|
45 | **
|
---|
46 | ** m_type m3_i1 m3_i2 m3_ca1
|
---|
47 | ** +------------+---------+---------+---------------+
|
---|
48 | ** |DL_INIT_REPL| port nr |last port| ethernet addr | (20)
|
---|
49 | ** +------------+---------+---------+---------------+
|
---|
50 | **
|
---|
51 | ** $Id: dp.c,v 1.13 2006/03/25 04:49:03 beng Exp $
|
---|
52 | */
|
---|
53 |
|
---|
54 | #include "drivers.h"
|
---|
55 | #include <minix/keymap.h>
|
---|
56 | #include <net/hton.h>
|
---|
57 | #include <net/gen/ether.h>
|
---|
58 | #include <net/gen/eth_io.h>
|
---|
59 |
|
---|
60 | #include "dp.h"
|
---|
61 |
|
---|
62 | /*
|
---|
63 | ** Local data
|
---|
64 | */
|
---|
65 | extern int errno;
|
---|
66 | static dpeth_t de_table[DE_PORT_NR];
|
---|
67 | static char *progname;
|
---|
68 |
|
---|
69 | typedef struct dp_conf { /* Configuration description structure */
|
---|
70 | port_t dpc_port;
|
---|
71 | int dpc_irq;
|
---|
72 | phys_bytes dpc_mem;
|
---|
73 | char *dpc_envvar;
|
---|
74 | } dp_conf_t;
|
---|
75 |
|
---|
76 | /* Device default configuration */
|
---|
77 | static dp_conf_t dp_conf[DE_PORT_NR] = {
|
---|
78 | /* I/O port, IRQ, Buff addr, Env. var, Buf. selector */
|
---|
79 | { 0x300, 5, 0xC8000, "DPETH0", },
|
---|
80 | { 0x280, 10, 0xCC000, "DPETH1", },
|
---|
81 | };
|
---|
82 |
|
---|
83 | static const char CopyErrMsg[] = "unable to read/write user data";
|
---|
84 | static const char PortErrMsg[] = "illegal port";
|
---|
85 | static const char RecvErrMsg[] = "receive failed";
|
---|
86 | static const char SendErrMsg[] = "send failed";
|
---|
87 | static const char SizeErrMsg[] = "illegal packet size";
|
---|
88 | static const char TypeErrMsg[] = "illegal message type";
|
---|
89 | static const char DevName[] = "eth#?";
|
---|
90 |
|
---|
91 | static void do_getname(message *mp);
|
---|
92 |
|
---|
93 | /*
|
---|
94 | ** Name: void reply(dpeth_t *dep, int err)
|
---|
95 | ** Function: Fills a DL_TASK_REPLY reply message and sends it.
|
---|
96 | */
|
---|
97 | static void reply(dpeth_t * dep, int err)
|
---|
98 | {
|
---|
99 | message reply;
|
---|
100 | int status = FALSE;
|
---|
101 |
|
---|
102 | if (dep->de_flags & DEF_ACK_SEND) status |= DL_PACK_SEND;
|
---|
103 | if (dep->de_flags & DEF_ACK_RECV) status |= DL_PACK_RECV;
|
---|
104 |
|
---|
105 | reply.m_type = DL_TASK_REPLY;
|
---|
106 | reply.DL_PORT = dep - de_table;
|
---|
107 | reply.DL_PROC = dep->de_client;
|
---|
108 | reply.DL_STAT = status /* | ((u32_t) err << 16) */;
|
---|
109 | reply.DL_COUNT = dep->de_read_s;
|
---|
110 | getuptime(&reply.DL_CLCK);
|
---|
111 |
|
---|
112 | DEBUG(printf("\t reply %d (%ld)\n", reply.m_type, reply.DL_STAT));
|
---|
113 |
|
---|
114 | if ((status = send(dep->de_client, &reply)) == OK) {
|
---|
115 | dep->de_read_s = 0;
|
---|
116 | dep->de_flags &= NOT(DEF_ACK_SEND | DEF_ACK_RECV);
|
---|
117 |
|
---|
118 | } else if (status != ELOCKED || err == OK)
|
---|
119 | panic(dep->de_name, SendErrMsg, status);
|
---|
120 |
|
---|
121 | return;
|
---|
122 | }
|
---|
123 |
|
---|
124 | /*
|
---|
125 | ** Name: void dp_confaddr(dpeth_t *dep)
|
---|
126 | ** Function: Checks environment for a User defined ethernet address.
|
---|
127 | */
|
---|
128 | static void dp_confaddr(dpeth_t * dep)
|
---|
129 | {
|
---|
130 | static char ea_fmt[] = "x:x:x:x:x:x";
|
---|
131 | char ea_key[16];
|
---|
132 | int ix;
|
---|
133 | long val;
|
---|
134 |
|
---|
135 | strcpy(ea_key, dp_conf[dep - de_table].dpc_envvar);
|
---|
136 | strcat(ea_key, "_EA");
|
---|
137 |
|
---|
138 | for (ix = 0; ix < SA_ADDR_LEN; ix++) {
|
---|
139 | val = dep->de_address.ea_addr[ix];
|
---|
140 | if (env_parse(ea_key, ea_fmt, ix, &val, 0x00L, 0xFFL) != EP_SET)
|
---|
141 | break;
|
---|
142 | dep->de_address.ea_addr[ix] = val;
|
---|
143 | }
|
---|
144 |
|
---|
145 | if (ix != 0 && ix != SA_ADDR_LEN)
|
---|
146 | /* It's all or nothing, force a panic */
|
---|
147 | env_parse(ea_key, "?", 0, &val, 0L, 0L);
|
---|
148 | return;
|
---|
149 | }
|
---|
150 |
|
---|
151 | /*
|
---|
152 | ** Name: void update_conf(dpeth_t *dep, dp_conf_t *dcp)
|
---|
153 | ** Function: Gets the default settings from 'dp_conf' table and
|
---|
154 | ** modifies them from the environment.
|
---|
155 | */
|
---|
156 | static void update_conf(dpeth_t * dep, dp_conf_t * dcp)
|
---|
157 | {
|
---|
158 | static char dpc_fmt[] = "x:d:x";
|
---|
159 | long val;
|
---|
160 |
|
---|
161 | dep->de_mode = DEM_SINK;
|
---|
162 | val = dcp->dpc_port; /* Get I/O port address */
|
---|
163 | switch (env_parse(dcp->dpc_envvar, dpc_fmt, 0, &val, 0x000L, 0x3FFL)) {
|
---|
164 | case EP_OFF: dep->de_mode = DEM_DISABLED; break;
|
---|
165 | case EP_ON:
|
---|
166 | case EP_SET: dep->de_mode = DEM_ENABLED; break;
|
---|
167 | }
|
---|
168 | dep->de_base_port = val;
|
---|
169 |
|
---|
170 | val = dcp->dpc_irq | DEI_DEFAULT; /* Get Interrupt line (IRQ) */
|
---|
171 | env_parse(dcp->dpc_envvar, dpc_fmt, 1, &val, 0L, (long) NR_IRQ_VECTORS - 1);
|
---|
172 | dep->de_irq = val;
|
---|
173 |
|
---|
174 | val = dcp->dpc_mem; /* Get shared memory address */
|
---|
175 | env_parse(dcp->dpc_envvar, dpc_fmt, 2, &val, 0L, LONG_MAX);
|
---|
176 | dep->de_linmem = val;
|
---|
177 |
|
---|
178 | return;
|
---|
179 | }
|
---|
180 |
|
---|
181 | /*
|
---|
182 | ** Name: void do_dump(message *mp)
|
---|
183 | ** Function: Displays statistics on screen (SFx key from console)
|
---|
184 | */
|
---|
185 | static void do_dump(message *mp)
|
---|
186 | {
|
---|
187 | dpeth_t *dep;
|
---|
188 | int port;
|
---|
189 |
|
---|
190 | printf("\n\n");
|
---|
191 | for (port = 0, dep = de_table; port < DE_PORT_NR; port += 1, dep += 1) {
|
---|
192 |
|
---|
193 | if (dep->de_mode == DEM_DISABLED) continue;
|
---|
194 |
|
---|
195 | printf("%s statistics:\t\t", dep->de_name);
|
---|
196 |
|
---|
197 | /* Network interface status */
|
---|
198 | printf("Status: 0x%04x (%d)\n\n", dep->de_flags, dep->de_int_pending);
|
---|
199 |
|
---|
200 | (*dep->de_dumpstatsf) (dep);
|
---|
201 |
|
---|
202 | /* Transmitted/received bytes */
|
---|
203 | printf("Tx bytes:%10ld\t", dep->bytes_Tx);
|
---|
204 | printf("Rx bytes:%10ld\n", dep->bytes_Rx);
|
---|
205 |
|
---|
206 | /* Transmitted/received packets */
|
---|
207 | printf("Tx OK: %8ld\t", dep->de_stat.ets_packetT);
|
---|
208 | printf("Rx OK: %8ld\n", dep->de_stat.ets_packetR);
|
---|
209 |
|
---|
210 | /* Transmit/receive errors */
|
---|
211 | printf("Tx Err: %8ld\t", dep->de_stat.ets_sendErr);
|
---|
212 | printf("Rx Err: %8ld\n", dep->de_stat.ets_recvErr);
|
---|
213 |
|
---|
214 | /* Transmit unnerruns/receive overrruns */
|
---|
215 | printf("Tx Und: %8ld\t", dep->de_stat.ets_fifoUnder);
|
---|
216 | printf("Rx Ovr: %8ld\n", dep->de_stat.ets_fifoOver);
|
---|
217 |
|
---|
218 | /* Transmit collisions/receive CRC errors */
|
---|
219 | printf("Tx Coll: %8ld\t", dep->de_stat.ets_collision);
|
---|
220 | printf("Rx CRC: %8ld\n", dep->de_stat.ets_CRCerr);
|
---|
221 | }
|
---|
222 | return;
|
---|
223 | }
|
---|
224 |
|
---|
225 | /*
|
---|
226 | ** Name: void get_userdata(int user_proc, vir_bytes user_addr, int count, void *loc_addr)
|
---|
227 | ** Function: Copies data from user area.
|
---|
228 | */
|
---|
229 | static void get_userdata(int user_proc, vir_bytes user_addr, int count, void *loc_addr)
|
---|
230 | {
|
---|
231 | int rc;
|
---|
232 | vir_bytes len;
|
---|
233 |
|
---|
234 | len = (count > IOVEC_NR ? IOVEC_NR : count) * sizeof(iovec_t);
|
---|
235 | if ((rc = sys_datacopy(user_proc, user_addr, SELF, (vir_bytes)loc_addr, len)) != OK)
|
---|
236 | panic(DevName, CopyErrMsg, rc);
|
---|
237 | return;
|
---|
238 | }
|
---|
239 |
|
---|
240 | /*
|
---|
241 | ** Name: void do_first_init(dpeth_t *dep, dp_conf_t *dcp);
|
---|
242 | ** Function: Init action to setup task
|
---|
243 | */
|
---|
244 | static void do_first_init(dpeth_t *dep, dp_conf_t *dcp)
|
---|
245 | {
|
---|
246 |
|
---|
247 | if (dep->de_linmem != 0) {
|
---|
248 | dep->de_memsegm = BIOS_SEG;
|
---|
249 | /* phys2seg(&dep->de_memsegm, &dep->de_memoffs, dep->de_linmem); */
|
---|
250 | } else
|
---|
251 | dep->de_linmem = 0xFFFF0000;
|
---|
252 |
|
---|
253 | /* Make sure statisics are cleared */
|
---|
254 | memset((void *) &(dep->de_stat), 0, sizeof(eth_stat_t));
|
---|
255 |
|
---|
256 | /* Device specific initialization */
|
---|
257 | (*dep->de_initf) (dep);
|
---|
258 |
|
---|
259 | /* Set the interrupt handler policy. Request interrupts not to be reenabled
|
---|
260 | * automatically. Return the IRQ line number when an interrupt occurs.
|
---|
261 | */
|
---|
262 | dep->de_hook = dep->de_irq;
|
---|
263 | sys_irqsetpolicy(dep->de_irq, 0 /*IRQ_REENABLE*/, &dep->de_hook);
|
---|
264 | dep->de_int_pending = FALSE;
|
---|
265 | sys_irqenable(&dep->de_hook);
|
---|
266 |
|
---|
267 | return;
|
---|
268 | }
|
---|
269 |
|
---|
270 | /*
|
---|
271 | ** Name: void do_init(message *mp)
|
---|
272 | ** Function: Checks for hardware presence.
|
---|
273 | ** Provides initialization of hardware and data structures
|
---|
274 | */
|
---|
275 | static void do_init(message * mp)
|
---|
276 | {
|
---|
277 | int port;
|
---|
278 | dpeth_t *dep;
|
---|
279 | dp_conf_t *dcp;
|
---|
280 | message reply_mess;
|
---|
281 |
|
---|
282 | port = mp->DL_PORT;
|
---|
283 | if (port >= 0 && port < DE_PORT_NR) {
|
---|
284 |
|
---|
285 | dep = &de_table[port];
|
---|
286 | dcp = &dp_conf[port];
|
---|
287 | strcpy(dep->de_name, DevName);
|
---|
288 | dep->de_name[4] = '0' + port;
|
---|
289 |
|
---|
290 | if (dep->de_mode == DEM_DISABLED) {
|
---|
291 |
|
---|
292 | update_conf(dep, dcp); /* First time thru */
|
---|
293 | if (dep->de_mode == DEM_ENABLED &&
|
---|
294 | !el1_probe(dep) && /* Probe for 3c501 */
|
---|
295 | !wdeth_probe(dep) && /* Probe for WD80x3 */
|
---|
296 | !ne_probe(dep) && /* Probe for NEx000 */
|
---|
297 | !el2_probe(dep) && /* Probe for 3c503 */
|
---|
298 | !el3_probe(dep)) { /* Probe for 3c509 */
|
---|
299 | printf("%s: warning no ethernet card found at 0x%04X\n",
|
---|
300 | dep->de_name, dep->de_base_port);
|
---|
301 | dep->de_mode = DEM_DISABLED;
|
---|
302 | }
|
---|
303 | }
|
---|
304 |
|
---|
305 | /* 'de_mode' may change if probe routines fail, test again */
|
---|
306 | switch (dep->de_mode) {
|
---|
307 |
|
---|
308 | case DEM_DISABLED:
|
---|
309 | /* Device is configured OFF or hardware probe failed */
|
---|
310 | port = ENXIO;
|
---|
311 | break;
|
---|
312 |
|
---|
313 | case DEM_ENABLED:
|
---|
314 | /* Device is present and probed */
|
---|
315 | if (dep->de_flags == DEF_EMPTY) {
|
---|
316 | /* These actions only the first time */
|
---|
317 | do_first_init(dep, dcp);
|
---|
318 | dep->de_flags |= DEF_ENABLED;
|
---|
319 | }
|
---|
320 | dep->de_flags &= NOT(DEF_PROMISC | DEF_MULTI | DEF_BROAD);
|
---|
321 | if (mp->DL_MODE & DL_PROMISC_REQ)
|
---|
322 | dep->de_flags |= DEF_PROMISC | DEF_MULTI | DEF_BROAD;
|
---|
323 | if (mp->DL_MODE & DL_MULTI_REQ) dep->de_flags |= DEF_MULTI;
|
---|
324 | if (mp->DL_MODE & DL_BROAD_REQ) dep->de_flags |= DEF_BROAD;
|
---|
325 | (*dep->de_flagsf) (dep);
|
---|
326 | dep->de_client = mp->m_source;
|
---|
327 | break;
|
---|
328 |
|
---|
329 | case DEM_SINK:
|
---|
330 | /* Device not present (sink mode) */
|
---|
331 | memset(dep->de_address.ea_addr, 0, sizeof(ether_addr_t));
|
---|
332 | dp_confaddr(dep); /* Station address from env. */
|
---|
333 | break;
|
---|
334 |
|
---|
335 | default: break;
|
---|
336 | }
|
---|
337 | *(ether_addr_t *) reply_mess.m3_ca1 = dep->de_address;
|
---|
338 |
|
---|
339 | } else /* Port number is out of range */
|
---|
340 | port = ENXIO;
|
---|
341 |
|
---|
342 | reply_mess.m_type = DL_INIT_REPLY;
|
---|
343 | reply_mess.m3_i1 = port;
|
---|
344 | reply_mess.m3_i2 = DE_PORT_NR;
|
---|
345 | DEBUG(printf("\t reply %d\n", reply_mess.m_type));
|
---|
346 | if (send(mp->m_source, &reply_mess) != OK) /* Can't send */
|
---|
347 | panic(dep->de_name, SendErrMsg, mp->m_source);
|
---|
348 |
|
---|
349 | return;
|
---|
350 | }
|
---|
351 |
|
---|
352 | /*
|
---|
353 | ** Name: void dp_next_iovec(iovec_dat_t *iovp)
|
---|
354 | ** Function: Retrieves data from next iovec element.
|
---|
355 | */
|
---|
356 | PUBLIC void dp_next_iovec(iovec_dat_t * iovp)
|
---|
357 | {
|
---|
358 |
|
---|
359 | iovp->iod_iovec_s -= IOVEC_NR;
|
---|
360 | iovp->iod_iovec_addr += IOVEC_NR * sizeof(iovec_t);
|
---|
361 | get_userdata(iovp->iod_proc_nr, iovp->iod_iovec_addr,
|
---|
362 | iovp->iod_iovec_s, iovp->iod_iovec);
|
---|
363 | return;
|
---|
364 | }
|
---|
365 |
|
---|
366 | /*
|
---|
367 | ** Name: int calc_iovec_size(iovec_dat_t *iovp)
|
---|
368 | ** Function: Compute the size of a request.
|
---|
369 | */
|
---|
370 | static int calc_iovec_size(iovec_dat_t * iovp)
|
---|
371 | {
|
---|
372 | int size, ix;
|
---|
373 |
|
---|
374 | size = ix = 0;
|
---|
375 | do {
|
---|
376 | size += iovp->iod_iovec[ix].iov_size;
|
---|
377 | if (++ix >= IOVEC_NR) {
|
---|
378 | dp_next_iovec(iovp);
|
---|
379 | ix = 0;
|
---|
380 | }
|
---|
381 |
|
---|
382 | /* Till all vectors added */
|
---|
383 | } while (ix < iovp->iod_iovec_s);
|
---|
384 | return size;
|
---|
385 | }
|
---|
386 |
|
---|
387 | /*
|
---|
388 | ** Name: void do_vwrite(message *mp, int vectored)
|
---|
389 | ** Function:
|
---|
390 | */
|
---|
391 | static void do_vwrite(message * mp, int vectored)
|
---|
392 | {
|
---|
393 | int port, size;
|
---|
394 | dpeth_t *dep;
|
---|
395 |
|
---|
396 | port = mp->DL_PORT;
|
---|
397 | if (port < 0 || port >= DE_PORT_NR) /* Check for illegal port number */
|
---|
398 | panic(dep->de_name, PortErrMsg, port);
|
---|
399 |
|
---|
400 | dep = &de_table[port];
|
---|
401 | dep->de_client = mp->DL_PROC;
|
---|
402 |
|
---|
403 | if (dep->de_mode == DEM_ENABLED) {
|
---|
404 |
|
---|
405 | if (dep->de_flags & DEF_SENDING) /* Is sending in progress? */
|
---|
406 | panic(dep->de_name, "send already in progress ", NO_NUM);
|
---|
407 |
|
---|
408 | dep->de_write_iovec.iod_proc_nr = mp->DL_PROC;
|
---|
409 | if (vectored) {
|
---|
410 | get_userdata(mp->DL_PROC, (vir_bytes) mp->DL_ADDR,
|
---|
411 | mp->DL_COUNT, dep->de_write_iovec.iod_iovec);
|
---|
412 | dep->de_write_iovec.iod_iovec_s = mp->DL_COUNT;
|
---|
413 | dep->de_write_iovec.iod_iovec_addr = (vir_bytes) mp->DL_ADDR;
|
---|
414 | size = calc_iovec_size(&dep->de_write_iovec);
|
---|
415 | } else {
|
---|
416 | dep->de_write_iovec.iod_iovec[0].iov_addr = (vir_bytes) mp->DL_ADDR;
|
---|
417 | dep->de_write_iovec.iod_iovec[0].iov_size = size = mp->DL_COUNT;
|
---|
418 | dep->de_write_iovec.iod_iovec_s = 1;
|
---|
419 | dep->de_write_iovec.iod_iovec_addr = 0;
|
---|
420 | }
|
---|
421 | if (size < ETH_MIN_PACK_SIZE || size > ETH_MAX_PACK_SIZE)
|
---|
422 | panic(dep->de_name, SizeErrMsg, size);
|
---|
423 |
|
---|
424 | dep->de_flags |= DEF_SENDING;
|
---|
425 | (*dep->de_sendf) (dep, FALSE, size);
|
---|
426 |
|
---|
427 | } else if (dep->de_mode == DEM_SINK)
|
---|
428 | dep->de_flags |= DEF_ACK_SEND;
|
---|
429 |
|
---|
430 | reply(dep, OK);
|
---|
431 | return;
|
---|
432 | }
|
---|
433 |
|
---|
434 | /*
|
---|
435 | ** Name: void do_vread(message *mp, int vectored)
|
---|
436 | ** Function:
|
---|
437 | */
|
---|
438 | static void do_vread(message * mp, int vectored)
|
---|
439 | {
|
---|
440 | int port, size;
|
---|
441 | dpeth_t *dep;
|
---|
442 |
|
---|
443 | port = mp->DL_PORT;
|
---|
444 | if (port < 0 || port >= DE_PORT_NR) /* Check for illegal port number */
|
---|
445 | panic(dep->de_name, PortErrMsg, port);
|
---|
446 |
|
---|
447 | dep = &de_table[port];
|
---|
448 | dep->de_client = mp->DL_PROC;
|
---|
449 |
|
---|
450 | if (dep->de_mode == DEM_ENABLED) {
|
---|
451 |
|
---|
452 | if (dep->de_flags & DEF_READING) /* Reading in progress */
|
---|
453 | panic(dep->de_name, "read already in progress", NO_NUM);
|
---|
454 |
|
---|
455 | dep->de_read_iovec.iod_proc_nr = mp->DL_PROC;
|
---|
456 | if (vectored) {
|
---|
457 | get_userdata(mp->DL_PROC, (vir_bytes) mp->DL_ADDR,
|
---|
458 | mp->DL_COUNT, dep->de_read_iovec.iod_iovec);
|
---|
459 | dep->de_read_iovec.iod_iovec_s = mp->DL_COUNT;
|
---|
460 | dep->de_read_iovec.iod_iovec_addr = (vir_bytes) mp->DL_ADDR;
|
---|
461 | size = calc_iovec_size(&dep->de_read_iovec);
|
---|
462 | } else {
|
---|
463 | dep->de_read_iovec.iod_iovec[0].iov_addr = (vir_bytes) mp->DL_ADDR;
|
---|
464 | dep->de_read_iovec.iod_iovec[0].iov_size = size = mp->DL_COUNT;
|
---|
465 | dep->de_read_iovec.iod_iovec_s = 1;
|
---|
466 | dep->de_read_iovec.iod_iovec_addr = 0;
|
---|
467 | }
|
---|
468 | if (size < ETH_MAX_PACK_SIZE) panic(dep->de_name, SizeErrMsg, size);
|
---|
469 |
|
---|
470 | dep->de_flags |= DEF_READING;
|
---|
471 | (*dep->de_recvf) (dep, FALSE, size);
|
---|
472 | #if 0
|
---|
473 | if ((dep->de_flags & (DEF_READING | DEF_STOPPED)) == (DEF_READING | DEF_STOPPED))
|
---|
474 | /* The chip is stopped, and all arrived packets delivered */
|
---|
475 | (*dep->de_resetf) (dep);
|
---|
476 | dep->de_flags &= NOT(DEF_STOPPED);
|
---|
477 | #endif
|
---|
478 | }
|
---|
479 | reply(dep, OK);
|
---|
480 | return;
|
---|
481 | }
|
---|
482 |
|
---|
483 | /*
|
---|
484 | ** Name: void do_getstat(message *mp)
|
---|
485 | ** Function: Reports device statistics.
|
---|
486 | */
|
---|
487 | static void do_getstat(message * mp)
|
---|
488 | {
|
---|
489 | int port, rc;
|
---|
490 | dpeth_t *dep;
|
---|
491 |
|
---|
492 | port = mp->DL_PORT;
|
---|
493 | if (port < 0 || port >= DE_PORT_NR) /* Check for illegal port number */
|
---|
494 | panic(dep->de_name, PortErrMsg, port);
|
---|
495 |
|
---|
496 | dep = &de_table[port];
|
---|
497 | dep->de_client = mp->DL_PROC;
|
---|
498 |
|
---|
499 | if (dep->de_mode == DEM_ENABLED) (*dep->de_getstatsf) (dep);
|
---|
500 | if ((rc = sys_datacopy(SELF, (vir_bytes)&dep->de_stat,
|
---|
501 | mp->DL_PROC, (vir_bytes)mp->DL_ADDR,
|
---|
502 | (vir_bytes) sizeof(dep->de_stat))) != OK)
|
---|
503 | panic(DevName, CopyErrMsg, rc);
|
---|
504 | reply(dep, OK);
|
---|
505 | return;
|
---|
506 | }
|
---|
507 |
|
---|
508 | static void do_getname(mp)
|
---|
509 | message *mp;
|
---|
510 | {
|
---|
511 | int r;
|
---|
512 |
|
---|
513 | strncpy(mp->DL_NAME, progname, sizeof(mp->DL_NAME));
|
---|
514 | mp->DL_NAME[sizeof(mp->DL_NAME)-1]= '\0';
|
---|
515 | mp->m_type= DL_NAME_REPLY;
|
---|
516 | r= send(mp->m_source, mp);
|
---|
517 | if (r != OK)
|
---|
518 | panic("dpeth", "do_getname: send failed: %d\n", r);
|
---|
519 | }
|
---|
520 |
|
---|
521 | /*
|
---|
522 | ** Name: void do_stop(message *mp)
|
---|
523 | ** Function: Stops network interface.
|
---|
524 | */
|
---|
525 | static void do_stop(message * mp)
|
---|
526 | {
|
---|
527 | int port;
|
---|
528 | dpeth_t *dep;
|
---|
529 |
|
---|
530 | port = mp->DL_PORT;
|
---|
531 | if (port < 0 || port >= DE_PORT_NR) /* Check for illegal port number */
|
---|
532 | panic(dep->de_name, PortErrMsg, port);
|
---|
533 |
|
---|
534 | dep = &de_table[port];
|
---|
535 | if (dep->de_mode == DEM_ENABLED && (dep->de_flags & DEF_ENABLED)) {
|
---|
536 |
|
---|
537 | /* Stop device */
|
---|
538 | (dep->de_stopf) (dep);
|
---|
539 | dep->de_flags = DEF_EMPTY;
|
---|
540 | dep->de_mode = DEM_DISABLED;
|
---|
541 | }
|
---|
542 | return;
|
---|
543 | }
|
---|
544 |
|
---|
545 | static void do_watchdog(void *message)
|
---|
546 | {
|
---|
547 |
|
---|
548 | DEBUG(printf("\t no reply"));
|
---|
549 | return;
|
---|
550 | }
|
---|
551 |
|
---|
552 | /*
|
---|
553 | ** Name: int dpeth_task(void)
|
---|
554 | ** Function: Main entry for dp task
|
---|
555 | */
|
---|
556 | PUBLIC int main(int argc, char **argv)
|
---|
557 | {
|
---|
558 | message m;
|
---|
559 | dpeth_t *dep;
|
---|
560 | int rc, fkeys, sfkeys, tasknr;
|
---|
561 |
|
---|
562 | (progname=strrchr(argv[0],'/')) ? progname++ : (progname=argv[0]);
|
---|
563 |
|
---|
564 | env_setargs(argc, argv);
|
---|
565 |
|
---|
566 | /* Request function key for debug dumps */
|
---|
567 | fkeys = sfkeys = 0; bit_set(sfkeys, 8);
|
---|
568 | if ((fkey_map(&fkeys, &sfkeys)) != OK)
|
---|
569 | printf("%s: couldn't program Shift+F8 key (%d)\n", DevName, errno);
|
---|
570 |
|
---|
571 | #ifdef ETH_IGN_PROTO
|
---|
572 | {
|
---|
573 | static u16_t eth_ign_proto = 0;
|
---|
574 | long val;
|
---|
575 | val = 0xFFFF;
|
---|
576 | env_parse("ETH_IGN_PROTO", "x", 0, &val, 0x0000L, 0xFFFFL);
|
---|
577 | eth_ign_proto = htons((u16_t) val);
|
---|
578 | }
|
---|
579 | #endif
|
---|
580 |
|
---|
581 | /* Try to notify inet that we are present (again) */
|
---|
582 | rc = _pm_findproc("inet", &tasknr);
|
---|
583 | if (rc == OK)
|
---|
584 | notify(tasknr);
|
---|
585 |
|
---|
586 | while (TRUE) {
|
---|
587 | if ((rc = receive(ANY, &m)) != OK) panic(dep->de_name, RecvErrMsg, rc);
|
---|
588 |
|
---|
589 | DEBUG(printf("eth: got message %d, ", m.m_type));
|
---|
590 |
|
---|
591 | switch (m.m_type) {
|
---|
592 | case DEV_PING: /* Status request from RS */
|
---|
593 | notify(m.m_source);
|
---|
594 | continue;
|
---|
595 | case DL_WRITE: /* Write message to device */
|
---|
596 | do_vwrite(&m, FALSE);
|
---|
597 | break;
|
---|
598 | case DL_WRITEV: /* Write message to device */
|
---|
599 | do_vwrite(&m, TRUE);
|
---|
600 | break;
|
---|
601 | case DL_READ: /* Read message from device */
|
---|
602 | do_vread(&m, FALSE);
|
---|
603 | break;
|
---|
604 | case DL_READV: /* Read message from device */
|
---|
605 | do_vread(&m, TRUE);
|
---|
606 | break;
|
---|
607 | case DL_INIT: /* Initialize device */
|
---|
608 | do_init(&m);
|
---|
609 | break;
|
---|
610 | case DL_GETSTAT: /* Get device statistics */
|
---|
611 | do_getstat(&m);
|
---|
612 | break;
|
---|
613 | case DL_GETNAME:
|
---|
614 | do_getname(&m);
|
---|
615 | break;
|
---|
616 | case SYN_ALARM: /* to be defined */
|
---|
617 | do_watchdog(&m);
|
---|
618 | break;
|
---|
619 | case DL_STOP: /* Stop device */
|
---|
620 | do_stop(&m);
|
---|
621 | break;
|
---|
622 | case SYS_SIG: {
|
---|
623 | sigset_t sigset = m.NOTIFY_ARG;
|
---|
624 | if (sigismember(&sigset, SIGKSTOP)) { /* Shut down */
|
---|
625 | for (rc = 0; rc < DE_PORT_NR; rc += 1) {
|
---|
626 | if (de_table[rc].de_mode == DEM_ENABLED) {
|
---|
627 | m.m_type = DL_STOP;
|
---|
628 | m.DL_PORT = rc;
|
---|
629 | do_stop(&m);
|
---|
630 | }
|
---|
631 | }
|
---|
632 | }
|
---|
633 | break;
|
---|
634 | }
|
---|
635 | case HARD_INT: /* Interrupt from device */
|
---|
636 | for (dep = de_table; dep < &de_table[DE_PORT_NR]; dep += 1) {
|
---|
637 | /* If device is enabled and interrupt pending */
|
---|
638 | if (dep->de_mode == DEM_ENABLED) {
|
---|
639 | dep->de_int_pending = TRUE;
|
---|
640 | (*dep->de_interruptf) (dep);
|
---|
641 | if (dep->de_flags & (DEF_ACK_SEND | DEF_ACK_RECV))
|
---|
642 | reply(dep, !OK);
|
---|
643 | dep->de_int_pending = FALSE;
|
---|
644 | sys_irqenable(&dep->de_hook);
|
---|
645 | }
|
---|
646 | }
|
---|
647 | break;
|
---|
648 | case FKEY_PRESSED: /* Function key pressed */
|
---|
649 | do_dump(&m);
|
---|
650 | break;
|
---|
651 | case PROC_EVENT:
|
---|
652 | break;
|
---|
653 | default: /* Invalid message type */
|
---|
654 | panic(DevName, TypeErrMsg, m.m_type);
|
---|
655 | break;
|
---|
656 | }
|
---|
657 | }
|
---|
658 | return OK; /* Never reached, but keeps compiler happy */
|
---|
659 | }
|
---|
660 |
|
---|
661 | /** dp.c **/
|
---|