Initial import from FreeBSD RELENG_4:
[dragonfly.git] / lib / libstand / net.c
1 /*      $NetBSD: net.c,v 1.20 1997/12/26 22:41:30 scottr Exp $  */
2
3 /*
4  * Copyright (c) 1992 Regents of the University of California.
5  * All rights reserved.
6  *
7  * This software was developed by the Computer Systems Engineering group
8  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
9  * contributed to Berkeley.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  * 3. All advertising materials mentioning features or use of this software
20  *    must display the following acknowledgement:
21  *      This product includes software developed by the University of
22  *      California, Lawrence Berkeley Laboratory and its contributors.
23  * 4. Neither the name of the University nor the names of its contributors
24  *    may be used to endorse or promote products derived from this software
25  *    without specific prior written permission.
26  *
27  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
28  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
29  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
30  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
31  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
32  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
33  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
34  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
35  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
36  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
37  * SUCH DAMAGE.
38  *
39  * @(#) Header: net.c,v 1.9 93/08/06 19:32:15 leres Exp  (LBL)
40  * $FreeBSD: src/lib/libstand/net.c,v 1.1.1.1.6.1 2000/04/15 03:09:28 ps Exp $
41  */
42
43 #include <sys/param.h>
44 #include <sys/socket.h>
45
46 #include <string.h>
47
48 #include <net/if.h>
49 #include <netinet/in.h>
50 #include <netinet/if_ether.h>
51 #include <netinet/in_systm.h>
52
53 #include <netinet/ip.h>
54 #include <netinet/ip_var.h>
55 #include <netinet/udp.h>
56 #include <netinet/udp_var.h>
57
58 #include "stand.h"
59 #include "net.h"
60
61 /*
62  * Send a packet and wait for a reply, with exponential backoff.
63  *
64  * The send routine must return the actual number of bytes written,
65  * or -1 on error.
66  *
67  * The receive routine can indicate success by returning the number of
68  * bytes read; it can return 0 to indicate EOF; it can return -1 with a
69  * non-zero errno to indicate failure; finally, it can return -1 with a
70  * zero errno to indicate it isn't done yet.
71  */
72 ssize_t
73 sendrecv(d, sproc, sbuf, ssize, rproc, rbuf, rsize)
74         register struct iodesc *d;
75         register ssize_t (*sproc)(struct iodesc *, void *, size_t);
76         register void *sbuf;
77         register size_t ssize;
78         register ssize_t (*rproc)(struct iodesc *, void *, size_t, time_t);
79         register void *rbuf;
80         register size_t rsize;
81 {
82         register ssize_t cc;
83         register time_t t, tmo, tlast;
84         long tleft;
85
86 #ifdef NET_DEBUG
87         if (debug)
88                 printf("sendrecv: called\n");
89 #endif
90
91         tmo = MINTMO;
92         tlast = tleft = 0;
93         t = getsecs();
94         for (;;) {
95                 if (tleft <= 0) {
96                         if (tmo >= MAXTMO) {
97                                 errno = ETIMEDOUT;
98                                 return -1;
99                         }
100                         cc = (*sproc)(d, sbuf, ssize);
101                         if (cc != -1 && cc < ssize)
102                                 panic("sendrecv: short write! (%d < %d)",
103                                     cc, ssize);
104
105                         tleft = tmo;
106                         tmo <<= 1;
107                         if (tmo > MAXTMO)
108                                 tmo = MAXTMO;
109
110                         if (cc == -1) {
111                                 /* Error on transmit; wait before retrying */
112                                 while ((getsecs() - t) < tmo);
113                                 tleft = 0;
114                                 continue;
115                         }
116
117                         tlast = t;
118                 }
119
120                 /* Try to get a packet and process it. */
121                 cc = (*rproc)(d, rbuf, rsize, tleft);
122                 /* Return on data, EOF or real error. */
123                 if (cc != -1 || errno != 0)
124                         return (cc);
125
126                 /* Timed out or didn't get the packet we're waiting for */
127                 t = getsecs();
128                 tleft -= t - tlast;
129                 tlast = t;
130         }
131 }
132
133 /*
134  * Like inet_addr() in the C library, but we only accept base-10.
135  * Return values are in network order.
136  */
137 n_long
138 inet_addr(cp)
139         char *cp;
140 {
141         register u_long val;
142         register int n;
143         register char c;
144         u_int parts[4];
145         register u_int *pp = parts;
146
147         for (;;) {
148                 /*
149                  * Collect number up to ``.''.
150                  * Values are specified as for C:
151                  * 0x=hex, 0=octal, other=decimal.
152                  */
153                 val = 0;
154                 while ((c = *cp) != '\0') {
155                         if (c >= '0' && c <= '9') {
156                                 val = (val * 10) + (c - '0');
157                                 cp++;
158                                 continue;
159                         }
160                         break;
161                 }
162                 if (*cp == '.') {
163                         /*
164                          * Internet format:
165                          *      a.b.c.d
166                          *      a.b.c   (with c treated as 16-bits)
167                          *      a.b     (with b treated as 24 bits)
168                          */
169                         if (pp >= parts + 3 || val > 0xff)
170                                 goto bad;
171                         *pp++ = val, cp++;
172                 } else
173                         break;
174         }
175         /*
176          * Check for trailing characters.
177          */
178         if (*cp != '\0')
179                 goto bad;
180
181         /*
182          * Concoct the address according to
183          * the number of parts specified.
184          */
185         n = pp - parts + 1;
186         switch (n) {
187
188         case 1:                         /* a -- 32 bits */
189                 break;
190
191         case 2:                         /* a.b -- 8.24 bits */
192                 if (val > 0xffffff)
193                         goto bad;
194                 val |= parts[0] << 24;
195                 break;
196
197         case 3:                         /* a.b.c -- 8.8.16 bits */
198                 if (val > 0xffff)
199                         goto bad;
200                 val |= (parts[0] << 24) | (parts[1] << 16);
201                 break;
202
203         case 4:                         /* a.b.c.d -- 8.8.8.8 bits */
204                 if (val > 0xff)
205                         goto bad;
206                 val |= (parts[0] << 24) | (parts[1] << 16) | (parts[2] << 8);
207                 break;
208         }
209
210         return (htonl(val));
211  bad:
212         return (htonl(INADDR_NONE));
213 }
214
215 char *
216 inet_ntoa(ia)
217         struct in_addr ia;
218 {
219         return (intoa(ia.s_addr));
220 }
221
222 /* Similar to inet_ntoa() */
223 char *
224 intoa(addr)
225         register n_long addr;
226 {
227         register char *cp;
228         register u_int byte;
229         register int n;
230         static char buf[17];    /* strlen(".255.255.255.255") + 1 */
231
232         NTOHL(addr);
233         cp = &buf[sizeof buf];
234         *--cp = '\0';
235
236         n = 4;
237         do {
238                 byte = addr & 0xff;
239                 *--cp = byte % 10 + '0';
240                 byte /= 10;
241                 if (byte > 0) {
242                         *--cp = byte % 10 + '0';
243                         byte /= 10;
244                         if (byte > 0)
245                                 *--cp = byte + '0';
246                 }
247                 *--cp = '.';
248                 addr >>= 8;
249         } while (--n > 0);
250
251         return (cp+1);
252 }
253
254 static char *
255 number(s, n)
256         char *s;
257         int *n;
258 {
259         for (*n = 0; isdigit(*s); s++)
260                 *n = (*n * 10) + *s - '0';
261         return s;
262 }
263
264 n_long
265 ip_convertaddr(p)
266         char *p;
267 {
268 #define IP_ANYADDR      0
269         n_long addr = 0, n;
270
271         if (p == (char *)0 || *p == '\0')
272                 return IP_ANYADDR;
273         p = number(p, &n);
274         addr |= (n << 24) & 0xff000000;
275         if (*p == '\0' || *p++ != '.')
276                 return IP_ANYADDR;
277         p = number(p, &n);
278         addr |= (n << 16) & 0xff0000;
279         if (*p == '\0' || *p++ != '.')
280                 return IP_ANYADDR;
281         p = number(p, &n);
282         addr |= (n << 8) & 0xff00;
283         if (*p == '\0' || *p++ != '.')
284                 return IP_ANYADDR;
285         p = number(p, &n);
286         addr |= n & 0xff;
287         if (*p != '\0')
288                 return IP_ANYADDR;
289
290         return htonl(addr);
291 }