| 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 **/ | 
|---|