rtems-omk-template/applwiptest/task_1.c

   1 #include <system_def.h>
   2 #include "system.h"
   3 #include "app_def.h"
   4 #include <stdio.h>
   5 #include <stdlib.h>
   6 #include <rtems/untar.h>
   7 #include <rtems/error.h>
   8 #include <rtems/mw_uid.h>
   9 #include <errno.h>
  10
  11 #include <lwip/init.h>
  12 #include "lwip/err.h"
  13 #include "lwip/tcp.h"
  14 #include <netif/etharp.h>
  15
  16 #include "lwip/tcpip.h"
  17 #include "arch/eth_lwip.h"
  18 #include "lwip/api.h"
  19 #include "lwip/netbuf.h"
  20 #include "lwip/netdb.h"
  21 #include "lwip/netifapi.h"
  22 #include "lwip/sockets.h"
  23 #include "lwip/sys.h"
  24
  25 void lwip_echo_task(rtems_task_argument arg)
  26 {
  27   int clientfd = (int) arg;
  28   char buffer[1024];
  29   int nbytes;
  30   printf("ECHO THREAD STARTED %d\n", clientfd);
  31   do{
  32     nbytes=lwip_recv(clientfd, buffer, sizeof(buffer),0);
  33     if (nbytes>0) lwip_send(clientfd, buffer, nbytes, 0);
  34   } while (nbytes>0);
  35   lwip_close(clientfd);
  36   printf("ECHO THREAD STOPPED %d\n", clientfd);
  37   rtems_task_delete( RTEMS_SELF );
  38 }
  39
  40 void lwip_echo_server(void)
  41 {
  42   int lSocket;
  43   struct sockaddr_in sLocalAddr;
  44
  45   lSocket = lwip_socket(AF_INET, SOCK_STREAM, 0);
  46   if (lSocket < 0) return;
  47
  48   memset((char *)&sLocalAddr, 0, sizeof(sLocalAddr));
  49   sLocalAddr.sin_family = AF_INET;
  50   sLocalAddr.sin_len = sizeof(sLocalAddr);
  51   sLocalAddr.sin_addr.s_addr = htonl(INADDR_ANY);
  52   sLocalAddr.sin_port = 23;
  53
  54   if (lwip_bind(lSocket, (struct sockaddr *)&sLocalAddr, sizeof(sLocalAddr)) < 0) {
  55           lwip_close(lSocket);
  56           return;
  57   }
  58
  59   if ( lwip_listen(lSocket, 20) != 0 ){
  60           lwip_close(lSocket);
  61           return;
  62   }
  63
  64   while (1)
  65   {
  66         int clientfd;
  67         struct sockaddr_in client_addr;
  68         int addrlen=sizeof(client_addr);
  69         rtems_id id;
  70         rtems_status_code res;
  71
  72         clientfd = lwip_accept(lSocket, (struct sockaddr*)&client_addr, (socklen_t)&addrlen);
  73         if (clientfd>0){
  74           res = rtems_task_create(rtems_build_name('E', 'C', 'H', '0'+(clientfd & 7)),
  75             90, RTEMS_MINIMUM_STACK_SIZE+2048, RTEMS_PREEMPT, 0, &id );
  76
  77           if (res != RTEMS_SUCCESSFUL) {
  78             lwip_close(clientfd);
  79             printf("ECHO THREAD NOT CREATED %d\n", clientfd);
  80             continue;
  81           }
  82           res = rtems_task_start(id, (rtems_task_entry)lwip_echo_task, (rtems_task_argument)clientfd);
  83           if (res != RTEMS_SUCCESSFUL) {
  84             rtems_task_delete(id);
  85             lwip_close(clientfd);
  86             continue;
  87           }
  88         }
  89   }
  90   lwip_close(lSocket);
  91 }
  92
  93 rtems_task Task_1(
  94   rtems_task_argument argument
  95 )
  96 {
  97   printf("*** Starting up Task_1 ***\n");
  98
  99   int loops = 3;
 100   rtems_status_code status;
 101   while(loops--){
 102     eth_lwip_get_dhcp_info();
 103     status = rtems_task_wake_after(rtems_clock_get_ticks_per_second()*5);
 104   }
 105   printf("*** Start Echo server ***\n");
 106   lwip_echo_server();
 107   printf("*** Echo server ended ***\n");
 108   rtems_task_suspend( RTEMS_SELF );
 109 }
 110