123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203 |
- #ifdef HAVE_CONFIG_H
- #include "config.h"
- #endif
- #include <netdissect-stdinc.h>
- #include <string.h>
- #include "netdissect.h"
- #include "extract.h"
- #define RRQ 01
- #define WRQ 02
- #define DATA 03
- #define ACK 04
- #define TFTP_ERROR 05
- #define OACK 06
- #define EUNDEF 0
- #define ENOTFOUND 1
- #define EACCESS 2
- #define ENOSPACE 3
- #define EBADOP 4
- #define EBADID 5
- #define EEXISTS 6
- #define ENOUSER 7
- static const char tstr[] = " [|tftp]";
- static const struct tok op2str[] = {
- { RRQ, "RRQ" },
- { WRQ, "WRQ" },
- { DATA, "DATA" },
- { ACK, "ACK" },
- { TFTP_ERROR, "ERROR" },
- { OACK, "OACK" },
- { 0, NULL }
- };
- static const struct tok err2str[] = {
- { EUNDEF, "EUNDEF" },
- { ENOTFOUND, "ENOTFOUND" },
- { EACCESS, "EACCESS" },
- { ENOSPACE, "ENOSPACE" },
- { EBADOP, "EBADOP" },
- { EBADID, "EBADID" },
- { EEXISTS, "EEXISTS" },
- { ENOUSER, "ENOUSER" },
- { 0, NULL }
- };
- void
- tftp_print(netdissect_options *ndo,
- register const u_char *bp, u_int length)
- {
- register const char *cp;
- register int opcode;
- u_int ui;
-
- ND_PRINT((ndo, " %d", length));
-
- if (length < 2)
- goto trunc;
- ND_TCHECK_16BITS(bp);
- opcode = EXTRACT_16BITS(bp);
- cp = tok2str(op2str, "tftp-#%d", opcode);
- ND_PRINT((ndo, " %s", cp));
-
- if (*cp == 't')
- return;
- bp += 2;
- length -= 2;
- switch (opcode) {
- case RRQ:
- case WRQ:
- if (length == 0)
- goto trunc;
- ND_PRINT((ndo, " "));
-
- ND_PRINT((ndo, "\""));
- ui = fn_printztn(ndo, bp, length, ndo->ndo_snapend);
- ND_PRINT((ndo, "\""));
- if (ui == 0)
- goto trunc;
- bp += ui;
- length -= ui;
-
- if (length == 0)
- goto trunc;
- ND_PRINT((ndo, " "));
- ui = fn_printztn(ndo, bp, length, ndo->ndo_snapend);
- if (ui == 0)
- goto trunc;
- bp += ui;
- length -= ui;
-
- while (length != 0) {
- ND_TCHECK(*bp);
- if (*bp != '\0')
- ND_PRINT((ndo, " "));
- ui = fn_printztn(ndo, bp, length, ndo->ndo_snapend);
- if (ui == 0)
- goto trunc;
- bp += ui;
- length -= ui;
- }
- break;
- case OACK:
-
- while (length != 0) {
- ND_TCHECK(*bp);
- if (*bp != '\0')
- ND_PRINT((ndo, " "));
- ui = fn_printztn(ndo, bp, length, ndo->ndo_snapend);
- if (ui == 0)
- goto trunc;
- bp += ui;
- length -= ui;
- }
- break;
- case ACK:
- case DATA:
- if (length < 2)
- goto trunc;
- ND_TCHECK_16BITS(bp);
- ND_PRINT((ndo, " block %d", EXTRACT_16BITS(bp)));
- break;
- case TFTP_ERROR:
-
- if (length < 2)
- goto trunc;
- ND_TCHECK_16BITS(bp);
- ND_PRINT((ndo, " %s", tok2str(err2str, "tftp-err-#%d \"",
- EXTRACT_16BITS(bp))));
- bp += 2;
- length -= 2;
-
- if (length == 0)
- goto trunc;
- ND_PRINT((ndo, " \""));
- ui = fn_printztn(ndo, bp, length, ndo->ndo_snapend);
- ND_PRINT((ndo, "\""));
- if (ui == 0)
- goto trunc;
- break;
- default:
-
- ND_PRINT((ndo, "(unknown #%d)", opcode));
- break;
- }
- return;
- trunc:
- ND_PRINT((ndo, "%s", tstr));
- return;
- }
|