src/udp.c

   1 // vim: set et sw=4 sts=4 :
   2
   3 #include "netdev.h"
   4 #include "ip.h"
   5 #include "udp.h"
   6
   7 uint16 udp_port_local;
   8
   9 uint16 udp_port_remote;
  10
  11 byte udp_dgram_len;
  12
  13 /* para calcular checksum */
  14 static uint16 checksum;
  15
  16 /* agrega un word al checksum calculado */
  17 static void sum(uint16 w)
  18 {
  19     checksum += w;
  20     if (checksum < w) /* corrección de carry (hubo OV) */
  21         ++checksum;
  22 }
  23
  24 bool udp_read_dgram_header()
  25 {
  26     uint16 p;
  27     /* reseteamos checksum */
  28     checksum = 0;
  29     /* el UDP tiene un checksum que incluye parte de la cabecera IP */
  30     /* ip de origen */
  31     sum(WORD(ip_addr_remote[0], ip_addr_remote[1]));
  32     sum(WORD(ip_addr_remote[2], ip_addr_remote[3]));
  33     /* ip de destino */
  34     sum(WORD(ip_addr_local[0], ip_addr_local[1]));
  35     sum(WORD(ip_addr_local[2], ip_addr_local[3]));
  36     /* protocolo expresado en 16 bits (0x11 es UDP) */
  37     sum(0x0011);
  38     /* tamaño del paquete UDP (sin las cabeceras que son 20 bytes) */
  39     sum(ip_packet_len - 20);
  40     /* de ahora en más todos los datos del checksum corresponden a UDP */
  41     /* puerto origen (remoto) */
  42     udp_port_remote = netdev_recv_word();
  43     /* agregamos puerto de origen al checksum */
  44     sum(udp_port_remote);
  45     /* sólo aceptamos datagramas a nuestro puerto */
  46     p = netdev_recv_word();
  47     if (p != udp_port_local)
  48         return false; /* drop */
  49     /* agregamos puerto de destino al checksum */
  50     sum(udp_port_local);
  51     /* tamaño del datagrama */
  52     if (netdev_recv_byte()) /* no soportamos más de 255 bytes */
  53         return false; /* drop */
  54     udp_dgram_len = netdev_recv_byte();
  55     /* agregamos tamaño al checksum */
  56     sum(udp_dgram_len);
  57     /* agregamos checksum al checksum */
  58     sum(netdev_recv_word());
  59     /* falta agregar el cuerpo del mensaje para verificar la suma
  60      * esto debe hacerlo el protocolo que sigue para poder seguir obteniendo
  61      * los datos de la placa de red byte a byte */
  62     return true;
  63 }
  64
  65 uint16 udp_read_word()
  66 {
  67     uint16 w = netdev_recv_word();
  68     sum(w);
  69     return w;
  70 }
  71
  72 bool udp_checksum_ok()
  73 {
  74     return (uint16)~checksum;
  75 }
  76
  77 void udp_write_dgram_header()
  78 {
  79     /* reseteamos checksum */
  80     checksum = 0;
  81     /* el UDP tiene un checksum que incluye parte de la cabecera IP */
  82     /* ip de origen */
  83     sum(WORD(ip_addr_remote[0], ip_addr_remote[1]));
  84     sum(WORD(ip_addr_remote[2], ip_addr_remote[3]));
  85     /* ip de destino */
  86     sum(WORD(ip_addr_local[0], ip_addr_local[1]));
  87     sum(WORD(ip_addr_local[2], ip_addr_local[3]));
  88     /* protocolo expresado en 16 bits (0x11 es UDP) */
  89     sum(0x0011);
  90     /* tamaño del paquete UDP (IP sin las cabeceras, que son 20 bytes) */
  91     sum(ip_packet_len - 20); // FIXME
  92     /* puerto origen */
  93     netdev_send_word(udp_port_local);
  94     sum(udp_port_local);
  95     /* puerto destino */
  96     netdev_send_word(udp_port_remote);
  97     sum(udp_port_remote);
  98     /* tamaño del datagrama */
  99     netdev_send_byte(0x00); /* parte alta en 0 porque no soportamos más de 255 */
 100     netdev_send_byte(udp_dgram_len);
 101     sum(WORD(0x00, udp_dgram_len));
 102     /* indicamos que no se usa checksum */
 103     netdev_send_word(0x0000);
 104     sum(0x0000);
 105 }
 106
 107 void udp_write_word(uint16 w)
 108 {
 109     sum(w);
 110     netdev_send_word(w);
 111 }
 112
 113 void udp_write_checksum()
 114 {
 115     // XXX TODO FIXME
 116     return;
 117 }
 118