]> git.ipfire.org Git - people/ms/u-boot.git/blob - net/nfs.c
net: nfs: Move some prints to debug statements
[people/ms/u-boot.git] / net / nfs.c
1 /*
2 * NFS support driver - based on etherboot and U-BOOT's tftp.c
3 *
4 * Masami Komiya <mkomiya@sonare.it> 2004
5 *
6 */
7
8 /* NOTE: the NFS code is heavily inspired by the NetBSD netboot code (read:
9 * large portions are copied verbatim) as distributed in OSKit 0.97. A few
10 * changes were necessary to adapt the code to Etherboot and to fix several
11 * inconsistencies. Also the RPC message preparation is done "by hand" to
12 * avoid adding netsprintf() which I find hard to understand and use. */
13
14 /* NOTE 2: Etherboot does not care about things beyond the kernel image, so
15 * it loads the kernel image off the boot server (ARP_SERVER) and does not
16 * access the client root disk (root-path in dhcpd.conf), which would use
17 * ARP_ROOTSERVER. The root disk is something the operating system we are
18 * about to load needs to use. This is different from the OSKit 0.97 logic. */
19
20 /* NOTE 3: Symlink handling introduced by Anselm M Hoffmeister, 2003-July-14
21 * If a symlink is encountered, it is followed as far as possible (recursion
22 * possible, maximum 16 steps). There is no clearing of ".."'s inside the
23 * path, so please DON'T DO THAT. thx. */
24
25 /* NOTE 4: NFSv3 support added by Guillaume GARDET, 2016-June-20.
26 * NFSv2 is still used by default. But if server does not support NFSv2, then
27 * NFSv3 is used, if available on NFS server. */
28
29 #include <common.h>
30 #include <command.h>
31 #include <net.h>
32 #include <malloc.h>
33 #include <mapmem.h>
34 #include "nfs.h"
35 #include "bootp.h"
36
37 #define HASHES_PER_LINE 65 /* Number of "loading" hashes per line */
38 #define NFS_RETRY_COUNT 30
39 #ifndef CONFIG_NFS_TIMEOUT
40 # define NFS_TIMEOUT 2000UL
41 #else
42 # define NFS_TIMEOUT CONFIG_NFS_TIMEOUT
43 #endif
44
45 #define NFS_RPC_ERR 1
46 #define NFS_RPC_DROP 124
47
48 static int fs_mounted;
49 static unsigned long rpc_id;
50 static int nfs_offset = -1;
51 static int nfs_len;
52 static ulong nfs_timeout = NFS_TIMEOUT;
53
54 static char dirfh[NFS_FHSIZE]; /* NFSv2 / NFSv3 file handle of directory */
55 static char filefh[NFS3_FHSIZE]; /* NFSv2 / NFSv3 file handle */
56 static int filefh3_length; /* (variable) length of filefh when NFSv3 */
57
58 static enum net_loop_state nfs_download_state;
59 static struct in_addr nfs_server_ip;
60 static int nfs_server_mount_port;
61 static int nfs_server_port;
62 static int nfs_our_port;
63 static int nfs_timeout_count;
64 static int nfs_state;
65 #define STATE_PRCLOOKUP_PROG_MOUNT_REQ 1
66 #define STATE_PRCLOOKUP_PROG_NFS_REQ 2
67 #define STATE_MOUNT_REQ 3
68 #define STATE_UMOUNT_REQ 4
69 #define STATE_LOOKUP_REQ 5
70 #define STATE_READ_REQ 6
71 #define STATE_READLINK_REQ 7
72
73 static char *nfs_filename;
74 static char *nfs_path;
75 static char nfs_path_buff[2048];
76
77 #define NFSV2_FLAG 1
78 #define NFSV3_FLAG 1 << 1
79 static char supported_nfs_versions = NFSV2_FLAG | NFSV3_FLAG;
80
81 static inline int store_block(uchar *src, unsigned offset, unsigned len)
82 {
83 ulong newsize = offset + len;
84 #ifdef CONFIG_SYS_DIRECT_FLASH_NFS
85 int i, rc = 0;
86
87 for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; i++) {
88 /* start address in flash? */
89 if (load_addr + offset >= flash_info[i].start[0]) {
90 rc = 1;
91 break;
92 }
93 }
94
95 if (rc) { /* Flash is destination for this packet */
96 rc = flash_write((uchar *)src, (ulong)(load_addr+offset), len);
97 if (rc) {
98 flash_perror(rc);
99 return -1;
100 }
101 } else
102 #endif /* CONFIG_SYS_DIRECT_FLASH_NFS */
103 {
104 void *ptr = map_sysmem(load_addr + offset, len);
105
106 memcpy(ptr, src, len);
107 unmap_sysmem(ptr);
108 }
109
110 if (net_boot_file_size < (offset + len))
111 net_boot_file_size = newsize;
112 return 0;
113 }
114
115 static char *basename(char *path)
116 {
117 char *fname;
118
119 fname = path + strlen(path) - 1;
120 while (fname >= path) {
121 if (*fname == '/') {
122 fname++;
123 break;
124 }
125 fname--;
126 }
127 return fname;
128 }
129
130 static char *dirname(char *path)
131 {
132 char *fname;
133
134 fname = basename(path);
135 --fname;
136 *fname = '\0';
137 return path;
138 }
139
140 /**************************************************************************
141 RPC_ADD_CREDENTIALS - Add RPC authentication/verifier entries
142 **************************************************************************/
143 static uint32_t *rpc_add_credentials(uint32_t *p)
144 {
145 int hl;
146 int hostnamelen;
147 char hostname[256];
148
149 strcpy(hostname, "");
150 hostnamelen = strlen(hostname);
151
152 /* Here's the executive summary on authentication requirements of the
153 * various NFS server implementations: Linux accepts both AUTH_NONE
154 * and AUTH_UNIX authentication (also accepts an empty hostname field
155 * in the AUTH_UNIX scheme). *BSD refuses AUTH_NONE, but accepts
156 * AUTH_UNIX (also accepts an empty hostname field in the AUTH_UNIX
157 * scheme). To be safe, use AUTH_UNIX and pass the hostname if we have
158 * it (if the BOOTP/DHCP reply didn't give one, just use an empty
159 * hostname). */
160
161 hl = (hostnamelen + 3) & ~3;
162
163 /* Provide an AUTH_UNIX credential. */
164 *p++ = htonl(1); /* AUTH_UNIX */
165 *p++ = htonl(hl+20); /* auth length */
166 *p++ = htonl(0); /* stamp */
167 *p++ = htonl(hostnamelen); /* hostname string */
168 if (hostnamelen & 3)
169 *(p + hostnamelen / 4) = 0; /* add zero padding */
170 memcpy(p, hostname, hostnamelen);
171 p += hl / 4;
172 *p++ = 0; /* uid */
173 *p++ = 0; /* gid */
174 *p++ = 0; /* auxiliary gid list */
175
176 /* Provide an AUTH_NONE verifier. */
177 *p++ = 0; /* AUTH_NONE */
178 *p++ = 0; /* auth length */
179
180 return p;
181 }
182
183 /**************************************************************************
184 RPC_LOOKUP - Lookup RPC Port numbers
185 **************************************************************************/
186 static void rpc_req(int rpc_prog, int rpc_proc, uint32_t *data, int datalen)
187 {
188 struct rpc_t rpc_pkt;
189 unsigned long id;
190 uint32_t *p;
191 int pktlen;
192 int sport;
193
194 id = ++rpc_id;
195 rpc_pkt.u.call.id = htonl(id);
196 rpc_pkt.u.call.type = htonl(MSG_CALL);
197 rpc_pkt.u.call.rpcvers = htonl(2); /* use RPC version 2 */
198 rpc_pkt.u.call.prog = htonl(rpc_prog);
199 switch (rpc_prog) {
200 case PROG_NFS:
201 if (supported_nfs_versions & NFSV2_FLAG)
202 rpc_pkt.u.call.vers = htonl(2); /* NFS v2 */
203 else /* NFSV3_FLAG */
204 rpc_pkt.u.call.vers = htonl(3); /* NFS v3 */
205 break;
206 case PROG_PORTMAP:
207 case PROG_MOUNT:
208 default:
209 rpc_pkt.u.call.vers = htonl(2); /* portmapper is version 2 */
210 }
211 rpc_pkt.u.call.proc = htonl(rpc_proc);
212 p = (uint32_t *)&(rpc_pkt.u.call.data);
213
214 if (datalen)
215 memcpy((char *)p, (char *)data, datalen*sizeof(uint32_t));
216
217 pktlen = (char *)p + datalen * sizeof(uint32_t) - (char *)&rpc_pkt;
218
219 memcpy((char *)net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE,
220 &rpc_pkt.u.data[0], pktlen);
221
222 if (rpc_prog == PROG_PORTMAP)
223 sport = SUNRPC_PORT;
224 else if (rpc_prog == PROG_MOUNT)
225 sport = nfs_server_mount_port;
226 else
227 sport = nfs_server_port;
228
229 net_send_udp_packet(net_server_ethaddr, nfs_server_ip, sport,
230 nfs_our_port, pktlen);
231 }
232
233 /**************************************************************************
234 RPC_LOOKUP - Lookup RPC Port numbers
235 **************************************************************************/
236 static void rpc_lookup_req(int prog, int ver)
237 {
238 uint32_t data[16];
239
240 data[0] = 0; data[1] = 0; /* auth credential */
241 data[2] = 0; data[3] = 0; /* auth verifier */
242 data[4] = htonl(prog);
243 data[5] = htonl(ver);
244 data[6] = htonl(17); /* IP_UDP */
245 data[7] = 0;
246 rpc_req(PROG_PORTMAP, PORTMAP_GETPORT, data, 8);
247 }
248
249 /**************************************************************************
250 NFS_MOUNT - Mount an NFS Filesystem
251 **************************************************************************/
252 static void nfs_mount_req(char *path)
253 {
254 uint32_t data[1024];
255 uint32_t *p;
256 int len;
257 int pathlen;
258
259 pathlen = strlen(path);
260
261 p = &(data[0]);
262 p = rpc_add_credentials(p);
263
264 *p++ = htonl(pathlen);
265 if (pathlen & 3)
266 *(p + pathlen / 4) = 0;
267 memcpy(p, path, pathlen);
268 p += (pathlen + 3) / 4;
269
270 len = (uint32_t *)p - (uint32_t *)&(data[0]);
271
272 rpc_req(PROG_MOUNT, MOUNT_ADDENTRY, data, len);
273 }
274
275 /**************************************************************************
276 NFS_UMOUNTALL - Unmount all our NFS Filesystems on the Server
277 **************************************************************************/
278 static void nfs_umountall_req(void)
279 {
280 uint32_t data[1024];
281 uint32_t *p;
282 int len;
283
284 if ((nfs_server_mount_port == -1) || (!fs_mounted))
285 /* Nothing mounted, nothing to umount */
286 return;
287
288 p = &(data[0]);
289 p = rpc_add_credentials(p);
290
291 len = (uint32_t *)p - (uint32_t *)&(data[0]);
292
293 rpc_req(PROG_MOUNT, MOUNT_UMOUNTALL, data, len);
294 }
295
296 /***************************************************************************
297 * NFS_READLINK (AH 2003-07-14)
298 * This procedure is called when read of the first block fails -
299 * this probably happens when it's a directory or a symlink
300 * In case of successful readlink(), the dirname is manipulated,
301 * so that inside the nfs() function a recursion can be done.
302 **************************************************************************/
303 static void nfs_readlink_req(void)
304 {
305 uint32_t data[1024];
306 uint32_t *p;
307 int len;
308
309 p = &(data[0]);
310 p = rpc_add_credentials(p);
311
312 if (supported_nfs_versions & NFSV2_FLAG) {
313 memcpy(p, filefh, NFS_FHSIZE);
314 p += (NFS_FHSIZE / 4);
315 } else { /* NFSV3_FLAG */
316 *p++ = htonl(filefh3_length);
317 memcpy(p, filefh, filefh3_length);
318 p += (filefh3_length / 4);
319 }
320
321 len = (uint32_t *)p - (uint32_t *)&(data[0]);
322
323 rpc_req(PROG_NFS, NFS_READLINK, data, len);
324 }
325
326 /**************************************************************************
327 NFS_LOOKUP - Lookup Pathname
328 **************************************************************************/
329 static void nfs_lookup_req(char *fname)
330 {
331 uint32_t data[1024];
332 uint32_t *p;
333 int len;
334 int fnamelen;
335
336 fnamelen = strlen(fname);
337
338 p = &(data[0]);
339 p = rpc_add_credentials(p);
340
341 if (supported_nfs_versions & NFSV2_FLAG) {
342 memcpy(p, dirfh, NFS_FHSIZE);
343 p += (NFS_FHSIZE / 4);
344 *p++ = htonl(fnamelen);
345 if (fnamelen & 3)
346 *(p + fnamelen / 4) = 0;
347 memcpy(p, fname, fnamelen);
348 p += (fnamelen + 3) / 4;
349
350 len = (uint32_t *)p - (uint32_t *)&(data[0]);
351
352 rpc_req(PROG_NFS, NFS_LOOKUP, data, len);
353 } else { /* NFSV3_FLAG */
354 *p++ = htonl(NFS_FHSIZE); /* Dir handle length */
355 memcpy(p, dirfh, NFS_FHSIZE);
356 p += (NFS_FHSIZE / 4);
357 *p++ = htonl(fnamelen);
358 if (fnamelen & 3)
359 *(p + fnamelen / 4) = 0;
360 memcpy(p, fname, fnamelen);
361 p += (fnamelen + 3) / 4;
362
363 len = (uint32_t *)p - (uint32_t *)&(data[0]);
364
365 rpc_req(PROG_NFS, NFS3PROC_LOOKUP, data, len);
366 }
367 }
368
369 /**************************************************************************
370 NFS_READ - Read File on NFS Server
371 **************************************************************************/
372 static void nfs_read_req(int offset, int readlen)
373 {
374 uint32_t data[1024];
375 uint32_t *p;
376 int len;
377
378 p = &(data[0]);
379 p = rpc_add_credentials(p);
380
381 if (supported_nfs_versions & NFSV2_FLAG) {
382 memcpy(p, filefh, NFS_FHSIZE);
383 p += (NFS_FHSIZE / 4);
384 *p++ = htonl(offset);
385 *p++ = htonl(readlen);
386 *p++ = 0;
387 } else { /* NFSV3_FLAG */
388 *p++ = htonl(filefh3_length);
389 memcpy(p, filefh, filefh3_length);
390 p += (filefh3_length / 4);
391 *p++ = htonl(0); /* offset is 64-bit long, so fill with 0 */
392 *p++ = htonl(offset);
393 *p++ = htonl(readlen);
394 *p++ = 0;
395 }
396
397 len = (uint32_t *)p - (uint32_t *)&(data[0]);
398
399 rpc_req(PROG_NFS, NFS_READ, data, len);
400 }
401
402 /**************************************************************************
403 RPC request dispatcher
404 **************************************************************************/
405 static void nfs_send(void)
406 {
407 debug("%s\n", __func__);
408
409 switch (nfs_state) {
410 case STATE_PRCLOOKUP_PROG_MOUNT_REQ:
411 if (supported_nfs_versions & NFSV2_FLAG)
412 rpc_lookup_req(PROG_MOUNT, 1);
413 else /* NFSV3_FLAG */
414 rpc_lookup_req(PROG_MOUNT, 3);
415 break;
416 case STATE_PRCLOOKUP_PROG_NFS_REQ:
417 if (supported_nfs_versions & NFSV2_FLAG)
418 rpc_lookup_req(PROG_NFS, 2);
419 else /* NFSV3_FLAG */
420 rpc_lookup_req(PROG_NFS, 3);
421 break;
422 case STATE_MOUNT_REQ:
423 nfs_mount_req(nfs_path);
424 break;
425 case STATE_UMOUNT_REQ:
426 nfs_umountall_req();
427 break;
428 case STATE_LOOKUP_REQ:
429 nfs_lookup_req(nfs_filename);
430 break;
431 case STATE_READ_REQ:
432 nfs_read_req(nfs_offset, nfs_len);
433 break;
434 case STATE_READLINK_REQ:
435 nfs_readlink_req();
436 break;
437 }
438 }
439
440 /**************************************************************************
441 Handlers for the reply from server
442 **************************************************************************/
443
444 static int rpc_lookup_reply(int prog, uchar *pkt, unsigned len)
445 {
446 struct rpc_t rpc_pkt;
447
448 memcpy(&rpc_pkt.u.data[0], pkt, len);
449
450 debug("%s\n", __func__);
451
452 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
453 return -NFS_RPC_ERR;
454 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
455 return -NFS_RPC_DROP;
456
457 if (rpc_pkt.u.reply.rstatus ||
458 rpc_pkt.u.reply.verifier ||
459 rpc_pkt.u.reply.astatus)
460 return -1;
461
462 switch (prog) {
463 case PROG_MOUNT:
464 nfs_server_mount_port = ntohl(rpc_pkt.u.reply.data[0]);
465 break;
466 case PROG_NFS:
467 nfs_server_port = ntohl(rpc_pkt.u.reply.data[0]);
468 break;
469 }
470
471 return 0;
472 }
473
474 static int nfs_mount_reply(uchar *pkt, unsigned len)
475 {
476 struct rpc_t rpc_pkt;
477
478 debug("%s\n", __func__);
479
480 memcpy(&rpc_pkt.u.data[0], pkt, len);
481
482 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
483 return -NFS_RPC_ERR;
484 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
485 return -NFS_RPC_DROP;
486
487 if (rpc_pkt.u.reply.rstatus ||
488 rpc_pkt.u.reply.verifier ||
489 rpc_pkt.u.reply.astatus ||
490 rpc_pkt.u.reply.data[0])
491 return -1;
492
493 fs_mounted = 1;
494 /* NFSv2 and NFSv3 use same structure */
495 memcpy(dirfh, rpc_pkt.u.reply.data + 1, NFS_FHSIZE);
496
497 return 0;
498 }
499
500 static int nfs_umountall_reply(uchar *pkt, unsigned len)
501 {
502 struct rpc_t rpc_pkt;
503
504 debug("%s\n", __func__);
505
506 memcpy(&rpc_pkt.u.data[0], pkt, len);
507
508 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
509 return -NFS_RPC_ERR;
510 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
511 return -NFS_RPC_DROP;
512
513 if (rpc_pkt.u.reply.rstatus ||
514 rpc_pkt.u.reply.verifier ||
515 rpc_pkt.u.reply.astatus)
516 return -1;
517
518 fs_mounted = 0;
519 memset(dirfh, 0, sizeof(dirfh));
520
521 return 0;
522 }
523
524 static int nfs_lookup_reply(uchar *pkt, unsigned len)
525 {
526 struct rpc_t rpc_pkt;
527
528 debug("%s\n", __func__);
529
530 memcpy(&rpc_pkt.u.data[0], pkt, len);
531
532 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
533 return -NFS_RPC_ERR;
534 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
535 return -NFS_RPC_DROP;
536
537 if (rpc_pkt.u.reply.rstatus ||
538 rpc_pkt.u.reply.verifier ||
539 rpc_pkt.u.reply.astatus ||
540 rpc_pkt.u.reply.data[0]) {
541 switch (ntohl(rpc_pkt.u.reply.astatus)) {
542 case NFS_RPC_SUCCESS: /* Not an error */
543 break;
544 case NFS_RPC_PROG_MISMATCH:
545 /* Remote can't support NFS version */
546 switch (ntohl(rpc_pkt.u.reply.data[0])) {
547 /* Minimal supported NFS version */
548 case 3:
549 debug("*** Waring: NFS version not supported: Requested: V%d, accepted: min V%d - max V%d\n",
550 (supported_nfs_versions & NFSV2_FLAG) ?
551 2 : 3,
552 ntohl(rpc_pkt.u.reply.data[0]),
553 ntohl(rpc_pkt.u.reply.data[1]));
554 debug("Will retry with NFSv3\n");
555 /* Clear NFSV2_FLAG from supported versions */
556 supported_nfs_versions &= ~NFSV2_FLAG;
557 return -NFS_RPC_PROG_MISMATCH;
558 case 4:
559 default:
560 puts("*** ERROR: NFS version not supported");
561 debug(": Requested: V%d, accepted: min V%d - max V%d\n",
562 (supported_nfs_versions & NFSV2_FLAG) ?
563 2 : 3,
564 ntohl(rpc_pkt.u.reply.data[0]),
565 ntohl(rpc_pkt.u.reply.data[1]));
566 puts("\n");
567 }
568 break;
569 case NFS_RPC_PROG_UNAVAIL:
570 case NFS_RPC_PROC_UNAVAIL:
571 case NFS_RPC_GARBAGE_ARGS:
572 case NFS_RPC_SYSTEM_ERR:
573 default: /* Unknown error on 'accept state' flag */
574 debug("*** ERROR: accept state error (%d)\n",
575 ntohl(rpc_pkt.u.reply.astatus));
576 break;
577 }
578 return -1;
579 }
580
581 if (supported_nfs_versions & NFSV2_FLAG) {
582 memcpy(filefh, rpc_pkt.u.reply.data + 1, NFS_FHSIZE);
583 } else { /* NFSV3_FLAG */
584 filefh3_length = ntohl(rpc_pkt.u.reply.data[1]);
585 if (filefh3_length > NFS3_FHSIZE)
586 filefh3_length = NFS3_FHSIZE;
587 memcpy(filefh, rpc_pkt.u.reply.data + 2, filefh3_length);
588 }
589
590 return 0;
591 }
592
593 static int nfs3_get_attributes_offset(uint32_t *data)
594 {
595 if (ntohl(data[1]) != 0) {
596 /* 'attributes_follow' flag is TRUE,
597 * so we have attributes on 21 dwords */
598 /* Skip unused values :
599 type; 32 bits value,
600 mode; 32 bits value,
601 nlink; 32 bits value,
602 uid; 32 bits value,
603 gid; 32 bits value,
604 size; 64 bits value,
605 used; 64 bits value,
606 rdev; 64 bits value,
607 fsid; 64 bits value,
608 fileid; 64 bits value,
609 atime; 64 bits value,
610 mtime; 64 bits value,
611 ctime; 64 bits value,
612 */
613 return 22;
614 } else {
615 /* 'attributes_follow' flag is FALSE,
616 * so we don't have any attributes */
617 return 1;
618 }
619 }
620
621 static int nfs_readlink_reply(uchar *pkt, unsigned len)
622 {
623 struct rpc_t rpc_pkt;
624 int rlen;
625 int nfsv3_data_offset = 0;
626
627 debug("%s\n", __func__);
628
629 memcpy((unsigned char *)&rpc_pkt, pkt, len);
630
631 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
632 return -NFS_RPC_ERR;
633 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
634 return -NFS_RPC_DROP;
635
636 if (rpc_pkt.u.reply.rstatus ||
637 rpc_pkt.u.reply.verifier ||
638 rpc_pkt.u.reply.astatus ||
639 rpc_pkt.u.reply.data[0])
640 return -1;
641
642 if (!(supported_nfs_versions & NFSV2_FLAG)) { /* NFSV3_FLAG */
643 nfsv3_data_offset =
644 nfs3_get_attributes_offset(rpc_pkt.u.reply.data);
645 }
646
647 /* new path length */
648 rlen = ntohl(rpc_pkt.u.reply.data[1 + nfsv3_data_offset]);
649
650 if (*((char *)&(rpc_pkt.u.reply.data[2 + nfsv3_data_offset])) != '/') {
651 int pathlen;
652
653 strcat(nfs_path, "/");
654 pathlen = strlen(nfs_path);
655 memcpy(nfs_path + pathlen,
656 (uchar *)&(rpc_pkt.u.reply.data[2 + nfsv3_data_offset]),
657 rlen);
658 nfs_path[pathlen + rlen] = 0;
659 } else {
660 memcpy(nfs_path,
661 (uchar *)&(rpc_pkt.u.reply.data[2 + nfsv3_data_offset]),
662 rlen);
663 nfs_path[rlen] = 0;
664 }
665 return 0;
666 }
667
668 static int nfs_read_reply(uchar *pkt, unsigned len)
669 {
670 struct rpc_t rpc_pkt;
671 int rlen;
672 uchar *data_ptr;
673
674 debug("%s\n", __func__);
675
676 memcpy(&rpc_pkt.u.data[0], pkt, sizeof(rpc_pkt.u.reply));
677
678 if (ntohl(rpc_pkt.u.reply.id) > rpc_id)
679 return -NFS_RPC_ERR;
680 else if (ntohl(rpc_pkt.u.reply.id) < rpc_id)
681 return -NFS_RPC_DROP;
682
683 if (rpc_pkt.u.reply.rstatus ||
684 rpc_pkt.u.reply.verifier ||
685 rpc_pkt.u.reply.astatus ||
686 rpc_pkt.u.reply.data[0]) {
687 if (rpc_pkt.u.reply.rstatus)
688 return -9999;
689 if (rpc_pkt.u.reply.astatus)
690 return -9999;
691 return -ntohl(rpc_pkt.u.reply.data[0]);
692 }
693
694 if ((nfs_offset != 0) && !((nfs_offset) %
695 (NFS_READ_SIZE / 2 * 10 * HASHES_PER_LINE)))
696 puts("\n\t ");
697 if (!(nfs_offset % ((NFS_READ_SIZE / 2) * 10)))
698 putc('#');
699
700 if (supported_nfs_versions & NFSV2_FLAG) {
701 rlen = ntohl(rpc_pkt.u.reply.data[18]);
702 data_ptr = (uchar *)&(rpc_pkt.u.reply.data[19]);
703 } else { /* NFSV3_FLAG */
704 int nfsv3_data_offset =
705 nfs3_get_attributes_offset(rpc_pkt.u.reply.data);
706
707 /* count value */
708 rlen = ntohl(rpc_pkt.u.reply.data[1 + nfsv3_data_offset]);
709 /* Skip unused values :
710 EOF: 32 bits value,
711 data_size: 32 bits value,
712 */
713 data_ptr = (uchar *)
714 &(rpc_pkt.u.reply.data[4 + nfsv3_data_offset]);
715 }
716
717 if (store_block(data_ptr, nfs_offset, rlen))
718 return -9999;
719
720 return rlen;
721 }
722
723 /**************************************************************************
724 Interfaces of U-BOOT
725 **************************************************************************/
726 static void nfs_timeout_handler(void)
727 {
728 if (++nfs_timeout_count > NFS_RETRY_COUNT) {
729 puts("\nRetry count exceeded; starting again\n");
730 net_start_again();
731 } else {
732 puts("T ");
733 net_set_timeout_handler(nfs_timeout +
734 NFS_TIMEOUT * nfs_timeout_count,
735 nfs_timeout_handler);
736 nfs_send();
737 }
738 }
739
740 static void nfs_handler(uchar *pkt, unsigned dest, struct in_addr sip,
741 unsigned src, unsigned len)
742 {
743 int rlen;
744 int reply;
745
746 debug("%s\n", __func__);
747
748 if (dest != nfs_our_port)
749 return;
750
751 switch (nfs_state) {
752 case STATE_PRCLOOKUP_PROG_MOUNT_REQ:
753 if (rpc_lookup_reply(PROG_MOUNT, pkt, len) == -NFS_RPC_DROP)
754 break;
755 nfs_state = STATE_PRCLOOKUP_PROG_NFS_REQ;
756 nfs_send();
757 break;
758
759 case STATE_PRCLOOKUP_PROG_NFS_REQ:
760 if (rpc_lookup_reply(PROG_NFS, pkt, len) == -NFS_RPC_DROP)
761 break;
762 nfs_state = STATE_MOUNT_REQ;
763 nfs_send();
764 break;
765
766 case STATE_MOUNT_REQ:
767 reply = nfs_mount_reply(pkt, len);
768 if (reply == -NFS_RPC_DROP) {
769 break;
770 } else if (reply == -NFS_RPC_ERR) {
771 puts("*** ERROR: Cannot mount\n");
772 /* just to be sure... */
773 nfs_state = STATE_UMOUNT_REQ;
774 nfs_send();
775 } else {
776 nfs_state = STATE_LOOKUP_REQ;
777 nfs_send();
778 }
779 break;
780
781 case STATE_UMOUNT_REQ:
782 reply = nfs_umountall_reply(pkt, len);
783 if (reply == -NFS_RPC_DROP) {
784 break;
785 } else if (reply == -NFS_RPC_ERR) {
786 debug("*** ERROR: Cannot umount\n");
787 net_set_state(NETLOOP_FAIL);
788 } else {
789 puts("\ndone\n");
790 net_set_state(nfs_download_state);
791 }
792 break;
793
794 case STATE_LOOKUP_REQ:
795 reply = nfs_lookup_reply(pkt, len);
796 if (reply == -NFS_RPC_DROP) {
797 break;
798 } else if (reply == -NFS_RPC_ERR) {
799 puts("*** ERROR: File lookup fail\n");
800 nfs_state = STATE_UMOUNT_REQ;
801 nfs_send();
802 } else if (reply == -NFS_RPC_PROG_MISMATCH &&
803 supported_nfs_versions != 0) {
804 /* umount */
805 nfs_state = STATE_UMOUNT_REQ;
806 nfs_send();
807 /* And retry with another supported version */
808 nfs_state = STATE_PRCLOOKUP_PROG_MOUNT_REQ;
809 nfs_send();
810 } else {
811 nfs_state = STATE_READ_REQ;
812 nfs_offset = 0;
813 nfs_len = NFS_READ_SIZE;
814 nfs_send();
815 }
816 break;
817
818 case STATE_READLINK_REQ:
819 reply = nfs_readlink_reply(pkt, len);
820 if (reply == -NFS_RPC_DROP) {
821 break;
822 } else if (reply == -NFS_RPC_ERR) {
823 puts("*** ERROR: Symlink fail\n");
824 nfs_state = STATE_UMOUNT_REQ;
825 nfs_send();
826 } else {
827 debug("Symlink --> %s\n", nfs_path);
828 nfs_filename = basename(nfs_path);
829 nfs_path = dirname(nfs_path);
830
831 nfs_state = STATE_MOUNT_REQ;
832 nfs_send();
833 }
834 break;
835
836 case STATE_READ_REQ:
837 rlen = nfs_read_reply(pkt, len);
838 net_set_timeout_handler(nfs_timeout, nfs_timeout_handler);
839 if (rlen > 0) {
840 nfs_offset += rlen;
841 nfs_send();
842 } else if ((rlen == -NFSERR_ISDIR) || (rlen == -NFSERR_INVAL)) {
843 /* symbolic link */
844 nfs_state = STATE_READLINK_REQ;
845 nfs_send();
846 } else {
847 if (!rlen)
848 nfs_download_state = NETLOOP_SUCCESS;
849 if (rlen < 0)
850 debug("NFS READ error (%d)\n", rlen);
851 nfs_state = STATE_UMOUNT_REQ;
852 nfs_send();
853 }
854 break;
855 }
856 }
857
858
859 void nfs_start(void)
860 {
861 debug("%s\n", __func__);
862 nfs_download_state = NETLOOP_FAIL;
863
864 nfs_server_ip = net_server_ip;
865 nfs_path = (char *)nfs_path_buff;
866
867 if (nfs_path == NULL) {
868 net_set_state(NETLOOP_FAIL);
869 debug("*** ERROR: Fail allocate memory\n");
870 return;
871 }
872
873 if (net_boot_file_name[0] == '\0') {
874 sprintf(nfs_path, "/nfsroot/%02X%02X%02X%02X.img",
875 net_ip.s_addr & 0xFF,
876 (net_ip.s_addr >> 8) & 0xFF,
877 (net_ip.s_addr >> 16) & 0xFF,
878 (net_ip.s_addr >> 24) & 0xFF);
879
880 debug("*** Warning: no boot file name; using '%s'\n",
881 nfs_path);
882 } else {
883 char *p = net_boot_file_name;
884
885 p = strchr(p, ':');
886
887 if (p != NULL) {
888 nfs_server_ip = string_to_ip(net_boot_file_name);
889 ++p;
890 strcpy(nfs_path, p);
891 } else {
892 strcpy(nfs_path, net_boot_file_name);
893 }
894 }
895
896 nfs_filename = basename(nfs_path);
897 nfs_path = dirname(nfs_path);
898
899 debug("Using %s device\n", eth_get_name());
900
901 debug("File transfer via NFS from server %pI4; our IP address is %pI4",
902 &nfs_server_ip, &net_ip);
903
904 /* Check if we need to send across this subnet */
905 if (net_gateway.s_addr && net_netmask.s_addr) {
906 struct in_addr our_net;
907 struct in_addr server_net;
908
909 our_net.s_addr = net_ip.s_addr & net_netmask.s_addr;
910 server_net.s_addr = net_server_ip.s_addr & net_netmask.s_addr;
911 if (our_net.s_addr != server_net.s_addr)
912 debug("; sending through gateway %pI4",
913 &net_gateway);
914 }
915 debug("\nFilename '%s/%s'.", nfs_path, nfs_filename);
916
917 if (net_boot_file_expected_size_in_blocks) {
918 debug(" Size is 0x%x Bytes = ",
919 net_boot_file_expected_size_in_blocks << 9);
920 print_size(net_boot_file_expected_size_in_blocks << 9, "");
921 }
922 debug("\nLoad address: 0x%lx\nLoading: *\b", load_addr);
923
924 net_set_timeout_handler(nfs_timeout, nfs_timeout_handler);
925 net_set_udp_handler(nfs_handler);
926
927 nfs_timeout_count = 0;
928 nfs_state = STATE_PRCLOOKUP_PROG_MOUNT_REQ;
929
930 /*nfs_our_port = 4096 + (get_ticks() % 3072);*/
931 /*FIX ME !!!*/
932 nfs_our_port = 1000;
933
934 /* zero out server ether in case the server ip has changed */
935 memset(net_server_ethaddr, 0, 6);
936
937 nfs_send();
938 }