summaryrefslogtreecommitdiffstats
path: root/sys/boot/uboot/lib/net.c
diff options
context:
space:
mode:
Diffstat (limited to 'sys/boot/uboot/lib/net.c')
-rw-r--r--sys/boot/uboot/lib/net.c252
1 files changed, 252 insertions, 0 deletions
diff --git a/sys/boot/uboot/lib/net.c b/sys/boot/uboot/lib/net.c
new file mode 100644
index 0000000..88021c8
--- /dev/null
+++ b/sys/boot/uboot/lib/net.c
@@ -0,0 +1,252 @@
+/*-
+ * Copyright (c) 2000-2001 Benno Rice
+ * Copyright (c) 2007 Semihalf, Rafal Jaworowski <raj@semihalf.com>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+
+#include <net/if.h>
+#include <netinet/in.h>
+#include <netinet/in_systm.h>
+#include <netinet/if_ether.h>
+#include <netinet/ip.h>
+
+#include <stand.h>
+#include <net.h>
+#include <netif.h>
+
+#include "api_public.h"
+#include "libuboot.h"
+
+#define NETIF_DEBUG
+#define NETIF_VERBOSE_DEBUG
+#undef NETIF_DEBUG
+#undef NETIF_VERBOSE_DEBUG
+
+
+static int net_probe(struct netif *, void *);
+static int net_match(struct netif *, void *);
+static void net_init(struct iodesc *, void *);
+static int net_get(struct iodesc *, void *, size_t, time_t);
+static int net_put(struct iodesc *, void *, size_t);
+static void net_end(struct netif *);
+
+struct device_info * ub_dev_get(int i);
+
+extern int devs_no;
+extern struct netif_stats net_stats[];
+
+struct netif_dif net_ifs[] = {
+ /* dif_unit dif_nsel dif_stats dif_private */
+ { 0, 1, &net_stats[0], 0, },
+};
+
+struct netif_stats net_stats[NENTS(net_ifs)];
+
+struct netif_driver uboot_net = {
+ "uboot_eth", /* netif_bname */
+ net_match, /* netif_match */
+ net_probe, /* netif_probe */
+ net_init, /* netif_init */
+ net_get, /* netif_get */
+ net_put, /* netif_put */
+ net_end, /* netif_end */
+ net_ifs, /* netif_ifs */
+ NENTS(net_ifs) /* netif_nifs */
+};
+
+struct uboot_softc {
+ u_int32_t sc_pad;
+ u_int8_t sc_rxbuf[ETHER_MAX_LEN];
+ u_int8_t sc_txbuf[ETHER_MAX_LEN + PKTALIGN];
+ u_int8_t *sc_txbufp;
+ int sc_handle; /* device handle for ub_dev_xxx */
+};
+
+static struct uboot_softc uboot_softc;
+
+static int
+net_match(struct netif *nif, void *machdep_hint)
+{
+ char **a = (char **)machdep_hint;
+
+ if (memcmp("net", *a, 3) == 0)
+ return 1;
+
+ printf("net_match: could not match network device\n");
+ return 0;
+}
+
+static int
+net_probe(struct netif *nif, void *machdep_hint)
+{
+ int i;
+ struct device_info *di;
+
+ for (i = 0; i < devs_no; i++)
+ if (di = ub_dev_get(i))
+ if (di->type == DEV_TYP_NET)
+ break;
+ if (i == devs_no) {
+ printf("net_probe: no network devices found, maybe not\
+ enumerated yet..?\n");
+ return -1;
+ }
+
+#if defined(NETIF_DEBUG)
+ printf("net_probe: network device found: %d\n", i);
+#endif
+ uboot_softc.sc_handle = i;
+
+ return 0;
+}
+
+static int
+net_put(struct iodesc *desc, void *pkt, size_t len)
+{
+ struct netif *nif = desc->io_netif;
+ struct uboot_softc *sc = nif->nif_devdata;
+
+ struct ether_header *eh;
+ size_t sendlen;
+ ssize_t rv;
+
+#if defined(NETIF_DEBUG)
+ printf("net_put: desc 0x%x, pkt 0x%x, len %d\n", desc, pkt, len);
+ eh = pkt;
+ printf("dst: %s ", ether_sprintf(eh->ether_dhost));
+ printf("src: %s ", ether_sprintf(eh->ether_shost));
+ printf("type: 0x%x\n", eh->ether_type & 0xffff);
+#endif
+
+ if (len < ETHER_MIN_LEN - ETHER_CRC_LEN) {
+ sendlen = ETHER_MIN_LEN - ETHER_CRC_LEN;
+ bzero(sc->sc_txbufp, sendlen);
+ } else
+ sendlen = len;
+
+ memcpy(sc->sc_txbufp, pkt, len);
+
+ rv = ub_dev_send(sc->sc_handle, sc->sc_txbufp, sendlen);
+
+#if defined(NETIF_DEBUG)
+ printf("net_put: ub_send returned %d\n", rv);
+#endif
+ if (rv == 0)
+ rv = len;
+ else
+ rv = -1;
+
+ return rv;
+}
+
+static int
+net_get(struct iodesc *desc, void *pkt, size_t len, time_t timeout)
+{
+ struct netif *nif = desc->io_netif;
+ struct uboot_softc *sc = nif->nif_devdata;
+
+ time_t t;
+ int length;
+
+#if defined(NETIF_DEBUG)
+ printf("net_get: pkt %x, len %d, timeout %d\n", pkt, len,
+ timeout);
+#endif
+
+ t = getsecs();
+ do {
+ length = ub_dev_recv(sc->sc_handle, sc->sc_rxbuf, len);
+ } while ((length == -1 || length == 0) &&
+ (getsecs() - t < timeout));
+
+#if defined(NETIF_DEBUG)
+ printf("net_get: received len %d (%x)\n", length, length);
+#endif
+
+ if (length > 0) {
+ memcpy(pkt, sc->sc_rxbuf, MIN(len, length));
+ if (length != len) {
+#if defined(NETIF_DEBUG)
+ printf("net_get: len %x, length %x\n", len, length);
+#endif
+ }
+ return length;
+ }
+
+ return -1;
+}
+
+
+static void
+net_init(struct iodesc *desc, void *machdep_hint)
+{
+ int i, err;
+ struct netif *nif = desc->io_netif;
+ struct uboot_softc *sc;
+ struct device_info *di;
+
+ sc = nif->nif_devdata = &uboot_softc;
+
+ if (err = ub_dev_open(sc->sc_handle))
+ panic("%s%d: initialisation failed with error %d\n",
+ nif->nif_driver->netif_bname, nif->nif_unit, err);
+
+ /* Get MAC address */
+ di = ub_dev_get(sc->sc_handle);
+ memcpy(desc->myea, di->di_net.hwaddr, 6);
+ if (memcmp (desc->myea, "\0\0\0\0\0\0", 6) == 0) {
+ panic("%s%d: empty ethernet address!",
+ nif->nif_driver->netif_bname, nif->nif_unit);
+ }
+
+#if defined(NETIF_DEBUG)
+ printf("network: %s%d attached to %s\n", nif->nif_driver->netif_bname,
+ nif->nif_unit, ether_sprintf(desc->myea));
+#endif
+
+ /* Set correct alignment for TX packets */
+ sc->sc_txbufp = sc->sc_txbuf;
+ if ((unsigned long)sc->sc_txbufp % PKTALIGN)
+ sc->sc_txbufp += PKTALIGN -
+ (unsigned long)sc->sc_txbufp % PKTALIGN;
+}
+
+
+static void
+net_end(struct netif *nif)
+{
+ int err;
+ struct uboot_softc *sc = nif->nif_devdata;
+
+ if (err = ub_dev_close(sc->sc_handle))
+ panic("%s%d: net_end failed with error %d\n",
+ nif->nif_driver->netif_bname, nif->nif_unit, err);
+}
OpenPOWER on IntegriCloud