udp.c

来自「Nast是一个基于Libnet 和Libpcap的sniffer包和LAN分析器」· C语言 代码 · 共 83 行

/*
    nast

    Copyright (C) 2002  Snifth

    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.

*/

#include "include/nast.h"

/* handle a udp packet */
void handle_UDP (u_short d, u_short x, FILE *output, FILE *ldd)
{
   struct libnet_ipv4_hdr *ip;
   struct libnet_udp_hdr *udp;
   struct servent *service;
   u_short size_buf, size_ip, size_udp;

   size_ip = LIBNET_IPV4_H;
   size_udp = LIBNET_UDP_H;
   size_buf = 0;
   
   ip = (struct libnet_ipv4_hdr *) (packet+offset);
   udp = (struct libnet_udp_hdr *) (packet+size_ip+offset);

   service = getservbyport (htons(ntohs(udp->uh_sport)), "udp");
   fprintf(output, "\n---[ UDP ]-----------------------------------------------------------\n");
   fprintf(output, "%s:%d(%s) -> ", inet_ntoa (ip->ip_src), ntohs(udp->uh_sport), (service) ? service->s_name : "unknown");
   service = getservbyport(htons(ntohs(udp->uh_dport)), "udp");
   fprintf(output, "%s:%d(%s)\n", inet_ntoa(ip->ip_dst), ntohs(udp->uh_dport), (service) ? service->s_name : "unknown");
   fprintf(output, "Version: %d\t Total Lenght: %d\t", ip->ip_v, ntohs(ip->ip_len));
   fprintf(output, "TTL: %d\n", ip->ip_ttl);

   size_buf = ntohs(ip->ip_len) - size_ip - size_udp;

   /* there is a payload */
   if (size_buf)
     {
	buf = (char *) (packet + size_ip + size_udp + offset);

	if (d)
	  {
	     fprintf(output, "\n---[ UDP Data ]------------------------------------------------------\n");
	     data_sniffo (buf, size_buf, output);
	     fprintf (output, "\n");
	  }

	if (x)
	  {
	     fprintf(output, "\n---[ UDP Hex-Ascii Data ]--------------------------------------------");
	     print_ascii_hex (buf, size_buf, output);
	     fprintf(output, "\n");
	  }

        /* log data (payload only) */
	if (ldd)
	  {
	     service = getservbyport (htons(ntohs(udp->uh_sport)), "udp");
	     fprintf(ldd, "%s:%d(%s) -> ", inet_ntoa (ip->ip_src), ntohs(udp->uh_sport), (service) ? service->s_name : "unknown");
	     service = getservbyport(htons(ntohs(udp->uh_dport)), "udp");
	     fprintf(ldd, "%s:%d(%s) UDP\n", inet_ntoa(ip->ip_dst), ntohs(udp->uh_dport), (service) ? service->s_name : "unknown");

	     data_sniffo (buf, size_buf, ldd);
	     fprintf(ldd, "\n");

	  }
     }
}