efinet.c revision 1.2.2.3
1 1.2.2.3 kardel /* $NetBSD: efinet.c,v 1.2.2.3 2006/06/01 22:34:54 kardel Exp $ */ 2 1.2.2.2 simonb 3 1.2.2.2 simonb /*- 4 1.2.2.2 simonb * Copyright (c) 2001 Doug Rabson 5 1.2.2.2 simonb * All rights reserved. 6 1.2.2.2 simonb * 7 1.2.2.2 simonb * Redistribution and use in source and binary forms, with or without 8 1.2.2.2 simonb * modification, are permitted provided that the following conditions 9 1.2.2.2 simonb * are met: 10 1.2.2.2 simonb * 1. Redistributions of source code must retain the above copyright 11 1.2.2.2 simonb * notice, this list of conditions and the following disclaimer. 12 1.2.2.2 simonb * 2. Redistributions in binary form must reproduce the above copyright 13 1.2.2.2 simonb * notice, this list of conditions and the following disclaimer in the 14 1.2.2.2 simonb * documentation and/or other materials provided with the distribution. 15 1.2.2.2 simonb * 16 1.2.2.2 simonb * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17 1.2.2.2 simonb * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18 1.2.2.2 simonb * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19 1.2.2.2 simonb * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20 1.2.2.2 simonb * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21 1.2.2.2 simonb * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22 1.2.2.2 simonb * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23 1.2.2.2 simonb * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24 1.2.2.2 simonb * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25 1.2.2.2 simonb * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26 1.2.2.2 simonb * SUCH DAMAGE. 27 1.2.2.2 simonb */ 28 1.2.2.2 simonb 29 1.2.2.2 simonb #include <sys/cdefs.h> 30 1.2.2.3 kardel /* __FBSDID("$FreeBSD: src/sys/boot/efi/libefi/efinet.c,v 1.6 2004/01/04 23:28:16 obrien Exp $"); */ 31 1.2.2.2 simonb 32 1.2.2.2 simonb #include <sys/param.h> 33 1.2.2.2 simonb #include <netinet/in.h> 34 1.2.2.2 simonb #include <netinet/in_systm.h> 35 1.2.2.2 simonb 36 1.2.2.2 simonb #include <lib/libsa/stand.h> 37 1.2.2.2 simonb #include <net.h> 38 1.2.2.2 simonb #include <netif.h> 39 1.2.2.2 simonb 40 1.2.2.2 simonb #include <efi.h> 41 1.2.2.2 simonb #include <efilib.h> 42 1.2.2.2 simonb 43 1.2.2.2 simonb extern struct netif_driver efi_net; 44 1.2.2.2 simonb 45 1.2.2.2 simonb #ifdef EFINET_DEBUG 46 1.2.2.2 simonb static void 47 1.2.2.2 simonb dump_mode(EFI_SIMPLE_NETWORK_MODE *mode) 48 1.2.2.2 simonb { 49 1.2.2.2 simonb int i; 50 1.2.2.2 simonb 51 1.2.2.2 simonb printf("State = %x\n", mode->State); 52 1.2.2.2 simonb printf("HwAddressSize = %u\n", mode->HwAddressSize); 53 1.2.2.2 simonb printf("MediaHeaderSize = %u\n", mode->MediaHeaderSize); 54 1.2.2.2 simonb printf("MaxPacketSize = %u\n", mode->MaxPacketSize); 55 1.2.2.2 simonb printf("NvRamSize = %u\n", mode->NvRamSize); 56 1.2.2.2 simonb printf("NvRamAccessSize = %u\n", mode->NvRamAccessSize); 57 1.2.2.2 simonb printf("ReceiveFilterMask = %x\n", mode->ReceiveFilterMask); 58 1.2.2.2 simonb printf("ReceiveFilterSetting = %u\n", mode->ReceiveFilterSetting); 59 1.2.2.2 simonb printf("MaxMCastFilterCount = %u\n", mode->MaxMCastFilterCount); 60 1.2.2.2 simonb printf("MCastFilterCount = %u\n", mode->MCastFilterCount); 61 1.2.2.2 simonb printf("MCastFilter = {"); 62 1.2.2.2 simonb for (i = 0; i < mode->MCastFilterCount; i++) 63 1.2.2.2 simonb printf(" %s", ether_sprintf(mode->MCastFilter[i].Addr)); 64 1.2.2.2 simonb printf(" }\n"); 65 1.2.2.2 simonb printf("CurrentAddress = %s\n", 66 1.2.2.2 simonb ether_sprintf(mode->CurrentAddress.Addr)); 67 1.2.2.2 simonb printf("BroadcastAddress = %s\n", 68 1.2.2.2 simonb ether_sprintf(mode->BroadcastAddress.Addr)); 69 1.2.2.2 simonb printf("PermanentAddress = %s\n", 70 1.2.2.2 simonb ether_sprintf(mode->PermanentAddress.Addr)); 71 1.2.2.2 simonb printf("IfType = %u\n", mode->IfType); 72 1.2.2.2 simonb printf("MacAddressChangeable = %d\n", mode->MacAddressChangeable); 73 1.2.2.2 simonb printf("MultipleTxSupported = %d\n", mode->MultipleTxSupported); 74 1.2.2.2 simonb printf("MediaPresentSupported = %d\n", mode->MediaPresentSupported); 75 1.2.2.2 simonb printf("MediaPresent = %d\n", mode->MediaPresent); 76 1.2.2.2 simonb } 77 1.2.2.2 simonb #endif 78 1.2.2.2 simonb 79 1.2.2.2 simonb int 80 1.2.2.2 simonb efinet_match(struct netif *nif, void *machdep_hint) 81 1.2.2.2 simonb { 82 1.2.2.2 simonb 83 1.2.2.2 simonb return (1); 84 1.2.2.2 simonb } 85 1.2.2.2 simonb 86 1.2.2.2 simonb int 87 1.2.2.2 simonb efinet_probe(struct netif *nif, void *machdep_hint) 88 1.2.2.2 simonb { 89 1.2.2.2 simonb 90 1.2.2.2 simonb return (0); 91 1.2.2.2 simonb } 92 1.2.2.2 simonb 93 1.2.2.2 simonb int 94 1.2.2.2 simonb efinet_put(struct iodesc *desc, void *pkt, size_t len) 95 1.2.2.2 simonb { 96 1.2.2.2 simonb struct netif *nif = desc->io_netif; 97 1.2.2.2 simonb EFI_SIMPLE_NETWORK *net; 98 1.2.2.2 simonb EFI_STATUS status; 99 1.2.2.2 simonb void *buf; 100 1.2.2.2 simonb 101 1.2.2.2 simonb net = nif->nif_devdata; 102 1.2.2.2 simonb 103 1.2.2.2 simonb status = net->Transmit(net, 0, len, pkt, 0, 0, 0); 104 1.2.2.2 simonb if (status != EFI_SUCCESS) 105 1.2.2.2 simonb return -1; 106 1.2.2.2 simonb 107 1.2.2.2 simonb /* Wait for the buffer to be transmitted */ 108 1.2.2.2 simonb do { 109 1.2.2.2 simonb buf = 0; /* XXX Is this needed? */ 110 1.2.2.2 simonb status = net->GetStatus(net, 0, &buf); 111 1.2.2.2 simonb /* 112 1.2.2.2 simonb * XXX EFI1.1 and the E1000 card returns a different 113 1.2.2.2 simonb * address than we gave. Sigh. 114 1.2.2.2 simonb */ 115 1.2.2.2 simonb } while (status == EFI_SUCCESS && buf == 0); 116 1.2.2.2 simonb 117 1.2.2.2 simonb /* XXX How do we deal with status != EFI_SUCCESS now? */ 118 1.2.2.2 simonb return (status == EFI_SUCCESS) ? len : -1; 119 1.2.2.2 simonb } 120 1.2.2.2 simonb 121 1.2.2.2 simonb 122 1.2.2.2 simonb int 123 1.2.2.2 simonb efinet_get(struct iodesc *desc, void *pkt, size_t len, time_t timeout) 124 1.2.2.2 simonb { 125 1.2.2.2 simonb struct netif *nif = desc->io_netif; 126 1.2.2.2 simonb EFI_SIMPLE_NETWORK *net; 127 1.2.2.2 simonb EFI_STATUS status; 128 1.2.2.2 simonb UINTN bufsz; 129 1.2.2.2 simonb time_t t; 130 1.2.2.2 simonb char buf[2048]; 131 1.2.2.2 simonb 132 1.2.2.2 simonb net = nif->nif_devdata; 133 1.2.2.2 simonb 134 1.2.2.2 simonb t = time(0); 135 1.2.2.2 simonb while ((time(0) - t) < timeout) { 136 1.2.2.2 simonb bufsz = sizeof(buf); 137 1.2.2.2 simonb status = net->Receive(net, 0, &bufsz, buf, 0, 0, 0); 138 1.2.2.2 simonb if (status == EFI_SUCCESS) { 139 1.2.2.2 simonb /* 140 1.2.2.2 simonb * XXX EFI1.1 and the E1000 card trash our 141 1.2.2.2 simonb * workspace if we do not do this silly copy. 142 1.2.2.2 simonb * Either they are not respecting the len 143 1.2.2.2 simonb * value or do not like the alignment. 144 1.2.2.2 simonb */ 145 1.2.2.2 simonb if (bufsz > len) 146 1.2.2.2 simonb bufsz = len; 147 1.2.2.2 simonb bcopy(buf, pkt, bufsz); 148 1.2.2.2 simonb return bufsz; 149 1.2.2.2 simonb } 150 1.2.2.2 simonb if (status != EFI_NOT_READY) 151 1.2.2.2 simonb return 0; 152 1.2.2.2 simonb } 153 1.2.2.2 simonb 154 1.2.2.2 simonb return 0; 155 1.2.2.2 simonb } 156 1.2.2.2 simonb 157 1.2.2.2 simonb void 158 1.2.2.2 simonb efinet_init(struct iodesc *desc, void *machdep_hint) 159 1.2.2.2 simonb { 160 1.2.2.2 simonb struct netif *nif = desc->io_netif; 161 1.2.2.2 simonb EFI_SIMPLE_NETWORK *net; 162 1.2.2.2 simonb EFI_STATUS status; 163 1.2.2.2 simonb 164 1.2.2.2 simonb net = nif->nif_driver->netif_ifs[nif->nif_unit].dif_private; 165 1.2.2.2 simonb nif->nif_devdata = net; 166 1.2.2.2 simonb 167 1.2.2.2 simonb if (net->Mode->State == EfiSimpleNetworkStopped) { 168 1.2.2.2 simonb status = net->Start(net); 169 1.2.2.2 simonb if (status != EFI_SUCCESS) { 170 1.2.2.2 simonb printf("net%d: cannot start interface (status=%ld)\n", 171 1.2.2.2 simonb nif->nif_unit, status); 172 1.2.2.2 simonb return; 173 1.2.2.2 simonb } 174 1.2.2.2 simonb } 175 1.2.2.2 simonb 176 1.2.2.2 simonb if (net->Mode->State != EfiSimpleNetworkInitialized) { 177 1.2.2.2 simonb status = net->Initialize(net, 0, 0); 178 1.2.2.2 simonb if (status != EFI_SUCCESS) { 179 1.2.2.2 simonb printf("net%d: cannot init. interface (status=%ld)\n", 180 1.2.2.2 simonb nif->nif_unit, status); 181 1.2.2.2 simonb return; 182 1.2.2.2 simonb } 183 1.2.2.2 simonb } 184 1.2.2.2 simonb 185 1.2.2.2 simonb if (net->Mode->ReceiveFilterSetting == 0) { 186 1.2.2.2 simonb UINT32 mask = EFI_SIMPLE_NETWORK_RECEIVE_UNICAST | 187 1.2.2.2 simonb EFI_SIMPLE_NETWORK_RECEIVE_BROADCAST; 188 1.2.2.2 simonb 189 1.2.2.2 simonb status = net->ReceiveFilters(net, mask, 0, FALSE, 0, 0); 190 1.2.2.2 simonb if (status != EFI_SUCCESS) { 191 1.2.2.2 simonb printf("net%d: cannot set rx. filters (status=%ld)\n", 192 1.2.2.2 simonb nif->nif_unit, status); 193 1.2.2.2 simonb return; 194 1.2.2.2 simonb } 195 1.2.2.2 simonb } 196 1.2.2.2 simonb 197 1.2.2.2 simonb #ifdef EFINET_DEBUG 198 1.2.2.2 simonb dump_mode(net->Mode); 199 1.2.2.2 simonb #endif 200 1.2.2.2 simonb 201 1.2.2.2 simonb bcopy(net->Mode->CurrentAddress.Addr, desc->myea, 6); 202 1.2.2.2 simonb desc->xid = 1; 203 1.2.2.2 simonb 204 1.2.2.2 simonb return; 205 1.2.2.2 simonb } 206 1.2.2.2 simonb 207 1.2.2.2 simonb void 208 1.2.2.2 simonb efinet_init_driver() 209 1.2.2.2 simonb { 210 1.2.2.2 simonb EFI_STATUS status; 211 1.2.2.2 simonb UINTN sz; 212 1.2.2.2 simonb static EFI_GUID netid = EFI_SIMPLE_NETWORK_PROTOCOL; 213 1.2.2.2 simonb EFI_HANDLE *handles; 214 1.2.2.2 simonb int nifs, i; 215 1.2.2.2 simonb #define MAX_INTERFACES 4 216 1.2.2.2 simonb static struct netif_dif difs[MAX_INTERFACES]; 217 1.2.2.2 simonb static struct netif_stats stats[MAX_INTERFACES]; 218 1.2.2.2 simonb 219 1.2.2.2 simonb sz = 0; 220 1.2.2.2 simonb status = BS->LocateHandle(ByProtocol, &netid, 0, &sz, 0); 221 1.2.2.2 simonb if (status != EFI_BUFFER_TOO_SMALL) 222 1.2.2.2 simonb return; 223 1.2.2.2 simonb handles = (EFI_HANDLE *) alloc(sz); 224 1.2.2.2 simonb status = BS->LocateHandle(ByProtocol, &netid, 0, &sz, handles); 225 1.2.2.2 simonb if (EFI_ERROR(status)) { 226 1.2.2.2 simonb free(handles, sz); 227 1.2.2.2 simonb return; 228 1.2.2.2 simonb } 229 1.2.2.2 simonb 230 1.2.2.2 simonb nifs = sz / sizeof(EFI_HANDLE); 231 1.2.2.2 simonb if (nifs > MAX_INTERFACES) 232 1.2.2.2 simonb nifs = MAX_INTERFACES; 233 1.2.2.2 simonb 234 1.2.2.2 simonb efi_net.netif_nifs = nifs; 235 1.2.2.2 simonb efi_net.netif_ifs = difs; 236 1.2.2.2 simonb 237 1.2.2.2 simonb bzero(stats, sizeof(stats)); 238 1.2.2.2 simonb for (i = 0; i < nifs; i++) { 239 1.2.2.2 simonb struct netif_dif *dif = &efi_net.netif_ifs[i]; 240 1.2.2.2 simonb dif->dif_unit = i; 241 1.2.2.2 simonb dif->dif_nsel = 1; 242 1.2.2.2 simonb dif->dif_stats = &stats[i]; 243 1.2.2.2 simonb 244 1.2.2.2 simonb BS->HandleProtocol(handles[i], &netid, 245 1.2.2.2 simonb (VOID**) &dif->dif_private); 246 1.2.2.2 simonb } 247 1.2.2.2 simonb 248 1.2.2.2 simonb return; 249 1.2.2.2 simonb } 250 1.2.2.2 simonb 251 1.2.2.2 simonb void 252 1.2.2.2 simonb efinet_end(struct netif *nif) 253 1.2.2.2 simonb { 254 1.2.2.2 simonb EFI_SIMPLE_NETWORK *net = nif->nif_devdata; 255 1.2.2.2 simonb 256 1.2.2.2 simonb net->Shutdown(net); 257 1.2.2.2 simonb } 258 1.2.2.2 simonb 259 1.2.2.2 simonb struct netif_driver efi_net = { 260 1.2.2.2 simonb "net", /* netif_bname */ 261 1.2.2.2 simonb efinet_match, /* netif_match */ 262 1.2.2.2 simonb efinet_probe, /* netif_probe */ 263 1.2.2.2 simonb efinet_init, /* netif_init */ 264 1.2.2.2 simonb efinet_get, /* netif_get */ 265 1.2.2.2 simonb efinet_put, /* netif_put */ 266 1.2.2.2 simonb efinet_end, /* netif_end */ 267 1.2.2.2 simonb 0, /* netif_ifs */ 268 1.2.2.2 simonb 0 /* netif_nifs */ 269 1.2.2.2 simonb }; 270 1.2.2.2 simonb 271
Indexes created Thu Oct 02 10:09:58 GMT 2025