initial commit
[freebsd-arm:freebsd-arm.git] / boot / ofw / libofw / ofw_net.c
1 /*-
2  * Copyright (c) 2000-2001 Benno Rice
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 Benno Rice ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER 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
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29
30 #include <sys/param.h>
31 #include <sys/types.h>
32 #include <sys/socket.h>
33
34 #include <net/if.h>
35 #include <netinet/in.h>
36 #include <netinet/in_systm.h>
37 #include <netinet/if_ether.h>
38 #include <netinet/ip.h>
39
40 #include <stand.h>
41 #include <net.h>
42 #include <netif.h>
43
44 #include "openfirm.h"
45
46 static int      ofwn_probe(struct netif *, void *);
47 static int      ofwn_match(struct netif *, void *);
48 static void     ofwn_init(struct iodesc *, void *);
49 static int      ofwn_get(struct iodesc *, void *, size_t, time_t);
50 static int      ofwn_put(struct iodesc *, void *, size_t);
51 static void     ofwn_end(struct netif *);
52
53 extern struct netif_stats       ofwn_stats[];
54
55 struct netif_dif ofwn_ifs[] = {
56         /*      dif_unit        dif_nsel        dif_stats       dif_private     */
57         {       0,              1,              &ofwn_stats[0], 0,      },
58 };
59
60 struct netif_stats ofwn_stats[NENTS(ofwn_ifs)];
61
62 struct netif_driver ofwnet = {
63         "net",                  /* netif_bname */
64         ofwn_match,             /* netif_match */
65         ofwn_probe,             /* netif_probe */
66         ofwn_init,              /* netif_init */
67         ofwn_get,               /* netif_get */
68         ofwn_put,               /* netif_put */
69         ofwn_end,               /* netif_end */
70         ofwn_ifs,               /* netif_ifs */
71         NENTS(ofwn_ifs)         /* netif_nifs */
72 };
73
74 static ihandle_t        netinstance;
75
76 static void             *dmabuf;
77
78 static int
79 ofwn_match(struct netif *nif, void *machdep_hint)
80 {
81         return 1;
82 }
83
84 static int
85 ofwn_probe(struct netif *nif, void *machdep_hint)
86 {
87         return 0;
88 }
89
90 static int
91 ofwn_put(struct iodesc *desc, void *pkt, size_t len)
92 {
93         struct ether_header     *eh;
94         size_t                  sendlen;
95         ssize_t                 rv;
96
97 #if defined(NETIF_DEBUG)
98         printf("netif_put: desc=0x%x pkt=0x%x len=%d\n", desc, pkt, len);
99         eh = pkt;
100         printf("dst: %s ", ether_sprintf(eh->ether_dhost));
101         printf("src: %s ", ether_sprintf(eh->ether_shost));
102         printf("type: 0x%x\n", eh->ether_type & 0xffff);
103 #endif
104
105         sendlen = len;
106         if (sendlen < 60) {
107                 sendlen = 60;
108 #if defined(NETIF_DEBUG)
109                 printf("netif_put: length padded to %d\n", sendlen);
110 #endif
111         }
112
113         if (dmabuf) {
114                 bcopy(pkt, dmabuf, sendlen);
115                 pkt = dmabuf;
116         }
117
118         rv = OF_write(netinstance, pkt, len);
119
120 #if defined(NETIF_DEBUG)
121         printf("netif_put: OF_write returned %d\n", rv);
122 #endif
123
124         return rv;
125 }
126
127 static int
128 ofwn_get(struct iodesc *desc, void *pkt, size_t len, time_t timeout)
129 {
130         time_t  t;
131         int     length;
132
133 #if defined(NETIF_DEBUG)
134         printf("netif_get: pkt=%p, maxlen=%d, timeout=%d\n", pkt, len,
135             timeout);
136 #endif
137
138         t = getsecs();
139         do {
140                 length = OF_read(netinstance, pkt, len);
141         } while ((length == -2 || length == 0) &&
142                 (getsecs() - t < timeout));
143
144 #if defined(NETIF_DEBUG)
145         printf("netif_get: received length=%d (%x)\n", length, length);
146 #endif
147
148         if (length < 12)
149                 return -1;
150
151 #if defined(NETIF_VERBOSE_DEBUG)
152         {
153                 char *ch = pkt;
154                 int i;
155
156                 for(i = 0; i < 96; i += 4) {
157                         printf("%02x%02x%02x%02x  ", ch[i], ch[i+1],
158                             ch[i+2], ch[i+3]);
159                 }
160                 printf("\n");
161         }
162 #endif
163
164 #if defined(NETIF_DEBUG)
165         {
166                 struct ether_header *eh = pkt;
167
168                 printf("dst: %s ", ether_sprintf(eh->ether_dhost));
169                 printf("src: %s ", ether_sprintf(eh->ether_shost));
170                 printf("type: 0x%x\n", eh->ether_type & 0xffff);
171         }
172 #endif
173
174         return length;
175 }
176
177 extern char *strchr();
178
179 static void
180 ofwn_init(struct iodesc *desc, void *machdep_hint)
181 {
182         phandle_t       netdev;
183         char            path[64];
184         char            *ch;
185         int             pathlen;
186
187         pathlen = OF_getprop(chosen, "bootpath", path, 64);
188         if ((ch = index(path, ':')) != NULL)
189                 *ch = '\0';
190         netdev = OF_finddevice(path);
191 #ifdef __sparc64__
192         if (OF_getprop(netdev, "mac-address", desc->myea, 6) == -1)
193 #else
194         if (OF_getprop(netdev, "local-mac-address", desc->myea, 6) == -1)
195 #endif
196                 goto punt;
197
198         printf("boot: ethernet address: %s\n", ether_sprintf(desc->myea));
199
200         if ((netinstance = OF_open(path)) == -1) {
201                 printf("Could not open network device.\n");
202                 goto punt;
203         }
204
205 #if defined(NETIF_DEBUG)
206         printf("ofwn_init: Open Firmware instance handle: %08x\n", netinstance);
207 #endif
208
209 #ifndef __sparc64__
210         dmabuf = NULL;
211         if (OF_call_method("dma-alloc", netinstance, 1, 1, (64 * 1024), &dmabuf)
212             < 0) {   
213                 printf("Failed to allocate DMA buffer (got %08x).\n", dmabuf);
214                 goto punt;
215         }
216
217 #if defined(NETIF_DEBUG)
218         printf("ofwn_init: allocated DMA buffer: %08x\n", dmabuf);
219 #endif
220 #endif
221
222         return;
223
224 punt:
225         printf("\n");
226         printf("Could not boot from %s.\n", path);
227         OF_enter();
228 }
229
230 static void
231 ofwn_end(struct netif *nif)
232 {
233         OF_call_method("dma-free", netinstance, 2, 0, dmabuf, MAXPHYS);
234         OF_close(netinstance);
235 }
236
237 #if 0
238 int
239 ofwn_getunit(const char *path)
240 {
241         int             i;
242         char            newpath[255];
243
244         OF_canon(path, newpath, 254);
245
246         for (i = 0; i < nofwninfo; i++) {
247                 printf(">>> test =\t%s\n", ofwninfo[i].ofwn_path);
248                 if (strcmp(path, ofwninfo[i].ofwn_path) == 0)
249                         return i;
250
251                 if (strcmp(newpath, ofwninfo[i].ofwn_path) == 0)
252                         return i;
253         }
254
255         return -1;
256 }
257 #endif