Merge from vendor branch OPENSSL:
[dragonfly.git] / sys / dev / netif / nv / if_nv.c
1 /*
2  * Copyright (c) 2003 by Quinton Dolan <q@onthenet.com.au>. 
3  * All rights reserved.
4  * 
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions 
7  * are met: 
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer. 
10  * 2. Redistributions in binary form must reproduce the above copyright 
11  *    notice, this list of conditions and the following disclaimer in the 
12  *    documentation and/or other materials provided with the distribution.
13  * 
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND ANY
15  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
16  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
17  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
18  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
20  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
21  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  * 
26  * $Id: if_nv.c,v 1.9 2003/12/13 15:27:40 q Exp $
27  * $DragonFly: src/sys/dev/netif/nv/Attic/if_nv.c,v 1.1 2004/08/28 15:08:02 joerg Exp $
28  */
29
30 /*
31  * NVIDIA nForce MCP Networking Adapter driver
32  * 
33  * This is a port of the NVIDIA MCP Linux ethernet driver distributed by NVIDIA
34  * through their web site.
35  * 
36  * All mainstream nForce and nForce2 motherboards are supported. This module
37  * is as stable, sometimes more stable, than the linux version. (This seems to 
38  * be related to some issues with newer distributions using GCC 3.2, however 
39  * this don't appear to effect FreeBSD 5.x).
40  * 
41  * In accordance with the NVIDIA distribution license it is necessary to link
42  * this module against the nvlibnet.o binary object included in the Linux
43  * driver source distribution. The binary component is not modified in any
44  * way and is simply linked against a FreeBSD equivalent of the nvnet.c linux
45  * kernel module "wrapper".
46  * 
47  * The Linux driver uses a common code API that is shared between Win32 and
48  * Linux. This abstracts the low level driver functions and uses callbacks
49  * and hooks to access the underlying hardware device. By using this same API
50  * in a FreeBSD kernel module it is possible to support the hardware without
51  * breaching the Linux source distributions licensing requirements, or
52  * obtaining the hardware programming specifications.
53  * 
54  * Although not conventional, it works, and given the relatively small amount of
55  * hardware centric code, it's hopefully no more buggy than its linux
56  * counterpart.
57  *
58  * Written by Quinton Dolan <q@onthenet.com.au> 
59  * Portions based on existing FreeBSD network drivers. 
60  * NVIDIA API usage derived from distributed NVIDIA NVNET driver source files.
61  * 
62  * $Id: if_nv.c,v 1.9 2003/12/13 15:27:40 q Exp $
63  */
64
65 #include <sys/param.h>
66 #include <sys/systm.h>
67 #include <sys/sockio.h>
68 #include <sys/mbuf.h>
69 #include <sys/malloc.h>
70 #include <sys/kernel.h>
71 #include <sys/socket.h>
72 #include <sys/sysctl.h>
73 #include <sys/queue.h>
74 #include <sys/module.h>
75
76 #include <net/if.h>
77 #include <net/if_arp.h>
78 #include <net/ethernet.h>
79 #include <net/if_dl.h>
80 #include <net/if_media.h>
81
82 #include <net/bpf.h>
83
84 #include <net/vlan/if_vlan_var.h>
85
86 #include <machine/bus_memio.h>
87 #include <machine/bus.h>
88 #include <machine/resource.h>
89
90 #include <vm/vm.h>              /* for vtophys */
91 #include <vm/pmap.h>            /* for vtophys */
92 #include <machine/clock.h>      /* for DELAY */
93 #include <sys/bus.h>
94 #include <sys/rman.h>
95
96 #include <bus/pci/pcireg.h>
97 #include <bus/pci/pcivar.h>
98
99 #include <dev/netif/mii_layer/mii.h>
100 #include <dev/netif/mii_layer/miivar.h>
101
102 MODULE_DEPEND(nv, pci, 1, 1, 1);
103 MODULE_DEPEND(nv, ether, 1, 1, 1);
104 MODULE_DEPEND(nv, miibus, 1, 1, 1);
105
106 #include "if_nvreg.h"
107 #include "miibus_if.h"
108
109 static int      nv_probe(device_t);
110 static int      nv_attach(device_t);
111 static int      nv_detach(device_t);
112 static void     nv_init(void *);
113 static void     nv_stop(struct nv_softc *);
114 static void     nv_shutdown(device_t);
115 static int      nv_init_rings(struct nv_softc *);
116 static void     nv_free_rings(struct nv_softc *);
117
118 static void     nv_ifstart(struct ifnet *);
119 static int      nv_ioctl(struct ifnet *, u_long, caddr_t, struct ucred *);
120 static void     nv_intr(void *);
121 static void     nv_tick(void *);
122 static void     nv_setmulti(struct nv_softc *);
123 static void     nv_watchdog(struct ifnet *);
124 static void     nv_update_stats(struct nv_softc *);
125
126 static int      nv_ifmedia_upd(struct ifnet *);
127 static void     nv_ifmedia_sts(struct ifnet *, struct ifmediareq *);
128 static int      nv_miibus_readreg(device_t, int, int);
129 static void     nv_miibus_writereg(device_t, int, int, int);
130
131 static void     nv_dmamap_cb(void *, bus_dma_segment_t *, int, int);
132 static void     nv_dmamap_tx_cb(void *, bus_dma_segment_t *, int, bus_size_t, int);
133
134 static int      nv_osalloc(void *, MEMORY_BLOCK *);
135 static int      nv_osfree(void *, MEMORY_BLOCK *);
136 static int      nv_osallocex(void *, MEMORY_BLOCKEX *);
137 static int      nv_osfreeex(void *, MEMORY_BLOCKEX *);
138 static int      nv_osclear(void *, void *, int);
139 static int      nv_osdelay(void *, unsigned long);
140 static int      nv_osallocrxbuf(void *, MEMORY_BLOCK *, void **);
141 static int      nv_osfreerxbuf(void *, MEMORY_BLOCK *, void *);
142 static int      nv_ospackettx(void *, void *, unsigned long);
143 static int      nv_ospacketrx(void *, void *, unsigned long, unsigned char *, unsigned char);
144 static int      nv_oslinkchg(void *, int);
145 static int      nv_osalloctimer(void *, void **);
146 static int      nv_osfreetimer(void *, void *);
147 static int      nv_osinittimer(void *, void *, PTIMER_FUNC, void *);
148 static int      nv_ossettimer(void *, void *, unsigned long);
149 static int      nv_oscanceltimer(void *, void *);
150 static int      nv_ospreprocpkt(void *, void *, void **, unsigned char *, unsigned char);
151 static void    *nv_ospreprocpktnopq(void *, void *);
152 static int      nv_osindicatepkt(void *, void **, unsigned long);
153 static int      nv_oslockalloc(void *, int, void **);
154 static int      nv_oslockacquire(void *, int, void *);
155 static int      nv_oslockrelease(void *, int, void *);
156 static void    *nv_osreturnbufvirt(void *, void *);
157
158 static device_method_t nv_methods[] = {
159         /* Device interface */
160         DEVMETHOD(device_probe, nv_probe),
161         DEVMETHOD(device_attach, nv_attach),
162         DEVMETHOD(device_detach, nv_detach),
163         DEVMETHOD(device_shutdown, nv_shutdown),
164
165         /* Bus interface */
166         DEVMETHOD(bus_print_child, bus_generic_print_child),
167         DEVMETHOD(bus_driver_added, bus_generic_driver_added),
168
169         /* MII interface */
170         DEVMETHOD(miibus_readreg, nv_miibus_readreg),
171         DEVMETHOD(miibus_writereg, nv_miibus_writereg),
172
173         {0, 0}
174 };
175
176 static driver_t nv_driver = {
177         "nv",
178         nv_methods,
179         sizeof(struct nv_softc)
180 };
181
182 static devclass_t nv_devclass;
183
184 static int      nv_pollinterval = 0;
185 SYSCTL_INT(_hw, OID_AUTO, nv_pollinterval, CTLFLAG_RW,
186            &nv_pollinterval, 0, "delay between interface polls");
187
188 DRIVER_MODULE(nv, pci, nv_driver, nv_devclass, 0, 0);
189 DRIVER_MODULE(miibus, nv, miibus_driver, miibus_devclass, 0, 0);
190
191 static struct nv_type nv_devs[] = {
192         {NVIDIA_VENDORID, NFORCE_MCPNET1_DEVICEID,
193         "NVIDIA nForce MCP Networking Adapter"},
194         {NVIDIA_VENDORID, NFORCE_MCPNET2_DEVICEID,
195         "NVIDIA nForce MCP2 Networking Adapter"},
196         {NVIDIA_VENDORID, NFORCE_MCPNET3_DEVICEID,
197         "NVIDIA nForce MCP3 Networking Adapter"},
198         {0, 0, NULL}
199 };
200
201 /* DMA MEM map callback function to get data segment physical address */
202 static void
203 nv_dmamap_cb(void *arg, bus_dma_segment_t * segs, int nsegs, int error)
204 {
205         if (error)
206                 return;
207
208         KASSERT(nsegs == 1,
209                 ("Too many DMA segments returned when mapping DMA memory"));
210         *(bus_addr_t *)arg = segs->ds_addr;
211 }
212
213 /* DMA RX map callback function to get data segment physical address */
214 static void
215 nv_dmamap_rx_cb(void *arg, bus_dma_segment_t * segs, int nsegs, bus_size_t mapsize, int error)
216 {
217         if (error)
218                 return;
219         *(bus_addr_t *)arg = segs->ds_addr;
220 }
221
222 /*
223  * DMA TX buffer callback function to allocate fragment data segment
224  * addresses
225  */
226 static void
227 nv_dmamap_tx_cb(void *arg, bus_dma_segment_t * segs, int nsegs, bus_size_t mapsize, int error)
228 {
229         struct nv_tx_desc *info = arg;
230
231         if (error)
232                 return;
233         KASSERT(nsegs < NV_MAX_FRAGS,
234                 ("Too many DMA segments returned when mapping mbuf"));
235         info->numfrags = nsegs;
236         bcopy(segs, info->frags, nsegs * sizeof(bus_dma_segment_t));
237 }
238
239 /* Probe for supported hardware ID's */
240 static int
241 nv_probe(device_t dev)
242 {
243         struct nv_type *t = nv_devs;
244
245         /* Check for matching PCI DEVICE ID's */
246         while (t->name != NULL) {
247                 if ((pci_get_vendor(dev) == t->vid_id) &&
248                     (pci_get_device(dev) == t->dev_id)) {
249                         device_set_desc(dev, t->name);
250                         return (0);
251                 }
252                 t++;
253         }
254
255         return (ENXIO);
256 }
257
258 /* Attach driver and initialise hardware for use */
259 static int
260 nv_attach(device_t dev)
261 {
262         u_char          eaddr[ETHER_ADDR_LEN];
263         struct nv_softc *sc;
264         struct ifnet   *ifp;
265         OS_API         *osapi;
266         ADAPTER_OPEN_PARAMS OpenParams;
267         int             error = 0, i, rid, unit;
268
269         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_attach - entry\n");
270
271         sc = device_get_softc(dev);
272         unit = device_get_unit(dev);
273
274         sc->dev = dev;
275         sc->unit = unit;
276
277         /* Preinitialize data structures */
278         bzero(&OpenParams, sizeof(ADAPTER_OPEN_PARAMS));
279
280         /* Enable bus mastering */
281         pci_enable_busmaster(dev);
282
283         /* Allocate memory mapped address space */
284         rid = NV_RID;
285         sc->res = bus_alloc_resource(dev, SYS_RES_MEMORY, &rid,
286                                      0, ~0, 1, RF_ACTIVE);
287
288         if (sc->res == NULL) {
289                 device_printf(dev, "couldn't map memory\n");
290                 error = ENXIO;
291                 goto fail;
292         }
293         sc->sc_st = rman_get_bustag(sc->res);
294         sc->sc_sh = rman_get_bushandle(sc->res);
295
296         /* Allocate interrupt */
297         rid = 0;
298         sc->irq = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1,
299                                      RF_SHAREABLE | RF_ACTIVE);
300
301         if (sc->irq == NULL) {
302                 device_printf(dev, "couldn't map interrupt\n");
303                 error = ENXIO;
304                 goto fail;
305         }
306         /* Allocate DMA tags */
307         error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
308                      BUS_SPACE_MAXADDR, NULL, NULL, MCLBYTES * NV_MAX_FRAGS,
309                                    NV_MAX_FRAGS, MCLBYTES, 0,
310                                    &sc->mtag);
311         if (error) {
312                 device_printf(dev, "couldn't allocate dma tag\n");
313                 goto fail;
314         }
315         error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
316                                    BUS_SPACE_MAXADDR, NULL, NULL,
317                                 sizeof(struct nv_rx_desc) * RX_RING_SIZE, 1,
318                                 sizeof(struct nv_rx_desc) * RX_RING_SIZE, 0,
319                                    &sc->rtag);
320         if (error) {
321                 device_printf(dev, "couldn't allocate dma tag\n");
322                 goto fail;
323         }
324         error = bus_dma_tag_create(NULL, 4, 0, BUS_SPACE_MAXADDR_32BIT,
325                                    BUS_SPACE_MAXADDR, NULL, NULL,
326                                 sizeof(struct nv_tx_desc) * TX_RING_SIZE, 1,
327                                 sizeof(struct nv_tx_desc) * TX_RING_SIZE, 0,
328                                    &sc->ttag);
329         if (error) {
330                 device_printf(dev, "couldn't allocate dma tag\n");
331                 goto fail;
332         }
333         /* Allocate DMA safe memory and get the DMA addresses. */
334         error = bus_dmamem_alloc(sc->ttag, (void **)&sc->tx_desc,
335                                  BUS_DMA_NOWAIT, &sc->tmap);
336         if (error) {
337                 device_printf(dev, "couldn't allocate dma memory\n");
338                 goto fail;
339         }
340         bzero(sc->tx_desc, sizeof(struct nv_tx_desc) * TX_RING_SIZE);
341         error = bus_dmamap_load(sc->ttag, sc->tmap, sc->tx_desc,
342                      sizeof(struct nv_tx_desc) * TX_RING_SIZE, nv_dmamap_cb,
343                                 &sc->tx_addr, 0);
344         if (error) {
345                 device_printf(dev, "couldn't map dma memory\n");
346                 goto fail;
347         }
348         error = bus_dmamem_alloc(sc->rtag, (void **)&sc->rx_desc,
349                                  BUS_DMA_NOWAIT, &sc->rmap);
350         if (error) {
351                 device_printf(dev, "couldn't allocate dma memory\n");
352                 goto fail;
353         }
354         bzero(sc->rx_desc, sizeof(struct nv_rx_desc) * RX_RING_SIZE);
355         error = bus_dmamap_load(sc->rtag, sc->rmap, sc->rx_desc,
356                      sizeof(struct nv_rx_desc) * RX_RING_SIZE, nv_dmamap_cb,
357                                 &sc->rx_addr, 0);
358         if (error) {
359                 device_printf(dev, "couldn't map dma memory\n");
360                 goto fail;
361         }
362         /* Initialize rings. */
363         if (nv_init_rings(sc)) {
364                 device_printf(dev, "failed to init rings\n");
365                 error = ENXIO;
366                 goto fail;
367         }
368         /* Setup NVIDIA API callback routines */
369         osapi = &sc->osapi;
370         osapi->pOSCX = sc;
371         osapi->pfnAllocMemory = nv_osalloc;
372         osapi->pfnFreeMemory = nv_osfree;
373         osapi->pfnAllocMemoryEx = nv_osallocex;
374         osapi->pfnFreeMemoryEx = nv_osfreeex;
375         osapi->pfnClearMemory = nv_osclear;
376         osapi->pfnStallExecution = nv_osdelay;
377         osapi->pfnAllocReceiveBuffer = nv_osallocrxbuf;
378         osapi->pfnFreeReceiveBuffer = nv_osfreerxbuf;
379         osapi->pfnPacketWasSent = nv_ospackettx;
380         osapi->pfnPacketWasReceived = nv_ospacketrx;
381         osapi->pfnLinkStateHasChanged = nv_oslinkchg;
382         osapi->pfnAllocTimer = nv_osalloctimer;
383         osapi->pfnFreeTimer = nv_osfreetimer;
384         osapi->pfnInitializeTimer = nv_osinittimer;
385         osapi->pfnSetTimer = nv_ossettimer;
386         osapi->pfnCancelTimer = nv_oscanceltimer;
387         osapi->pfnPreprocessPacket = nv_ospreprocpkt;
388         osapi->pfnPreprocessPacketNopq = nv_ospreprocpktnopq;
389         osapi->pfnIndicatePackets = nv_osindicatepkt;
390         osapi->pfnLockAlloc = nv_oslockalloc;
391         osapi->pfnLockAcquire = nv_oslockacquire;
392         osapi->pfnLockRelease = nv_oslockrelease;
393         osapi->pfnReturnBufferVirtual = nv_osreturnbufvirt;
394
395         /* Set NVIDIA API startup parameters */
396         OpenParams.MaxDpcLoop = 2;
397         OpenParams.MaxRxPkt = RX_RING_SIZE;
398         OpenParams.MaxTxPkt = TX_RING_SIZE;
399         OpenParams.SentPacketStatusSuccess = 1;
400         OpenParams.SentPacketStatusFailure = 0;
401         OpenParams.MaxRxPktToAccumulate = 6;
402         OpenParams.ulPollInterval = nv_pollinterval;
403         OpenParams.SetForcedModeEveryNthRxPacket = 0;
404         OpenParams.SetForcedModeEveryNthTxPacket = 0;
405         OpenParams.RxForcedInterrupt = 0;
406         OpenParams.TxForcedInterrupt = 0;
407         OpenParams.pOSApi = osapi;
408         OpenParams.pvHardwareBaseAddress = rman_get_virtual(sc->res);
409         sc->linkup = 0;
410
411         /* Open NVIDIA Hardware API */
412         error = ADAPTER_Open(&OpenParams, (void **)&(sc->hwapi), &sc->phyaddr);
413         if (error) {
414                 device_printf(dev, "failed to open NVIDIA Hardware API: 0x%x\n", error);
415                 goto fail;
416         }
417         /* MAC is loaded backwards into h/w reg */
418         sc->hwapi->pfnGetNodeAddress(sc->hwapi->pADCX, sc->original_mac_addr);
419         for (i = 0; i < 6; i++) {
420                 eaddr[i] = sc->original_mac_addr[5 - i];
421         }
422         sc->hwapi->pfnSetNodeAddress(sc->hwapi->pADCX, eaddr);
423         bcopy(eaddr, (char *)&sc->sc_macaddr, ETHER_ADDR_LEN);
424
425         /* Display ethernet address ,... */
426         device_printf(dev, "Ethernet address %6D\n", sc->sc_macaddr, ":");
427
428         DEBUGOUT(NV_DEBUG_INIT, "nv: do mii_phy_probe\n");
429
430         /* Probe device for MII interface to PHY */
431         if (mii_phy_probe(dev, &sc->miibus,
432                           nv_ifmedia_upd, nv_ifmedia_sts)) {
433                 device_printf(dev, "MII without any phy!\n");
434                 error = ENXIO;
435                 goto fail;
436         }
437         /* Setup interface parameters */
438         ifp = &sc->sc_if;
439         ifp->if_softc = sc;
440         if_initname(ifp, "nv", unit);
441         ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
442         ifp->if_ioctl = nv_ioctl;
443         ifp->if_start = nv_ifstart;
444         ifp->if_watchdog = nv_watchdog;
445         ifp->if_timer = 0;
446         ifp->if_init = nv_init;
447         ifp->if_mtu = ETHERMTU;
448         ifp->if_baudrate = IF_Mbps(100);
449         ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
450
451         /* Attach to OS's managers. */
452         ether_ifattach(ifp, sc->sc_macaddr);
453         callout_handle_init(&sc->stat_ch);
454
455         /* Activate our interrupt handler. - attach last to avoid lock */
456         error = bus_setup_intr(sc->dev, sc->irq, INTR_TYPE_NET,
457                                nv_intr, sc, &sc->sc_ih);
458         if (error) {
459                 device_printf(sc->dev, "couldn't set up interrupt handler\n");
460                 goto fail;
461         }
462         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_attach - exit\n");
463
464 fail:
465         if (error)
466                 nv_detach(dev);
467
468         return (error);
469 }
470
471 /* Detach interface for module unload */
472 static int
473 nv_detach(device_t dev)
474 {
475         struct nv_softc *sc = device_get_softc(dev);
476         struct ifnet   *ifp;
477
478         NV_LOCK(sc);
479
480         DEBUGOUT(NV_DEBUG_DEINIT, "nv: nv_detach - entry\n");
481
482         ifp = &sc->arpcom.ac_if;
483
484         if (device_is_attached(dev)) {
485                 nv_stop(sc);
486                 ether_ifdetach(ifp);
487         }
488
489         if (sc->miibus)
490                 device_delete_child(dev, sc->miibus);
491         bus_generic_detach(dev);
492
493         /* Reload unreversed address back into MAC in original state */
494         if (sc->original_mac_addr)
495                 sc->hwapi->pfnSetNodeAddress(sc->hwapi->pADCX, sc->original_mac_addr);
496
497         DEBUGOUT(NV_DEBUG_DEINIT, "nv: do pfnClose\n");
498         /* Detach from NVIDIA hardware API */
499         if (sc->hwapi->pfnClose)
500                 sc->hwapi->pfnClose(sc->hwapi->pADCX);
501         /* Release resources */
502         if (sc->sc_ih)
503                 bus_teardown_intr(sc->dev, sc->irq, sc->sc_ih);
504         if (sc->irq)
505                 bus_release_resource(sc->dev, SYS_RES_IRQ, 0, sc->irq);
506         if (sc->res)
507                 bus_release_resource(sc->dev, SYS_RES_MEMORY, NV_RID, sc->res);
508
509         nv_free_rings(sc);
510
511         if (sc->tx_desc) {
512                 bus_dmamap_unload(sc->rtag, sc->rmap);
513                 bus_dmamem_free(sc->rtag, sc->rx_desc, sc->rmap);
514                 bus_dmamap_destroy(sc->rtag, sc->rmap);
515         }
516         if (sc->mtag)
517                 bus_dma_tag_destroy(sc->mtag);
518         if (sc->ttag)
519                 bus_dma_tag_destroy(sc->ttag);
520         if (sc->rtag)
521                 bus_dma_tag_destroy(sc->rtag);
522
523         NV_UNLOCK(sc);
524
525         DEBUGOUT(NV_DEBUG_DEINIT, "nv: nv_detach - exit\n");
526
527         return (0);
528 }
529
530 /* Initialise interface and start it "RUNNING" */
531 static void
532 nv_init(void *xsc)
533 {
534         struct nv_softc *sc = xsc;
535         struct ifnet   *ifp;
536         int             error;
537
538         NV_LOCK(sc);
539
540         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_init - entry (%d)\n", sc->linkup);
541
542         ifp = &sc->sc_if;
543
544         /* Do nothing if already running */
545         if (ifp->if_flags & IFF_RUNNING)
546                 goto fail;
547
548         nv_stop(sc);
549
550         DEBUGOUT(NV_DEBUG_INIT, "nv: do pfnInit\n");
551         /* Setup Hardware interface and allocate memory structures */
552         error = sc->hwapi->pfnInit(sc->hwapi->pADCX, 0, 0, 0, &sc->linkup);
553         if (error) {
554                 device_printf(sc->dev, "failed to start NVIDIA Hardware interface\n");
555                 goto fail;
556         }
557         /* Set the MAC address */
558         sc->hwapi->pfnSetNodeAddress(sc->hwapi->pADCX, sc->sc_macaddr);
559         sc->hwapi->pfnEnableInterrupts(sc->hwapi->pADCX);
560         sc->hwapi->pfnStart(sc->hwapi->pADCX);
561
562         /* Setup multicast filter */
563         nv_setmulti(sc);
564         nv_ifmedia_upd(ifp);
565
566         /* Update interface parameters */
567         ifp->if_flags |= IFF_RUNNING;
568         ifp->if_flags &= ~IFF_OACTIVE;
569
570         sc->stat_ch = timeout(nv_tick, sc, hz);
571
572         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_init - exit\n");
573
574 fail:
575         NV_UNLOCK(sc);
576
577         return;
578 }
579
580 /* Stop interface activity ie. not "RUNNING" */
581 static void
582 nv_stop(struct nv_softc *sc)
583 {
584         struct ifnet   *ifp;
585
586         NV_LOCK(sc);
587
588         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_stop - entry\n");
589
590         ifp = &sc->sc_if;
591         ifp->if_timer = 0;
592
593         /* Cancel tick timer */
594         untimeout(nv_tick, sc, sc->stat_ch);
595
596         /* Stop hardware activity */
597         sc->hwapi->pfnDisableInterrupts(sc->hwapi->pADCX);
598         sc->hwapi->pfnStop(sc->hwapi->pADCX, 0);
599
600         DEBUGOUT(NV_DEBUG_DEINIT, "nv: do pfnDeinit\n");
601         /* Shutdown interface and deallocate memory buffers */
602         if (sc->hwapi->pfnDeinit)
603                 sc->hwapi->pfnDeinit(sc->hwapi->pADCX, 0);
604
605         sc->linkup = 0;
606         sc->cur_rx = 0;
607
608         ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
609
610         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_stop - exit\n");
611
612         NV_UNLOCK(sc);
613
614         return;
615 }
616
617 /* Shutdown interface for unload/reboot */
618 static void
619 nv_shutdown(device_t dev)
620 {
621         struct nv_softc *sc;
622
623         DEBUGOUT(NV_DEBUG_DEINIT, "nv: nv_shutdown\n");
624
625         sc = device_get_softc(dev);
626
627         /* Stop hardware activity */
628         nv_stop(sc);
629 }
630
631 /* Allocate TX ring buffers */
632 static int
633 nv_init_rings(struct nv_softc *sc)
634 {
635         int             error, i;
636
637         NV_LOCK(sc);
638
639         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_init_rings - entry\n");
640
641         sc->cur_rx = sc->cur_tx = sc->pending_rxs = sc->pending_txs = 0;
642         /* Initialise RX ring */
643         for (i = 0; i < RX_RING_SIZE; i++) {
644                 struct nv_rx_desc *desc = sc->rx_desc + i;
645                 struct nv_map_buffer *buf = &desc->buf;
646
647                 buf->mbuf = m_getcl(MB_DONTWAIT, MT_DATA, M_PKTHDR);
648                 if (buf->mbuf == NULL) {
649                         device_printf(sc->dev, "couldn't allocate mbuf\n");
650                         nv_free_rings(sc);
651                         error = ENOBUFS;
652                         goto fail;
653                 }
654                 buf->mbuf->m_len = buf->mbuf->m_pkthdr.len = MCLBYTES;
655                 m_adj(buf->mbuf, ETHER_ALIGN);
656
657                 error = bus_dmamap_create(sc->mtag, 0, &buf->map);
658                 if (error) {
659                         device_printf(sc->dev, "couldn't create dma map\n");
660                         nv_free_rings(sc);
661                         goto fail;
662                 }
663                 error = bus_dmamap_load_mbuf(sc->mtag, buf->map, buf->mbuf,
664                                           nv_dmamap_rx_cb, &desc->paddr, 0);
665                 if (error) {
666                         device_printf(sc->dev, "couldn't dma map mbuf\n");
667                         nv_free_rings(sc);
668                         goto fail;
669                 }
670                 bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_PREREAD);
671
672                 desc->buflength = buf->mbuf->m_len;
673                 desc->vaddr = mtod(buf->mbuf, PVOID);
674         }
675         bus_dmamap_sync(sc->rtag, sc->rmap,
676                         BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
677
678         /* Initialize TX ring */
679         for (i = 0; i < TX_RING_SIZE; i++) {
680                 struct nv_tx_desc *desc = sc->tx_desc + i;
681                 struct nv_map_buffer *buf = &desc->buf;
682
683                 buf->mbuf = NULL;
684
685                 error = bus_dmamap_create(sc->mtag, 0, &buf->map);
686                 if (error) {
687                         device_printf(sc->dev, "couldn't create dma map\n");
688                         nv_free_rings(sc);
689                         goto fail;
690                 }
691         }
692         bus_dmamap_sync(sc->ttag, sc->tmap,
693                         BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
694
695         DEBUGOUT(NV_DEBUG_INIT, "nv: nv_init_rings - exit\n");
696
697 fail:
698         NV_UNLOCK(sc);
699
700         return (error);
701 }
702
703 /* Free the TX ring buffers */
704 static void
705 nv_free_rings(struct nv_softc *sc)
706 {
707         int             i;
708
709         NV_LOCK(sc);
710
711         DEBUGOUT(NV_DEBUG_DEINIT, "nv: nv_free_rings - entry\n");
712
713         for (i = 0; i < RX_RING_SIZE; i++) {
714                 struct nv_rx_desc *desc = sc->rx_desc + i;
715                 struct nv_map_buffer *buf = &desc->buf;
716
717                 if (buf->mbuf) {
718                         bus_dmamap_unload(sc->mtag, buf->map);
719                         bus_dmamap_destroy(sc->mtag, buf->map);
720                         m_freem(buf->mbuf);
721                 }
722                 buf->mbuf = NULL;
723         }
724
725         for (i = 0; i < TX_RING_SIZE; i++) {
726                 struct nv_tx_desc *desc = sc->tx_desc + i;
727                 struct nv_map_buffer *buf = &desc->buf;
728
729                 if (buf->mbuf) {
730                         bus_dmamap_unload(sc->mtag, buf->map);
731                         bus_dmamap_destroy(sc->mtag, buf->map);
732                         m_freem(buf->mbuf);
733                 }
734                 buf->mbuf = NULL;
735         }
736
737         DEBUGOUT(NV_DEBUG_DEINIT, "nv: nv_free_rings - exit\n");
738
739         NV_UNLOCK(sc);
740 }
741
742 /* Main loop for sending packets from OS to interface */
743 static void
744 nv_ifstart(struct ifnet *ifp)
745 {
746         struct nv_softc *sc = ifp->if_softc;
747         struct nv_map_buffer *buf;
748         struct mbuf    *m0, *m;
749         struct nv_tx_desc *desc;
750         ADAPTER_WRITE_DATA txdata;
751         int             error, i;
752
753         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_ifstart - entry\n");
754
755         /* If link is down/busy or queue is empty do nothing */
756         if (ifp->if_flags & IFF_OACTIVE || ifp->if_snd.ifq_head == NULL)
757                 return;
758
759         /* Transmit queued packets until sent or TX ring is full */
760         while (sc->pending_txs < TX_RING_SIZE) {
761                 desc = sc->tx_desc + sc->cur_tx;
762                 buf = &desc->buf;
763
764                 /* Get next packet to send. */
765                 IF_DEQUEUE(&ifp->if_snd, m0);
766
767                 /* If nothing to send, return. */
768                 if (m0 == NULL)
769                         return;
770
771                 /* Map MBUF for DMA access */
772                 error = bus_dmamap_load_mbuf(sc->mtag, buf->map, m0,
773                                      nv_dmamap_tx_cb, desc, BUS_DMA_NOWAIT);
774
775                 if (error && error != EFBIG) {
776                         m_freem(m0);
777                         sc->tx_errors++;
778                         continue;
779                 }
780                 /*
781                  * Packet has too many fragments - defrag into new mbuf
782                  * cluster
783                  */
784                 if (error) {
785                         m = m_defrag(m0, MB_DONTWAIT);
786                         if (m == NULL) {
787                                 m_freem(m0);
788                                 sc->tx_errors++;
789                                 continue;
790                         }
791                         m_freem(m0);
792                         m0 = m;
793
794                         error = bus_dmamap_load_mbuf(sc->mtag, buf->map, m,
795                                      nv_dmamap_tx_cb, desc, BUS_DMA_NOWAIT);
796                         if (error) {
797                                 m_freem(m);
798                                 sc->tx_errors++;
799                                 continue;
800                         }
801                 }
802                 /* Do sync on DMA bounce buffer */
803                 bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_PREWRITE);
804
805                 buf->mbuf = m0;
806                 txdata.ulNumberOfElements = desc->numfrags;
807                 txdata.pvID = (PVOID)desc;
808
809                 /* Put fragments into API element list */
810                 txdata.ulTotalLength = buf->mbuf->m_len;
811                 for (i = 0; i < desc->numfrags; i++) {
812                         txdata.sElement[i].ulLength = (ulong)desc->frags[i].ds_len;
813                         txdata.sElement[i].pPhysical = (PVOID)desc->frags[i].ds_addr;
814                 }
815
816                 /* Send packet to Nvidia API for transmission */
817                 error = sc->hwapi->pfnWrite(sc->hwapi->pADCX, &txdata);
818
819                 switch (error) {
820                 case ADAPTERERR_NONE:
821                         /* Packet was queued in API TX queue successfully */
822                         sc->pending_txs++;
823                         sc->cur_tx = (sc->cur_tx + 1) % TX_RING_SIZE;
824                         break;
825
826                 case ADAPTERERR_TRANSMIT_QUEUE_FULL:
827                         /* The API TX queue is full - requeue the packet */
828                         device_printf(sc->dev, "nv_ifstart: transmit queue is full\n");
829                         ifp->if_flags |= IFF_OACTIVE;
830                         bus_dmamap_unload(sc->mtag, buf->map);
831                         IF_PREPEND(&ifp->if_snd, buf->mbuf);
832                         buf->mbuf = NULL;
833                         return;
834
835                 default:
836                         /* The API failed to queue/send the packet so dump it */
837                         device_printf(sc->dev, "nv_ifstart: transmit error\n");
838                         bus_dmamap_unload(sc->mtag, buf->map);
839                         m_freem(buf->mbuf);
840                         buf->mbuf = NULL;
841                         sc->tx_errors++;
842                         return;
843                 }
844                 /* Set watchdog timer. */
845                 ifp->if_timer = 8;
846
847                 /* Copy packet to BPF tap */
848                 BPF_MTAP(ifp, m0);
849         }
850         ifp->if_flags |= IFF_OACTIVE;
851
852         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_ifstart - exit\n");
853 }
854
855 /* Handle IOCTL events */
856 static int
857 nv_ioctl(struct ifnet *ifp, u_long command, caddr_t data, struct ucred *cr)
858 {
859         struct nv_softc *sc = ifp->if_softc;
860         struct ifreq   *ifr = (struct ifreq *) data;
861         struct mii_data *mii;
862         int             error = 0;
863
864         NV_LOCK(sc);
865
866         DEBUGOUT(NV_DEBUG_IOCTL, "nv: nv_ioctl - entry\n");
867
868         switch (command) {
869         case SIOCSIFMTU:
870                 /* Set MTU size */
871                 if (ifp->if_mtu == ifr->ifr_mtu)
872                         break;
873                 if (ifr->ifr_mtu + ifp->if_hdrlen <= MAX_PACKET_SIZE) {
874                         ifp->if_mtu = ifr->ifr_mtu;
875                         nv_stop(sc);
876                         nv_init(sc);
877                 } else
878                         error = EINVAL;
879                 break;
880
881         case SIOCSIFFLAGS:
882                 /* Setup interface flags */
883                 if (ifp->if_flags & IFF_UP) {
884                         if ((ifp->if_flags & IFF_RUNNING) == 0) {
885                                 nv_init(sc);
886                                 break;
887                         }
888                 } else {
889                         if (ifp->if_flags & IFF_RUNNING) {
890                                 nv_stop(sc);
891                                 break;
892                         }
893                 }
894
895                 /* Handle IFF_PROMISC and IFF_ALLMULTI flags. */
896                 nv_setmulti(sc);
897                 break;
898
899         case SIOCADDMULTI:
900         case SIOCDELMULTI:
901                 /* Setup multicast filter */
902                 if (ifp->if_flags & IFF_RUNNING) {
903                         nv_setmulti(sc);
904                 }
905                 break;
906         case SIOCGIFMEDIA:
907         case SIOCSIFMEDIA:
908                 /* Get/Set interface media parameters */
909                 mii = device_get_softc(sc->miibus);
910                 error = ifmedia_ioctl(ifp, ifr, &mii->mii_media, command);
911                 break;
912
913         default:
914                 /* Everything else we forward to generic ether ioctl */
915                 error = ether_ioctl(ifp, (int)command, data);
916                 break;
917         }
918
919         DEBUGOUT(NV_DEBUG_IOCTL, "nv: nv_ioctl - exit\n");
920
921         NV_UNLOCK(sc);
922
923         return (error);
924 }
925
926 /* Interrupt service routine */
927 static void
928 nv_intr(void *arg)
929 {
930         struct nv_softc *sc = arg;
931         struct ifnet   *ifp = &sc->sc_if;
932
933         DEBUGOUT(NV_DEBUG_INTERRUPT, "nv: nv_intr - entry\n");
934
935         if (!ifp->if_flags & IFF_UP) {
936                 nv_stop(sc);
937                 return;
938         }
939         /* Handle interrupt event */
940         if (sc->hwapi->pfnQueryInterrupt(sc->hwapi->pADCX)) {
941                 sc->hwapi->pfnHandleInterrupt(sc->hwapi->pADCX);
942                 sc->hwapi->pfnEnableInterrupts(sc->hwapi->pADCX);
943         }
944         if (ifp->if_snd.ifq_head != NULL)
945                 nv_ifstart(ifp);
946
947         /* If no pending packets we don't need a timeout */
948         if (sc->pending_txs == 0)
949                 sc->sc_if.if_timer = 0;
950
951         DEBUGOUT(NV_DEBUG_INTERRUPT, "nv: nv_intr - exit\n");
952
953         return;
954 }
955
956 /* Setup multicast filters */
957 static void
958 nv_setmulti(struct nv_softc *sc)
959 {
960         struct ifnet   *ifp;
961         struct ifmultiaddr *ifma;
962         PACKET_FILTER   hwfilter;
963         int             i;
964         u_int8_t        oraddr[6];
965         u_int8_t        andaddr[6];
966
967         NV_LOCK(sc);
968
969         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_setmulti - entry\n");
970
971         ifp = &sc->sc_if;
972
973         /* Initialize filter */
974         hwfilter.ulFilterFlags = 0;
975         for (i = 0; i < 6; i++) {
976                 hwfilter.acMulticastAddress[i] = 0;
977                 hwfilter.acMulticastMask[i] = 0;
978         }
979
980         if (ifp->if_flags & (IFF_PROMISC | IFF_ALLMULTI)) {
981                 /* Accept all packets */
982                 hwfilter.ulFilterFlags |= ACCEPT_ALL_PACKETS;
983                 sc->hwapi->pfnSetPacketFilter(sc->hwapi->pADCX, &hwfilter);
984                 NV_UNLOCK(sc);
985                 return;
986         }
987         /* Setup multicast filter */
988         LIST_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
989                 u_char         *addrp;
990
991                 if (ifma->ifma_addr->sa_family != AF_LINK)
992                         continue;
993
994                 addrp = LLADDR((struct sockaddr_dl *) ifma->ifma_addr);
995                 for (i = 0; i < 6; i++) {
996                         u_int8_t        mcaddr = addrp[i];
997                         andaddr[i] &= mcaddr;
998                         oraddr[i] |= mcaddr;
999                 }
1000         }
1001         for (i = 0; i < 6; i++) {
1002                 hwfilter.acMulticastAddress[i] = andaddr[i] & oraddr[i];
1003                 hwfilter.acMulticastMask[i] = andaddr[i] | (~oraddr[i]);
1004         }
1005
1006         /* Send filter to NVIDIA API */
1007         sc->hwapi->pfnSetPacketFilter(sc->hwapi->pADCX, &hwfilter);
1008
1009         NV_UNLOCK(sc);
1010
1011         DEBUGOUT(NV_DEBUG_RUNNING, "nv: nv_setmulti - exit\n");
1012
1013         return;
1014 }
1015
1016 /* Change the current media/mediaopts */
1017 static int
1018 nv_ifmedia_upd(struct ifnet *ifp)
1019 {
1020         struct nv_softc *sc = ifp->if_softc;
1021         struct mii_data *mii;
1022
1023         DEBUGOUT(NV_DEBUG_MII, "nv: nv_ifmedia_upd\n");
1024
1025         mii = device_get_softc(sc->miibus);
1026
1027         if (mii->mii_instance) {
1028                 struct mii_softc *miisc;
1029                 for (miisc = LIST_FIRST(&mii->mii_phys); miisc != NULL;
1030                      miisc = LIST_NEXT(miisc, mii_list)) {
1031                         mii_phy_reset(miisc);
1032                 }
1033         }
1034         mii_mediachg(mii);
1035
1036         return (0);
1037 }
1038
1039 /* Update current miibus PHY status of media */
1040 static void
1041 nv_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
1042 {
1043         struct nv_softc *sc;
1044         struct mii_data *mii;
1045
1046         DEBUGOUT(NV_DEBUG_MII, "nv: nv_ifmedia_sts\n");
1047
1048         sc = ifp->if_softc;
1049         mii = device_get_softc(sc->miibus);
1050         mii_pollstat(mii);
1051
1052         ifmr->ifm_active = mii->mii_media_active;
1053         ifmr->ifm_status = mii->mii_media_status;
1054
1055         return;
1056 }
1057
1058 /* miibus tick timer - maintain link status */
1059 static void
1060 nv_tick(void *xsc)
1061 {
1062         struct nv_softc *sc = xsc;
1063         struct mii_data *mii;
1064         struct ifnet   *ifp;
1065
1066         NV_LOCK(sc);
1067
1068         ifp = &sc->sc_if;
1069         nv_update_stats(sc);
1070
1071         mii = device_get_softc(sc->miibus);
1072         mii_tick(mii);
1073
1074         if (mii->mii_media_status & IFM_ACTIVE &&
1075             IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
1076                 if (ifp->if_snd.ifq_head != NULL)
1077                         nv_ifstart(ifp);
1078         }
1079         sc->stat_ch = timeout(nv_tick, sc, hz);
1080
1081         NV_UNLOCK(sc);
1082
1083         return;
1084 }
1085
1086 /* Update ifnet data structure with collected interface stats from API */
1087 static void
1088 nv_update_stats(struct nv_softc *sc)
1089 {
1090         struct ifnet   *ifp = &sc->sc_if;
1091         ADAPTER_STATS   stats;
1092
1093         NV_LOCK(sc);
1094
1095         if (sc->hwapi) {
1096                 sc->hwapi->pfnGetStatistics(sc->hwapi->pADCX, &stats);
1097
1098                 ifp->if_ipackets = stats.ulSuccessfulReceptions;
1099                 ifp->if_ierrors = stats.ulMissedFrames +
1100                         stats.ulFailedReceptions +
1101                         stats.ulCRCErrors +
1102                         stats.ulFramingErrors +
1103                         stats.ulOverFlowErrors;
1104
1105                 ifp->if_opackets = stats.ulSuccessfulTransmissions;
1106                 ifp->if_oerrors = sc->tx_errors +
1107                         stats.ulFailedTransmissions +
1108                         stats.ulRetryErrors +
1109                         stats.ulUnderflowErrors +
1110                         stats.ulLossOfCarrierErrors +
1111                         stats.ulLateCollisionErrors;
1112
1113                 ifp->if_collisions = stats.ulLateCollisionErrors;
1114         }
1115         NV_UNLOCK(sc);
1116
1117         return;
1118 }
1119
1120 /* miibus Read PHY register wrapper - calls Nvidia API entry point */
1121 static int
1122 nv_miibus_readreg(device_t dev, int phy, int reg)
1123 {
1124         struct nv_softc *sc = device_get_softc(dev);
1125         ulong           data;
1126
1127         DEBUGOUT(NV_DEBUG_MII, "nv: nv_miibus_readreg - entry\n");
1128
1129         ADAPTER_ReadPhy(sc->hwapi->pADCX, phy, reg, &data);
1130
1131         DEBUGOUT(NV_DEBUG_MII, "nv: nv_miibus_readreg - exit\n");
1132
1133         return (data);
1134 }
1135
1136 /* miibus Write PHY register wrapper - calls Nvidia API entry point */
1137 static void
1138 nv_miibus_writereg(device_t dev, int phy, int reg, int data)
1139 {
1140         struct nv_softc *sc = device_get_softc(dev);
1141
1142         DEBUGOUT(NV_DEBUG_MII, "nv: nv_miibus_writereg - entry\n");
1143
1144         ADAPTER_WritePhy(sc->hwapi->pADCX, phy, reg, (ulong)data);
1145
1146         DEBUGOUT(NV_DEBUG_MII, "nv: nv_miibus_writereg - exit\n");
1147
1148         return;
1149 }
1150
1151 /* Watchdog timer to prevent PHY lockups */
1152 static void
1153 nv_watchdog(struct ifnet *ifp)
1154 {
1155         struct nv_softc *sc = ifp->if_softc;
1156
1157         device_printf(sc->dev, "device timeout\n");
1158
1159         sc->tx_errors++;
1160
1161         nv_stop(sc);
1162         ifp->if_flags &= ~IFF_RUNNING;
1163         nv_init(sc);
1164
1165         if (ifp->if_snd.ifq_head != NULL)
1166                 nv_ifstart(ifp);
1167
1168         return;
1169 }
1170
1171 /* --- Start of NVOSAPI interface --- */
1172
1173 /* Allocate DMA enabled general use memory for API */
1174 static int
1175 nv_osalloc(void *ctx, MEMORY_BLOCK *mem)
1176 {
1177         struct nv_softc *sc;
1178         bus_addr_t      mem_physical;
1179
1180         DEBUGOUT(NV_DEBUG_API, "nv: nv_osalloc - %d\n", mem->uiLength);
1181
1182         sc = (struct nv_softc *)ctx;
1183
1184         mem->pLogical = (PVOID)contigmalloc(mem->uiLength, M_DEVBUF,
1185                                     M_NOWAIT | M_ZERO, 0, ~0, PAGE_SIZE, 0);
1186
1187         if (!mem->pLogical) {
1188                 device_printf(sc->dev, "memory allocation failed\n");
1189                 return (0);
1190         }
1191         memset(mem->pLogical, 0, (ulong)mem->uiLength);
1192         mem_physical = vtophys(mem->pLogical);
1193         mem->pPhysical = (PVOID)mem_physical;
1194
1195         DEBUGOUT(NV_DEBUG_API, "nv: nv_osalloc 0x%x/0x%x - %d\n",
1196                  (u_int32_t) mem->pLogical,
1197                  (u_int32_t) mem->pPhysical, mem->uiLength);
1198
1199         return (1);
1200 }
1201
1202 /* Free allocated memory */
1203 static int
1204 nv_osfree(void *ctx, MEMORY_BLOCK *mem)
1205 {
1206         DEBUGOUT(NV_DEBUG_API, "nv: nv_osfree - 0x%x - %d\n",
1207                  (u_int32_t) mem->pLogical, mem->uiLength);
1208
1209         contigfree(mem->pLogical, PAGE_SIZE, M_DEVBUF);
1210         return (1);
1211 }
1212
1213 /* Copied directly from nvnet.c */
1214 static int
1215 nv_osallocex(void *ctx, MEMORY_BLOCKEX *mem_block_ex)
1216 {
1217         MEMORY_BLOCK    mem_block;
1218
1219         DEBUGOUT(NV_DEBUG_API, "nv: nv_osallocex\n");
1220
1221         mem_block_ex->pLogical = NULL;
1222         mem_block_ex->uiLengthOrig = mem_block_ex->uiLength;
1223
1224         if ((mem_block_ex->AllocFlags & ALLOC_MEMORY_ALIGNED) &&
1225             (mem_block_ex->AlignmentSize > 1)) {
1226                 DEBUGOUT(NV_DEBUG_API, "     aligning on %d\n",
1227                          mem_block_ex->AlignmentSize);
1228                 mem_block_ex->uiLengthOrig += mem_block_ex->AlignmentSize;
1229         }
1230         mem_block.uiLength = mem_block_ex->uiLengthOrig;
1231
1232         if (nv_osalloc(ctx, &mem_block) == 0) {
1233                 return (0);
1234         }
1235         mem_block_ex->pLogicalOrig = mem_block.pLogical;
1236         mem_block_ex->pPhysicalOrigLow = (ULONG)mem_block.pPhysical;
1237         mem_block_ex->pPhysicalOrigHigh = 0;
1238
1239         mem_block_ex->pPhysical = mem_block.pPhysical;
1240         mem_block_ex->pLogical = mem_block.pLogical;
1241
1242         if (mem_block_ex->uiLength != mem_block_ex->uiLengthOrig) {
1243                 unsigned int    offset;
1244                 offset = mem_block_ex->pPhysicalOrigLow & (mem_block_ex->AlignmentSize - 1);
1245
1246                 if (offset) {
1247                         mem_block_ex->pPhysical = (PVOID)((ULONG)mem_block_ex->pPhysical +
1248                                       mem_block_ex->AlignmentSize - offset);
1249                         mem_block_ex->pLogical = (PVOID)((ULONG)mem_block_ex->pLogical +
1250                                       mem_block_ex->AlignmentSize - offset);
1251                 }               /* if (offset) */
1252         }                       /* if (mem_block_ex->uiLength !=
1253                                  * mem_block_ex->uiLengthOrig) */
1254         return (1);
1255 }
1256
1257 /* Copied directly from nvnet.c */
1258 static int
1259 nv_osfreeex(void *ctx, MEMORY_BLOCKEX *mem_block_ex)
1260 {
1261         MEMORY_BLOCK    mem_block;
1262
1263         DEBUGOUT(NV_DEBUG_API, "nv: nv_osfreeex\n");
1264
1265         mem_block.pLogical = mem_block_ex->pLogicalOrig;
1266         mem_block.pPhysical = (PVOID)mem_block_ex->pPhysicalOrigLow;
1267         mem_block.uiLength = mem_block_ex->uiLengthOrig;
1268
1269         return (nv_osfree(ctx, &mem_block));
1270 }
1271
1272 /* Clear memory region */
1273 static int
1274 nv_osclear(void *ctx, void *mem, int length)
1275 {
1276         DEBUGOUT(NV_DEBUG_API, "nv: nv_osclear\n");
1277         memset(mem, 0, length);
1278         return (1);
1279 }
1280
1281 /* Sleep for a tick */
1282 static int
1283 nv_osdelay(void *ctx, unsigned long usec)
1284 {
1285         DELAY(usec);
1286         return (1);
1287 }
1288
1289 /* Allocate memory for rx buffer */
1290 static int
1291 nv_osallocrxbuf(void *ctx, MEMORY_BLOCK *mem, void **id)
1292 {
1293         struct nv_softc *sc = ctx;
1294         struct nv_rx_desc *desc;
1295         struct nv_map_buffer *buf;
1296         int             error;
1297
1298         NV_LOCK(sc);
1299
1300         DEBUGOUT(NV_DEBUG_API, "nv: nv_osallocrxbuf\n");
1301
1302         if (sc->pending_rxs == RX_RING_SIZE) {
1303                 device_printf(sc->dev, "rx ring buffer is full\n");
1304                 goto fail;
1305         }
1306         desc = sc->rx_desc + sc->cur_rx;
1307         buf = &desc->buf;
1308
1309         if (buf->mbuf == NULL) {
1310                 buf->mbuf = m_getcl(MB_DONTWAIT, MT_DATA, M_PKTHDR);
1311                 if (buf->mbuf == NULL) {
1312                         device_printf(sc->dev, "failed to allocate memory\n");
1313                         goto fail;
1314                 }
1315                 buf->mbuf->m_len = buf->mbuf->m_pkthdr.len = MCLBYTES;
1316                 m_adj(buf->mbuf, ETHER_ALIGN);
1317
1318                 error = bus_dmamap_load_mbuf(sc->mtag, buf->map, buf->mbuf,
1319                                           nv_dmamap_rx_cb, &desc->paddr, 0);
1320                 if (error) {
1321                         device_printf(sc->dev, "failed to dmamap mbuf\n");
1322                         m_freem(buf->mbuf);
1323                         buf->mbuf = NULL;
1324                         goto fail;
1325                 }
1326                 bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_PREREAD);
1327                 desc->buflength = buf->mbuf->m_len;
1328                 desc->vaddr = mtod(buf->mbuf, PVOID);
1329         }
1330         sc->pending_rxs++;
1331         sc->cur_rx = (sc->cur_rx + 1) % RX_RING_SIZE;
1332
1333         mem->pLogical = (void *)desc->vaddr;
1334         mem->pPhysical = (void *)desc->paddr;
1335         mem->uiLength = desc->buflength;
1336         *id = (void *)desc;
1337
1338 fail:
1339         NV_UNLOCK(sc);
1340
1341         return (1);
1342 }
1343
1344
1345 /* Free the rx buffer */
1346 static int
1347 nv_osfreerxbuf(void *ctx, MEMORY_BLOCK *mem, void *id)
1348 {
1349         struct nv_softc *sc = ctx;
1350         struct nv_rx_desc *desc;
1351         struct nv_map_buffer *buf;
1352
1353         NV_LOCK(sc);
1354
1355         DEBUGOUT(NV_DEBUG_API, "nv: nv_osfreerxbuf\n");
1356
1357         desc = (struct nv_rx_desc *) id;
1358         buf = &desc->buf;
1359
1360         if (buf->mbuf) {
1361                 bus_dmamap_unload(sc->mtag, buf->map);
1362                 bus_dmamap_destroy(sc->mtag, buf->map);
1363                 m_freem(buf->mbuf);
1364         }
1365         sc->pending_rxs--;
1366         buf->mbuf = NULL;
1367
1368         NV_UNLOCK(sc);
1369
1370         return (1);
1371 }
1372
1373 /* This gets called by the Nvidia API after our TX packet has been sent */
1374 static int
1375 nv_ospackettx(void *ctx, void *id, unsigned long success)
1376 {
1377         struct nv_softc *sc = ctx;
1378         struct nv_map_buffer *buf;
1379         struct nv_tx_desc *desc = (struct nv_tx_desc *) id;
1380         struct ifnet   *ifp;
1381
1382         NV_LOCK(sc);
1383
1384         DEBUGOUT(NV_DEBUG_API, "nv: nv_ospackettx\n");
1385
1386         ifp = &sc->sc_if;
1387
1388         buf = &desc->buf;
1389
1390         if (buf->mbuf == NULL)
1391                 goto fail;
1392
1393         bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_POSTWRITE);
1394         bus_dmamap_unload(sc->mtag, buf->map);
1395         m_freem(buf->mbuf);
1396         buf->mbuf = NULL;
1397
1398         sc->pending_txs--;
1399
1400         if (ifp->if_snd.ifq_head != NULL && sc->pending_txs < TX_RING_SIZE)
1401                 nv_ifstart(ifp);
1402
1403 fail:
1404         NV_UNLOCK(sc);
1405
1406         return (1);
1407 }
1408
1409 /* This gets called by the Nvidia API when a new packet has been received */
1410 /* XXX What is newbuf used for? XXX */
1411 static int
1412 nv_ospacketrx(void *ctx, void *data, unsigned long success,
1413               unsigned char *newbuf, unsigned char priority)
1414 {
1415         struct nv_softc *sc = ctx;
1416         struct ifnet   *ifp;
1417         struct nv_rx_desc *desc;
1418         struct nv_map_buffer *buf;
1419         ADAPTER_READ_DATA *readdata;
1420         NV_LOCK(sc);
1421
1422         DEBUGOUT(NV_DEBUG_API, "nv: nv_ospacketrx\n");
1423
1424         ifp = &sc->sc_if;
1425
1426         readdata = (ADAPTER_READ_DATA *) data;
1427         desc = readdata->pvID;
1428         buf = &desc->buf;
1429         bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_POSTREAD);
1430
1431         if (success) {
1432                 /* Sync DMA bounce buffer. */
1433                 bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_POSTREAD);
1434
1435                 /* First mbuf in packet holds the ethernet and packet headers */
1436                 buf->mbuf->m_pkthdr.rcvif = ifp;
1437                 buf->mbuf->m_pkthdr.len = buf->mbuf->m_len = readdata->ulTotalLength;
1438
1439                 bus_dmamap_unload(sc->mtag, buf->map);
1440
1441                 /* Give mbuf to OS. */
1442                 (*ifp->if_input) (ifp, buf->mbuf);
1443                 if (readdata->ulFilterMatch & ADREADFL_MULTICAST_MATCH)
1444                         ifp->if_imcasts++;
1445
1446                 /* Blat the mbuf pointer, kernel will free the mbuf cluster */
1447                 buf->mbuf = NULL;
1448         } else {
1449                 bus_dmamap_sync(sc->mtag, buf->map, BUS_DMASYNC_POSTREAD);
1450                 bus_dmamap_unload(sc->mtag, buf->map);
1451                 m_freem(buf->mbuf);
1452                 buf->mbuf = NULL;
1453         }
1454
1455         sc->cur_rx = desc - sc->rx_desc;
1456         sc->pending_rxs--;
1457
1458         NV_UNLOCK(sc);
1459
1460         return (1);
1461 }
1462
1463 /* This gets called by NVIDIA API when the PHY link state changes */
1464 static int
1465 nv_oslinkchg(void *ctx, int enabled)
1466 {
1467         struct nv_softc *sc = (struct nv_softc *)ctx;
1468         struct ifnet   *ifp;
1469
1470         DEBUGOUT(NV_DEBUG_API, "nv: nv_oslinkchg\n");
1471
1472         ifp = &sc->sc_if;
1473
1474         if (enabled)
1475                 ifp->if_flags |= IFF_UP;
1476         else
1477                 ifp->if_flags &= ~IFF_UP;
1478
1479
1480         return (1);
1481 }
1482
1483
1484 /* Setup a watchdog timer */
1485 static int
1486 nv_osalloctimer(void *ctx, void **timer)
1487 {
1488         struct nv_softc *sc = (struct nv_softc *)ctx;
1489
1490         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_osalloctimer\n");
1491
1492         callout_handle_init(&sc->ostimer);
1493         *timer = &sc->ostimer;
1494
1495         return (1);
1496 }
1497
1498 /* Free the timer */
1499 static int
1500 nv_osfreetimer(void *ctx, void *timer)
1501 {
1502         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_osfreetimer\n");
1503
1504         return (1);
1505 }
1506
1507 /* Setup timer parameters */
1508 static int
1509 nv_osinittimer(void *ctx, void *timer, PTIMER_FUNC func, void *parameters)
1510 {
1511         struct nv_softc *sc = (struct nv_softc *)ctx;
1512
1513         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_osinittimer\n");
1514
1515         sc->ostimer_func = func;
1516         sc->ostimer_params = parameters;
1517
1518         return (1);
1519 }
1520
1521 /* Set the timer to go off */
1522 static int
1523 nv_ossettimer(void *ctx, void *timer, unsigned long delay)
1524 {
1525         struct nv_softc *sc = ctx;
1526
1527         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_ossettimer\n");
1528
1529         *(struct callout_handle *) timer = timeout(sc->ostimer_func, sc->ostimer_params, delay);
1530
1531         return (1);
1532 }
1533
1534 /* Cancel the timer */
1535 static int
1536 nv_oscanceltimer(void *ctx, void *timer)
1537 {
1538         struct nv_softc *sc = ctx;
1539
1540         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_oscanceltimer\n");
1541
1542         untimeout(sc->ostimer_func, sc->ostimer_params, *(struct callout_handle *) timer);
1543
1544         return (1);
1545 }
1546
1547 static int
1548 nv_ospreprocpkt(void *ctx, void *readdata, void **id, unsigned char *newbuffer,
1549                 unsigned char priority)
1550 {
1551         /* Not implemented */
1552         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_ospreprocpkt\n");
1553
1554         return (1);
1555 }
1556
1557 static void
1558                *
1559 nv_ospreprocpktnopq(void *ctx, void *readdata)
1560 {
1561         /* Not implemented */
1562         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_ospreprocpkt\n");
1563
1564         return (NULL);
1565 }
1566
1567 static int
1568 nv_osindicatepkt(void *ctx, void **id, unsigned long pktno)
1569 {
1570         /* Not implemented */
1571         DEBUGOUT(NV_DEBUG_BROKEN, "nv: nv_osindicatepkt\n");
1572
1573         return (1);
1574 }
1575
1576 /* Allocate mutex context (already done in nv_attach) */
1577 static int
1578 nv_oslockalloc(void *ctx, int type, void **pLock)
1579 {
1580         struct nv_softc *sc = (struct nv_softc *)ctx;
1581
1582         DEBUGOUT(NV_DEBUG_LOCK, "nv: nv_oslockalloc\n");
1583
1584         *pLock = (void **)sc;
1585
1586         return (1);
1587 }
1588
1589 /* Obtain a spin lock */
1590 static int
1591 nv_oslockacquire(void *ctx, int type, void *lock)
1592 {
1593         DEBUGOUT(NV_DEBUG_LOCK, "nv: nv_oslockacquire\n");
1594
1595         NV_OSLOCK((struct nv_softc *)lock);
1596
1597         return (1);
1598 }
1599
1600 /* Release lock */
1601 static int
1602 nv_oslockrelease(void *ctx, int type, void *lock)
1603 {
1604         DEBUGOUT(NV_DEBUG_LOCK, "nv: nv_oslockrelease\n");
1605
1606         NV_OSUNLOCK((struct nv_softc *)lock);
1607
1608         return (1);
1609 }
1610
1611 /* I have no idea what this is for */
1612 static void    *
1613 nv_osreturnbufvirt(void *ctx, void *readdata)
1614 {
1615         /* Not implemented */
1616         DEBUGOUT(NV_DEBUG_LOCK, "nv: nv_osreturnbufvirt\n");
1617         panic("nv: nv_osreturnbufvirtual not implemented\n");
1618
1619         return (NULL);
1620 }
1621
1622
1623 /* --- End on NVOSAPI interface --- */