This source file includes following definitions.
- krpc_portmap
- krpc_call
- xdr_string_encode
- xdr_string_decode
- xdr_inaddr_encode
- xdr_inaddr_decode
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46 #include <sys/param.h>
47 #include <sys/systm.h>
48 #include <sys/conf.h>
49 #include <sys/ioctl.h>
50 #include <sys/proc.h>
51 #include <sys/mount.h>
52 #include <sys/mbuf.h>
53 #include <sys/reboot.h>
54 #include <sys/socket.h>
55 #include <sys/socketvar.h>
56
57 #include <net/if.h>
58 #include <netinet/in.h>
59
60 #include <nfs/rpcv2.h>
61 #include <nfs/krpc.h>
62 #include <nfs/xdr_subs.h>
63 #include <dev/rndvar.h>
64
65
66
67
68
69
70
71
72
73
74
75 struct auth_info {
76 u_int32_t authtype;
77 u_int32_t authlen;
78 };
79
80 struct auth_unix {
81 int32_t ua_time;
82 int32_t ua_hostname;
83 int32_t ua_uid;
84 int32_t ua_gid;
85 int32_t ua_gidlist;
86 };
87
88 struct rpc_call {
89 u_int32_t rp_xid;
90 int32_t rp_direction;
91 u_int32_t rp_rpcvers;
92 u_int32_t rp_prog;
93 u_int32_t rp_vers;
94 u_int32_t rp_proc;
95 struct auth_info rpc_auth;
96 struct auth_unix rpc_unix;
97 struct auth_info rpc_verf;
98 };
99
100 struct rpc_reply {
101 u_int32_t rp_xid;
102 int32_t rp_direction;
103 int32_t rp_astatus;
104 union {
105 u_int32_t rpu_errno;
106 struct {
107 struct auth_info rok_auth;
108 u_int32_t rok_status;
109 } rpu_rok;
110 } rp_u;
111 };
112 #define rp_errno rp_u.rpu_errno
113 #define rp_auth rp_u.rpu_rok.rok_auth
114 #define rp_status rp_u.rpu_rok.rok_status
115
116 #define MIN_REPLY_HDR 16
117
118
119
120
121
122
123
124 #define MAX_RESEND_DELAY 5
125
126
127
128
129
130 int
131 krpc_portmap(sin, prog, vers, portp)
132 struct sockaddr_in *sin;
133 u_int prog, vers;
134 u_int16_t *portp;
135 {
136 struct sdata {
137 u_int32_t prog;
138 u_int32_t vers;
139 u_int32_t proto;
140 u_int32_t port;
141 } *sdata;
142 struct rdata {
143 u_int16_t pad;
144 u_int16_t port;
145 } *rdata;
146 struct mbuf *m;
147 int error;
148
149
150 if (prog == PMAPPROG) {
151 *portp = htons(PMAPPORT);
152 return 0;
153 }
154
155 m = m_get(M_WAIT, MT_DATA);
156 sdata = mtod(m, struct sdata *);
157 m->m_len = sizeof(*sdata);
158
159
160 sdata->prog = txdr_unsigned(prog);
161 sdata->vers = txdr_unsigned(vers);
162 sdata->proto = txdr_unsigned(IPPROTO_UDP);
163 sdata->port = 0;
164
165 sin->sin_port = htons(PMAPPORT);
166 error = krpc_call(sin, PMAPPROG, PMAPVERS,
167 PMAPPROC_GETPORT, &m, NULL, -1);
168 if (error)
169 return error;
170
171 if (m->m_len < sizeof(*rdata)) {
172 m = m_pullup(m, sizeof(*rdata));
173 if (m == NULL)
174 return ENOBUFS;
175 }
176 rdata = mtod(m, struct rdata *);
177 *portp = rdata->port;
178
179 m_freem(m);
180 return 0;
181 }
182
183
184
185
186
187
188 int
189 krpc_call(sa, prog, vers, func, data, from_p, retries)
190 struct sockaddr_in *sa;
191 u_int prog, vers, func;
192 struct mbuf **data;
193 struct mbuf **from_p;
194 int retries;
195 {
196 struct socket *so;
197 struct sockaddr_in *sin;
198 struct mbuf *m, *nam, *mhead, *from, *mopt;
199 struct rpc_call *call;
200 struct rpc_reply *reply;
201 struct uio auio;
202 int error, rcvflg, timo, secs, len;
203 static u_int32_t xid = 0;
204 u_int32_t newxid;
205 int *ip;
206 struct timeval *tv;
207
208
209
210
211
212 if (sa->sin_family != AF_INET)
213 return (EAFNOSUPPORT);
214
215
216 nam = mhead = NULL;
217 from = NULL;
218
219
220
221
222 if ((error = socreate(AF_INET, &so, SOCK_DGRAM, 0)))
223 goto out;
224
225 m = m_get(M_WAIT, MT_SOOPTS);
226 tv = mtod(m, struct timeval *);
227 m->m_len = sizeof(*tv);
228 tv->tv_sec = 1;
229 tv->tv_usec = 0;
230 if ((error = sosetopt(so, SOL_SOCKET, SO_RCVTIMEO, m)))
231 goto out;
232
233
234
235
236 if (from_p) {
237 int32_t *on;
238 m = m_get(M_WAIT, MT_SOOPTS);
239 on = mtod(m, int32_t *);
240 m->m_len = sizeof(*on);
241 *on = 1;
242 if ((error = sosetopt(so, SOL_SOCKET, SO_BROADCAST, m)))
243 goto out;
244 }
245
246
247
248
249
250
251 m = m_getclr(M_WAIT, MT_SONAME);
252 sin = mtod(m, struct sockaddr_in *);
253 sin->sin_len = m->m_len = sizeof(*sin);
254 sin->sin_family = AF_INET;
255 sin->sin_addr.s_addr = INADDR_ANY;
256
257 MGET(mopt, M_WAIT, MT_SOOPTS);
258 mopt->m_len = sizeof(int);
259 ip = mtod(mopt, int *);
260 *ip = IP_PORTRANGE_LOW;
261 error = sosetopt(so, IPPROTO_IP, IP_PORTRANGE, mopt);
262 if (error)
263 goto out;
264
265 MGET(m, M_WAIT, MT_SONAME);
266 sin = mtod(m, struct sockaddr_in *);
267 sin->sin_len = m->m_len = sizeof (struct sockaddr_in);
268 sin->sin_family = AF_INET;
269 sin->sin_addr.s_addr = INADDR_ANY;
270 sin->sin_port = htons(0);
271 error = sobind(so, m);
272 m_freem(m);
273 if (error) {
274 printf("bind failed\n");
275 goto out;
276 }
277
278 MGET(mopt, M_WAIT, MT_SOOPTS);
279 mopt->m_len = sizeof(int);
280 ip = mtod(mopt, int *);
281 *ip = IP_PORTRANGE_DEFAULT;
282 error = sosetopt(so, IPPROTO_IP, IP_PORTRANGE, mopt);
283 if (error)
284 goto out;
285
286
287
288
289 nam = m_get(M_WAIT, MT_SONAME);
290 sin = mtod(nam, struct sockaddr_in *);
291 bcopy((caddr_t)sa, (caddr_t)sin, (nam->m_len = sa->sin_len));
292
293
294
295
296 mhead = m_gethdr(M_WAIT, MT_DATA);
297 mhead->m_next = *data;
298 call = mtod(mhead, struct rpc_call *);
299 mhead->m_len = sizeof(*call);
300 bzero((caddr_t)call, sizeof(*call));
301
302 while ((newxid = arc4random()) == xid);
303 xid = newxid;
304 call->rp_xid = txdr_unsigned(xid);
305
306 call->rp_rpcvers = txdr_unsigned(2);
307 call->rp_prog = txdr_unsigned(prog);
308 call->rp_vers = txdr_unsigned(vers);
309 call->rp_proc = txdr_unsigned(func);
310
311 call->rpc_auth.authtype = txdr_unsigned(RPCAUTH_UNIX);
312 call->rpc_auth.authlen = txdr_unsigned(sizeof(struct auth_unix));
313
314 call->rpc_verf.authtype = 0;
315 call->rpc_verf.authlen = 0;
316
317
318
319
320 len = 0;
321 m = mhead;
322 while (m) {
323 len += m->m_len;
324 m = m->m_next;
325 }
326 mhead->m_pkthdr.len = len;
327 mhead->m_pkthdr.rcvif = NULL;
328
329
330
331
332
333
334 for (timo = 0; retries; retries--) {
335
336 m = m_copym(mhead, 0, M_COPYALL, M_WAIT);
337 if (m == NULL) {
338 error = ENOBUFS;
339 goto out;
340 }
341 error = sosend(so, nam, NULL, m, NULL, 0);
342 if (error) {
343 printf("krpc_call: sosend: %d\n", error);
344 goto out;
345 }
346 m = NULL;
347
348
349 if (timo < MAX_RESEND_DELAY)
350 timo++;
351 else
352 printf("RPC timeout for server %s (0x%x) prog %u\n",
353 inet_ntoa(sin->sin_addr),
354 ntohl(sin->sin_addr.s_addr), prog);
355
356
357
358
359
360 secs = timo;
361 while (secs > 0) {
362 if (from) {
363 m_freem(from);
364 from = NULL;
365 }
366 if (m) {
367 m_freem(m);
368 m = NULL;
369 }
370 auio.uio_resid = len = 1<<16;
371 auio.uio_procp = NULL;
372 rcvflg = 0;
373 error = soreceive(so, &from, &auio, &m, NULL, &rcvflg);
374 if (error == EWOULDBLOCK) {
375 secs--;
376 continue;
377 }
378 if (error)
379 goto out;
380 len -= auio.uio_resid;
381
382
383 if (len < MIN_REPLY_HDR)
384 continue;
385 if (m->m_len < MIN_REPLY_HDR)
386 continue;
387 reply = mtod(m, struct rpc_reply *);
388
389
390 if (reply->rp_direction != txdr_unsigned(RPC_REPLY))
391 continue;
392
393 if (reply->rp_xid != txdr_unsigned(xid))
394 continue;
395
396
397 if (reply->rp_astatus != 0) {
398 error = fxdr_unsigned(u_int32_t, reply->rp_errno);
399 printf("rpc denied, error=%d\n", error);
400 continue;
401 }
402
403
404 if (reply->rp_status != 0) {
405 error = fxdr_unsigned(u_int32_t, reply->rp_status);
406 printf("rpc denied, status=%d\n", error);
407 continue;
408 }
409
410 goto gotreply;
411
412 }
413 }
414
415 error = ETIMEDOUT;
416 goto out;
417
418 gotreply:
419
420
421
422
423
424 len = sizeof(*reply);
425 if (m->m_len < len) {
426 m = m_pullup(m, len);
427 if (m == NULL) {
428 error = ENOBUFS;
429 goto out;
430 }
431 }
432 reply = mtod(m, struct rpc_reply *);
433 if (reply->rp_auth.authtype != 0) {
434 len += fxdr_unsigned(u_int32_t, reply->rp_auth.authlen);
435 len = (len + 3) & ~3;
436 }
437 m_adj(m, len);
438
439
440 *data = m;
441 if (from_p) {
442 *from_p = from;
443 from = NULL;
444 }
445
446 out:
447 if (nam) m_freem(nam);
448 if (mhead) m_freem(mhead);
449 if (from) m_freem(from);
450 soclose(so);
451 return error;
452 }
453
454
455
456
457
458
459
460
461
462 struct xdr_string {
463 u_int32_t len;
464 char data[4];
465
466 };
467
468 struct mbuf *
469 xdr_string_encode(str, len)
470 char *str;
471 int len;
472 {
473 struct mbuf *m;
474 struct xdr_string *xs;
475 int dlen;
476 int mlen;
477
478 dlen = (len + 3) & ~3;
479 mlen = dlen + 4;
480
481 if (mlen > MCLBYTES)
482 return (NULL);
483
484 m = m_get(M_WAIT, MT_DATA);
485 if (mlen > MLEN) {
486 MCLGET(m, M_WAIT);
487 if ((m->m_flags & M_EXT) == 0) {
488 (void) m_free(m);
489 return (NULL);
490 }
491 }
492 xs = mtod(m, struct xdr_string *);
493 m->m_len = mlen;
494 xs->len = txdr_unsigned(len);
495 bcopy(str, xs->data, len);
496 return (m);
497 }
498
499 struct mbuf *
500 xdr_string_decode(m, str, len_p)
501 struct mbuf *m;
502 char *str;
503 int *len_p;
504 {
505 struct xdr_string *xs;
506 int mlen;
507 int slen;
508
509 if (m->m_len < 4) {
510 m = m_pullup(m, 4);
511 if (m == NULL)
512 return (NULL);
513 }
514 xs = mtod(m, struct xdr_string *);
515 slen = fxdr_unsigned(u_int32_t, xs->len);
516 mlen = 4 + ((slen + 3) & ~3);
517
518 if (slen > *len_p)
519 slen = *len_p;
520 if (slen > m->m_pkthdr.len) {
521 m_freem(m);
522 return (NULL);
523 }
524 m_copydata(m, 4, slen, str);
525 m_adj(m, mlen);
526
527 str[slen] = '\0';
528 *len_p = slen;
529
530 return (m);
531 }
532
533
534
535
536
537
538 struct xdr_inaddr {
539 u_int32_t atype;
540 u_int32_t addr[4];
541 };
542
543 struct mbuf *
544 xdr_inaddr_encode(ia)
545 struct in_addr *ia;
546 {
547 struct mbuf *m;
548 struct xdr_inaddr *xi;
549 u_int8_t *cp;
550 u_int32_t *ip;
551
552 m = m_get(M_WAIT, MT_DATA);
553 xi = mtod(m, struct xdr_inaddr *);
554 m->m_len = sizeof(*xi);
555 xi->atype = txdr_unsigned(1);
556 ip = xi->addr;
557 cp = (u_int8_t *)&ia->s_addr;
558 *ip++ = txdr_unsigned(*cp++);
559 *ip++ = txdr_unsigned(*cp++);
560 *ip++ = txdr_unsigned(*cp++);
561 *ip++ = txdr_unsigned(*cp++);
562
563 return (m);
564 }
565
566 struct mbuf *
567 xdr_inaddr_decode(m, ia)
568 struct mbuf *m;
569 struct in_addr *ia;
570 {
571 struct xdr_inaddr *xi;
572 u_int8_t *cp;
573 u_int32_t *ip;
574
575 if (m->m_len < sizeof(*xi)) {
576 m = m_pullup(m, sizeof(*xi));
577 if (m == NULL)
578 return (NULL);
579 }
580 xi = mtod(m, struct xdr_inaddr *);
581 if (xi->atype != txdr_unsigned(1)) {
582 ia->s_addr = INADDR_ANY;
583 goto out;
584 }
585 ip = xi->addr;
586 cp = (u_int8_t *)&ia->s_addr;
587 *cp++ = fxdr_unsigned(u_int8_t, *ip++);
588 *cp++ = fxdr_unsigned(u_int8_t, *ip++);
589 *cp++ = fxdr_unsigned(u_int8_t, *ip++);
590 *cp++ = fxdr_unsigned(u_int8_t, *ip++);
591
592 out:
593 m_adj(m, sizeof(*xi));
594 return (m);
595 }