Faltó reemplazar un petherled por EPL =)

[z.facultad/66.09/etherled.git] / src / main.c

diff --git a/src/main.c b/src/main.c
index 7cd27163c955894dbc067104382b84bdf04947c9..f980df1fb630c10f9d10b7c4669bb80017a34f83 100644 (file)
--- a/src/main.c
+++ b/src/main.c
@@ -1,47 +1,33 @@
 // vim: set et sw=4 sts=4 :    
 
 // vim: set et sw=4 sts=4 :    
 

+#include "debug.h"
+#include "leds.h"
+#include "reg51.h"

 #include "netdev.h"
 #include "eth.h"
 #include "ip.h"
 #include "udp.h"
 
 #include "netdev.h"
 #include "eth.h"
 #include "ip.h"
 #include "udp.h"
 

-#ifdef SDCC
-static xdata at 0x0080 byte leds0;
-static xdata at 0x00c0 byte leds1;
-#else
-static byte xdata leds0 _at_ 0x0080;
-static byte xdata leds1 _at_ 0x00c0;
-#endif
-
-#define leds(word)              \
-    do                          \
-    {                           \
-        leds0 = ~LOW(word);     \
-        leds1 = ~HIGH(word);    \
-    }                           \
-    while (0)
-        
-
-void sleep(unsigned char times)
-{
-    unsigned int i;
-    unsigned char j;
-    for (i = 0; i < 0xffff; ++i)
-        for (j = 0; j < times; ++j);
-}
-

 void main(void)
 {
 void main(void)
 {

-    // Apagamos todos los leds
-    leds(0x0000);
+    // Inicializamos leds
+    leds_init();
+
+    // Hacemos prueba simple de los leds
+    leds_test();

 
     // Inicializamos dispositivo de red
     if (!netdev_init())
     {
 
     // Inicializamos dispositivo de red
     if (!netdev_init())
     {

-        leds(0xffff);
-        while(1); // Si falla init nos quedamos bobos
+        // Si hubo un error, quedan prendidos todos los leds
+        leds_write(0xFFFF);
+        return;

     }
 
     }
 

+    // Comienza a 'dibujar'
+    EA  = 1; // Habilita interrupciones globalmente
+    TR2 = 1; // Pone a correr el 'dibujado'
+

     // Inicializo IP
     ip_addr_local[0] = 10;
     ip_addr_local[1] = 10;
     // Inicializo IP
     ip_addr_local[0] = 10;
     ip_addr_local[1] = 10;


@@ -49,64 +35,81 @@ void main(void)
     ip_addr_local[3] = 100;
 
     // Inicializo puerto UDP
     ip_addr_local[3] = 100;
 
     // Inicializo puerto UDP

-    udp_port_local = 9000;
+    udp_port_local = 9876;

 
     while (1) // Forever
     {
 
     while (1) // Forever
     {

-        uint16 len = netdev_recv_start();
-        if (!len) // no recibimos nada
-        {
-            netdev_recv_end();
-            continue; // vamos de nuevo!
-        }
+        byte i; //XXX
+        byte len;
+
+        len = netdev_recv_start();
+        if (!len) // no recibimos nada (válido)
+            continue; // Probamos de nuevo
+
+        // Tenemos algo!
+        //print(0x2);

 
         // Parseamos cabecera ethernet
         if (!eth_read_frame_header()) // No es un buen header
 
         // Parseamos cabecera ethernet
         if (!eth_read_frame_header()) // No es un buen header

-        {
-        // Tenemos algo!
-            netdev_recv_end(); // Tiramos el paquete
-            continue; // Vamos de nuevo!
-        }
+            goto drop; // Tiramos el paquete
+        //print(0x4);

 
         // Vemos que protocolo transporta
         switch (eth_proto)
         {
 
         // Vemos que protocolo transporta
         switch (eth_proto)
         {

-            case ETH_ARP: // FIXME, implementar ARP!
-                netdev_recv_end(); // Tiramos el paquete
-                continue; // Vamos de nuevo!
+            case ETH_ARP: // TODO: implementar ARP!
+                goto drop; // Tiramos el paquete

 
             case ETH_IP:
 
             case ETH_IP:

+                //print(0x8);

                 // Parseamos cabecera IP
                 if (!ip_read_packet_header()) // No es un buen header
                 // Parseamos cabecera IP
                 if (!ip_read_packet_header()) // No es un buen header

-                {
-                    netdev_recv_end(); // Tiramos el paquete
-                    continue; // Vamos de nuevo!
-                }
+                    goto drop; // Tiramos el paquete
+                //print(0x10);

 
                 // Vemos que protocolo transporta
                 switch (ip_proto)
                 {
 
                 // Vemos que protocolo transporta
                 switch (ip_proto)
                 {

-                    case IP_ICMP: // FIXME, implementar ICMP!
-                        netdev_recv_end(); // Tiramos el paquete
-                        continue; // Vamos de nuevo!
+                    case IP_ICMP: // TODO: implementar ICMP!
+                        goto drop; // Tiramos el paquete

 
                     case IP_UDP:
 
                     case IP_UDP:

+                        //print(0x20);

                         // Parseamos cabecera UDP
                         if (!udp_read_dgram_header()) // No es un buen header
                         // Parseamos cabecera UDP
                         if (!udp_read_dgram_header()) // No es un buen header

-                        {
-                            netdev_recv_end(); // Tiramos el paquete
-                            continue; // Vamos de nuevo!
-                        }
+                            goto drop; // Tiramos el paquete

 
 

+                        //printb(udp_dgram_len, 0x40);

                         // TODO
                         // Nuestro protocolo, por ahora un simple echo!
                         // TODO
                         // Nuestro protocolo, por ahora un simple echo!

-                        for (len = 8; len < udp_dgram_len; len += 2) // 8 por la cabecera UDP
-                        {
-                            leds(netdev_recv_word());
-                            sleep(5);
-                        }
+                        len = udp_dgram_len - UDP_HEADER_SIZE;
+                        netdev_read_start(len);
+                        leds_matrix_len = len;
+                        for (i = 0; i < len; ++i)
+                            leds_matrix[i] = udp_read_byte();
+                        netdev_read_end();
+                        if (!udp_checksum_ok())
+                            goto drop;
+                        netdev_recv_end();
+
+                        // Respuesta
+                        netdev_send_start();
+                        eth_write_frame_header();
+                        //udp_dgram_len = UDP_HEADER_SIZE+len;
+                        //ip_packet_len = IP_HEADER_SIZE+udp_dgram_len;
+                        ip_write_packet_header();
+                        udp_write_dgram_header();
+                        netdev_write_start(len);
+                        for (i = 0; i < len; ++i)
+                            udp_write_byte(leds_matrix[i]);
+                        netdev_write_end();
+                        udp_write_checksum(ETH_HEADER_SIZE+IP_HEADER_SIZE);
+                        netdev_send_end(ETH_HEADER_SIZE+IP_HEADER_SIZE+udp_dgram_len);

                 }
         }
                 }
         }

+        continue;
+drop:
+        netdev_recv_end();

     }
 }
 
     }
 }