Home | History | Annotate | Line # | Download | only in boot2440
      1  1.1  nisimura /*-
      2  1.1  nisimura  * Copyright (c) 2012 The NetBSD Foundation, Inc.
      3  1.1  nisimura  * All rights reserved.
      4  1.1  nisimura  *
      5  1.1  nisimura  * This code is derived from software contributed to The NetBSD Foundation
      6  1.1  nisimura  * by Paul Fleischer <paul (at) xpg.dk>
      7  1.1  nisimura  *
      8  1.1  nisimura  * Redistribution and use in source and binary forms, with or without
      9  1.1  nisimura  * modification, are permitted provided that the following conditions
     10  1.1  nisimura  * are met:
     11  1.1  nisimura  * 1. Redistributions of source code must retain the above copyright
     12  1.1  nisimura  *    notice, this list of conditions and the following disclaimer.
     13  1.1  nisimura  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.1  nisimura  *    notice, this list of conditions and the following disclaimer in the
     15  1.1  nisimura  *    documentation and/or other materials provided with the distribution.
     16  1.1  nisimura  *
     17  1.1  nisimura  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     18  1.1  nisimura  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     19  1.1  nisimura  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     20  1.1  nisimura  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     21  1.1  nisimura  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     22  1.1  nisimura  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     23  1.1  nisimura  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     24  1.1  nisimura  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     25  1.1  nisimura  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     26  1.1  nisimura  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     27  1.1  nisimura  * POSSIBILITY OF SUCH DAMAGE.
     28  1.1  nisimura  */
     29  1.1  nisimura /*
     30  1.1  nisimura  * This file is based on arch/sandpoint/stand/netboot/nif.c
     31  1.1  nisimura  */
     32  1.1  nisimura 
     33  1.1  nisimura #include <sys/types.h>
     34  1.1  nisimura 
     35  1.1  nisimura #include <netinet/in.h>
     36  1.1  nisimura 
     37  1.1  nisimura #include <lib/libsa/stand.h>
     38  1.1  nisimura #include <lib/libsa/iodesc.h>
     39  1.1  nisimura 
     40  1.1  nisimura #include "dm9k.h"
     41  1.1  nisimura #include <arch/evbarm/mini2440/mini2440_bootinfo.h>
     42  1.1  nisimura 
     43  1.1  nisimura extern struct btinfo_rootdevice bi_rdev;
     44  1.1  nisimura extern struct btinfo_net	bi_net;
     45  1.1  nisimura 
     46  1.1  nisimura struct nifdv {
     47  1.1  nisimura 	char *name;
     48  1.1  nisimura 	int (*match)(unsigned, void *);
     49  1.1  nisimura 	void *(*init)(unsigned, void *);
     50  1.1  nisimura 	int (*send)(void *, char *, unsigned);
     51  1.1  nisimura 	int (*recv)(void *, char *, unsigned, unsigned);
     52  1.1  nisimura 	int (*halt)(void *, int);
     53  1.1  nisimura 	void *priv;
     54  1.1  nisimura };
     55  1.1  nisimura 
     56  1.1  nisimura 
     57  1.1  nisimura static struct nifdv vnifdv[] = {
     58  1.1  nisimura 	{"dme", dm9k_match, dm9k_init, dm9k_send, dm9k_recv}
     59  1.1  nisimura };
     60  1.1  nisimura static int nnifdv = sizeof(vnifdv)/sizeof(vnifdv[0]);
     61  1.1  nisimura static bool nifmatch[sizeof(nnifdv)];
     62  1.1  nisimura //static uint8_t nifaddr[sizeof(nnifdv)][6];
     63  1.1  nisimura 
     64  1.1  nisimura static struct iodesc netdesc;
     65  1.1  nisimura 
     66  1.1  nisimura void netif_match(unsigned int tag, uint8_t *macaddr);
     67  1.1  nisimura int netif_init(unsigned int tag, uint8_t *macaddr);
     68  1.1  nisimura int netif_open(void*);
     69  1.1  nisimura int netif_close(int);
     70  1.1  nisimura 
     71  1.1  nisimura void
     72  1.1  nisimura netif_match(unsigned int tag, uint8_t *macaddr)
     73  1.1  nisimura {
     74  1.1  nisimura 	struct nifdv *dv;
     75  1.1  nisimura 	int n;
     76  1.1  nisimura 
     77  1.1  nisimura 	for (n = 0; n < nnifdv; n++) {
     78  1.1  nisimura 		//memcpy(nifaddr[n], macaddr, sizeof(nifaddr[n]));
     79  1.1  nisimura 		dv = &vnifdv[n];
     80  1.1  nisimura 		if ((*dv->match)(tag, macaddr) > 0) {
     81  1.1  nisimura 			nifmatch[n] = 1;
     82  1.2     joerg 			snprintf(bi_rdev.devname, sizeof(bi_rdev.devname), "%s", dv->name);
     83  1.1  nisimura 			bi_rdev.cookie = tag;
     84  1.1  nisimura 
     85  1.2     joerg 			snprintf(bi_net.devname, sizeof(bi_net.devname), "%s", dv->name);
     86  1.1  nisimura 			bi_net.cookie = tag;
     87  1.1  nisimura 			memcpy(bi_net.mac_address, macaddr, sizeof(bi_net.mac_address));
     88  1.1  nisimura 			break;
     89  1.1  nisimura 		} else {
     90  1.1  nisimura 			nifmatch[n] = 0;
     91  1.1  nisimura 		}
     92  1.1  nisimura 	}
     93  1.1  nisimura }
     94  1.1  nisimura 
     95  1.1  nisimura int
     96  1.1  nisimura netif_init(unsigned int tag, uint8_t *macaddr)
     97  1.1  nisimura {
     98  1.1  nisimura 	struct iodesc *s;
     99  1.1  nisimura 	struct nifdv *dv;
    100  1.1  nisimura 	int n;
    101  1.1  nisimura 	uint8_t enaddr[6];
    102  1.1  nisimura 
    103  1.1  nisimura 	for (n = 0; n < nnifdv; n++) {
    104  1.1  nisimura 		if (nifmatch[n]) {
    105  1.1  nisimura 			dv = &vnifdv[n];
    106  1.1  nisimura 			goto found;
    107  1.1  nisimura 		}
    108  1.1  nisimura 	}
    109  1.1  nisimura 	return 0;
    110  1.1  nisimura  found:
    111  1.1  nisimura 	dv->priv = (*dv->init)(tag, enaddr);
    112  1.1  nisimura 	s = &netdesc;
    113  1.1  nisimura 	s->io_netif = dv;
    114  1.1  nisimura 	memcpy(s->myea, enaddr, sizeof(s->myea));
    115  1.1  nisimura 
    116  1.2     joerg 	snprintf(bi_rdev.devname, sizeof(bi_rdev.devname), "%s", dv->name);
    117  1.1  nisimura 	bi_rdev.cookie = tag;
    118  1.1  nisimura 
    119  1.2     joerg 	snprintf(bi_net.devname, sizeof(bi_net.devname), "%s", dv->name);
    120  1.1  nisimura 	bi_net.cookie = tag;
    121  1.1  nisimura 	memcpy(bi_net.mac_address, enaddr, sizeof(bi_net.mac_address));
    122  1.1  nisimura 	return 1;
    123  1.1  nisimura }
    124  1.1  nisimura 
    125  1.1  nisimura int
    126  1.1  nisimura netif_open (void *cookie)
    127  1.1  nisimura {
    128  1.1  nisimura   return 0;
    129  1.1  nisimura }
    130  1.1  nisimura 
    131  1.1  nisimura int
    132  1.1  nisimura netif_close (int sock)
    133  1.1  nisimura {
    134  1.1  nisimura   return 0;
    135  1.1  nisimura }
    136  1.1  nisimura 
    137  1.1  nisimura 
    138  1.1  nisimura ssize_t
    139  1.1  nisimura netif_put(struct iodesc *desc, void *pkt, size_t len)
    140  1.1  nisimura {
    141  1.1  nisimura 	struct nifdv *dv = desc->io_netif;
    142  1.1  nisimura 
    143  1.1  nisimura 	return (*dv->send)(dv->priv, pkt, len);
    144  1.1  nisimura 
    145  1.1  nisimura }
    146  1.1  nisimura 
    147  1.1  nisimura ssize_t
    148  1.1  nisimura netif_get(struct iodesc *desc, void *pkt, size_t maxlen, saseconds_t timo)
    149  1.1  nisimura {
    150  1.1  nisimura 	struct nifdv *dv = desc->io_netif;
    151  1.1  nisimura 	int len;
    152  1.1  nisimura 
    153  1.1  nisimura 	len = (*dv->recv)(dv->priv, pkt, maxlen, timo);
    154  1.1  nisimura 	return len;
    155  1.1  nisimura }
    156  1.1  nisimura 
    157  1.1  nisimura struct iodesc*
    158  1.1  nisimura socktodesc (int i)
    159  1.1  nisimura {
    160  1.1  nisimura   return (i==0) ? &netdesc : NULL;
    161  1.1  nisimura }
    162