URL https://opencores.org/ocsvn/plasma/plasma/trunk

Subversion Repositories plasma

[/] [plasma/] [trunk/] [kernel/] [netutil.c] - Blame information for rev 436

Go to most recent revision | Details | Compare with Previous | View Log


/*--------------------------------------------------------------------
 * TITLE: Plasma TCP/IP Network Utilities
 * AUTHOR: Steve Rhoads (rhoadss@yahoo.com)
 * DATE CREATED: 4/20/07
 * FILENAME: netutil.c
 * PROJECT: Plasma CPU core
 * COPYRIGHT: Software placed into the public domain by the author.
 *    Software 'as is' without warranty.  Author liable for nothing.
 * DESCRIPTION:
 *    Plasma FTP server and FTP client and TFTP server and client
 *    and Telnet server.
 *--------------------------------------------------------------------*/
#define INSIDE_NETUTIL
#include "plasma.h"
#include "rtos.h"
#include "tcpip.h"
 
#ifndef EXCLUDE_DLL
void ConsoleRun(IPSocket *socket, char *argv[]);
#endif
 
//******************* FTP Server ************************
typedef struct {
   IPSocket *socket;
   int ip, port, bytes, done, canReceive;
   FILE *file;
} FtpdInfo;
 
static void FtpdSender(IPSocket *socket)
{
   unsigned char buf[600];
   int i, bytes, bytes2;
   FtpdInfo *info = (FtpdInfo*)socket->userPtr;
 
   if(info == NULL || info->done)
      return;
   fseek(info->file, info->bytes, 0);
   for(i = 0; i < 100000; ++i)
   {
      bytes = fread(buf, 1, 512, info->file);
      bytes2 = IPWrite(socket, buf, bytes);
      info->bytes += bytes2;
      if(bytes != bytes2)
         return;
      if(bytes < 512)
      {
         fclose(info->file);
         IPClose(socket);
         info->done = 1;
         IPPrintf(info->socket, "226 Done\r\n");
         return;
      }
   }
}
 
 
static void FtpdReceiver(IPSocket *socket)
{
   unsigned char buf[600];
   int bytes, state = socket->state;
   FtpdInfo *info = (FtpdInfo*)socket->userPtr;
   int total = 0;
 
   if(info == NULL || info->done)
      return;
   do
   {
      bytes = IPRead(socket, buf, sizeof(buf));
      fwrite(buf, 1, bytes, info->file);
      total += bytes;
   } while(bytes);
 
   if(state > IP_TCP && total == 0)
   {
      fclose(info->file);
      info->done = 1;
      IPPrintf(info->socket, "226 Done\r\n");
      IPClose(socket);
      return;
   }
}
 
 
static void FtpdServer(IPSocket *socket)
{
   uint8 buf[600];
   int bytes;
   int ip0, ip1, ip2, ip3, port0, port1;
   IPSocket *socketOut;
   FtpdInfo *info;
 
   if(socket == NULL)
      return;
   info = (FtpdInfo*)socket->userPtr;
   bytes = IPRead(socket, buf, sizeof(buf)-1);
   buf[bytes] = 0;
   //printf("(%s)\n", buf);
   if(socket->userPtr == NULL)
   {
      info = (FtpdInfo*)malloc(sizeof(FtpdInfo));
      if(info == NULL)
         return;
      memset(info, 0, sizeof(FtpdInfo));
      socket->userPtr = info;
      info->socket = socket;
      socket->timeoutReset = 60;
      IPPrintf(socket, "220 Connected to Plasma\r\n");
   }
   else if(socket->userPtr == (void*)-1)
   {
      return;
   }
   else if(strstr((char*)buf, "USER"))
   {
      if(strstr((char*)buf, "PlasmaSend"))
         info->canReceive = 1;
      IPPrintf(socket, "331 Password?\r\n");
   }
   else if(strstr((char*)buf, "PASS"))
   {
      IPPrintf(socket, "230 Logged in\r\n");
   }
   else if(strstr((char*)buf, "PORT"))
   {
      sscanf((char*)buf + 5, "%d,%d,%d,%d,%d,%d", &ip0, &ip1, &ip2, &ip3, &port0, &port1);
      info->ip = (ip0 << 24) | (ip1 << 16) | (ip2 << 8) | ip3;
      info->port = (port0 << 8) | port1;
      //printf("ip=0x%x port=%d\n", info->ip, info->port);
      IPPrintf(socket, "200 OK\r\n");
   }
   else if(strstr((char*)buf, "RETR") || strstr((char*)buf, "STOR"))
   {
      char *ptr = strstr((char*)buf, "\r");
      if(ptr)
         *ptr = 0;
      info->file = NULL;
      info->bytes = 0;
      info->done = 0;
      if(strstr((char*)buf, "RETR"))
         info->file = fopen((char*)buf + 5, "rb");
      else if(info->canReceive && strcmp((char*)buf+5, "/flash/web"))
         info->file = fopen((char*)buf + 5, "wb");
      if(info->file)
      {
         IPPrintf(socket, "150 File ready\r\n");
         if(strstr((char*)buf, "RETR"))
            socketOut = IPOpen(IP_MODE_TCP, info->ip, info->port, FtpdSender);
         else
            socketOut = IPOpen(IP_MODE_TCP, info->ip, info->port, FtpdReceiver);
         if(socketOut)
            socketOut->userPtr = info;
      }
      else
      {
         IPPrintf(socket, "500 Error\r\n");
      }
   }
   else if(strstr((char*)buf, "QUIT"))
   {
      if(socket->userPtr)
         free(socket->userPtr);
      socket->userPtr = (void*)-1;
      IPPrintf(socket, "221 Bye\r\n");
      IPClose(socket);
   }
   else if(bytes)
   {
      IPPrintf(socket, "500 Error\r\n");
   }
}
 
 
void FtpdInit(int UseFiles)
{
   (void)UseFiles;
   IPOpen(IP_MODE_TCP, 0, 21, FtpdServer);
}
 
 
//******************* FTP Client ************************
 
typedef struct {
   uint32 ip, port;
   char user[80], passwd[80], filename[80];
   uint8 *buf;
   int size, bytes, send, state;
} FtpInfo;
 
 
static void FtpCallbackTransfer(IPSocket *socket)
{
   int bytes, state = socket->state;
   FtpInfo *info = (FtpInfo*)socket->userPtr;
 
   //printf("FtpCallbackTransfer\n");
   if(info == NULL)
      return;
   bytes = info->size - info->bytes;
   if(info->send == 0)
      bytes = IPRead(socket, info->buf + info->bytes, bytes);
   else
      bytes = IPWrite(socket, info->buf + info->bytes, bytes);
   info->bytes += bytes;
   if(info->bytes == info->size || (bytes == 0 && state > IP_TCP))
   {
      socket->userFunc(socket, info->buf, info->bytes);
      free(info);
      socket->userPtr = NULL;
      IPClose(socket);
   }
}
 
 
static void FtpCallback(IPSocket *socket)
{
   char buf[600];
   FtpInfo *info = (FtpInfo*)socket->userPtr;
   int bytes, value;
 
   bytes = IPRead(socket, (uint8*)buf, sizeof(buf)-1);
   if(bytes == 0)
      return;
   buf[bytes] = 0;
   sscanf(buf, "%d", &value);
   if(bytes > 2)
      buf[bytes-2] = 0;
   //printf("FtpCallback(%d:%s)\n", socket->userData, buf);
   if(value / 100 != 2 && value / 100 != 3)
      return;
   buf[0] = 0;
   switch(socket->userData) {
   case 0:
      sprintf(buf, "USER %s\r\n", info->user);
      socket->userData = 1;
      break;
   case 1:
      sprintf(buf, "PASS %s\r\n", info->passwd);
      socket->userData = 2;
      if(value == 331)
         break;  //possible fall-through
   case 2:
      sprintf(buf, "PORT %d,%d,%d,%d,%d,%d\r\n",
         info->ip >> 24, (uint8)(info->ip >> 16),
         (uint8)(info->ip >> 8), (uint8)info->ip,
         (uint8)(info->port >> 8), (uint8)info->port);
      socket->userData = 3;
      break;
   case 3:
      if(info->send == 0)
         sprintf(buf, "RETR %s\r\n", info->filename);
      else
         sprintf(buf, "STOR %s\r\n", info->filename);
      socket->userData = 4;
      break;
   case 4:
      sprintf(buf, "QUIT\r\n");
      socket->userData = 9;
      break;
   }
   IPWrite(socket, (uint8*)buf, strlen(buf));
   IPWriteFlush(socket);
   if(socket->userData == 9)
      IPClose(socket);
}
 
 
IPSocket *FtpTransfer(uint32 ip, char *user, char *passwd,
                      char *filename, uint8 *buf, int size,
                      int send, IPCallbackPtr callback)
{
   IPSocket *socket, *socketTransfer;
   FtpInfo *info;
   uint8 *ptr;
   info = (FtpInfo*)malloc(sizeof(FtpInfo));
   if(info == NULL)
      return NULL;
   strncpy(info->user, user, 80);
   strncpy(info->passwd, passwd, 80);
   strncpy(info->filename, filename, 80);
   info->buf = buf;
   info->size = size;
   info->send = send;
   info->bytes = 0;
   info->state = 0;
   info->port = 2000;
   socketTransfer = IPOpen(IP_MODE_TCP, 0, info->port, FtpCallbackTransfer);
   if(socketTransfer == NULL)
      return NULL;
   socketTransfer->userPtr = info;
   socketTransfer->userFunc = callback;
   socket = IPOpen(IP_MODE_TCP, ip, 21, FtpCallback);
   if(socket == NULL)
      return NULL;
   socket->userPtr = info;
   socket->userFunc = callback;
   ptr = socket->headerSend;
   info->ip = IPAddressSelf();
   return socket;
}
 
 
//******************* TFTP Server ************************
 
 
static void TftpdCallback(IPSocket *socket)
{
   unsigned char buf[512+4];
   int bytes, blockNum;
   FILE *file = (FILE*)socket->userPtr;
   bytes = IPRead(socket, buf, sizeof(buf));
   //printf("TfptdCallback bytes=%d\n", bytes);
   if(bytes < 4 || buf[0])
      return;
   if(buf[1] == 1)  //RRQ = Read Request
   {
      if(file)
         fclose(file);
      file = fopen((char*)buf+2, "rb");
      socket->userPtr = file;
      if(file == NULL)
      {
         buf[0] = 0;
         buf[1] = 5;   //ERROR
         buf[2] = 0;
         buf[3] = 0;
         buf[4] = 'X'; //Error string
         buf[5] = 0;
         IPWrite(socket, buf, 6);
         return;
      }
   }
   if(buf[1] == 1 || buf[1] == 4) //ACK
   {
      if(file == NULL)
         return;
      if(buf[1] == 1)
         blockNum = 0;
      else
         blockNum = (buf[2] << 8) | buf[3];
      ++blockNum;
      buf[0] = 0;
      buf[1] = 3;  //DATA
      buf[2] = (uint8)(blockNum >> 8);
      buf[3] = (uint8)blockNum;
      fseek(file, (blockNum-1)*512, 0);
      bytes = fread(buf+4, 1, 512, file);
      IPWrite(socket, buf, bytes+4);
   }
}
 
 
void TftpdInit(void)
{
   IPSocket *socket;
   socket = IPOpen(IP_MODE_UDP, 0, 69, TftpdCallback);
}
 
 
//******************* TFTP Client ************************
 
 
static void TftpCallback(IPSocket *socket)
{
   unsigned char buf[512+4];
   int bytes, blockNum, length;
 
   bytes = IPRead(socket, buf, sizeof(buf));
   if(bytes < 4 || buf[0])
      return;
   blockNum = (buf[2] << 8) | buf[3];
   length = blockNum * 512 - 512 + bytes - 4;
   //printf("TftpCallback(%d,%d)\n", buf[1], blockNum);
   if(length > (int)socket->userData)
   {
      bytes -= length - (int)socket->userData;
      length = (int)socket->userData;
   }
   if(buf[1] == 3) //DATA
   {
      memcpy((uint8*)socket->userPtr + blockNum * 512 - 512, buf+4, bytes-4);
      buf[1] = 4; //ACK
      IPWrite(socket, buf, 4);
      if(bytes-4 < 512)
      {
         socket->userFunc(socket, (uint8*)socket->userPtr, length);
         IPClose(socket);
      }
   }
}
 
 
IPSocket *TftpTransfer(uint32 ip, char *filename, uint8 *buffer, int size,
                       IPCallbackPtr callback)
{
   IPSocket *socket;
   uint8 buf[512+4];
   int bytes;
   socket = IPOpen(IP_MODE_UDP, ip, 69, TftpCallback);
   if(socket == NULL)
      return NULL;
   socket->userPtr = buffer;
   socket->userData = size;
   socket->userFunc = callback;
   buf[0] = 0;
   buf[1] = 1; //read
   strcpy((char*)buf+2, filename);
   bytes = strlen(filename);
   strcpy((char*)buf+bytes+3, "octet");
   IPWrite(socket, buf, bytes+9);
   return socket;
}
 
 
//******************* Telnet Server ************************
 
#define COMMAND_BUFFER_SIZE 80
#define COMMAND_BUFFER_COUNT 10
static char CommandHistory[400];
static char *CommandPtr[COMMAND_BUFFER_COUNT];
static int CommandIndex;
static OS_Semaphore_t *semProtect;
 
typedef void (*ConsoleFunc)(IPSocket *socket, char *argv[]);
typedef struct {
   char *name;
   ConsoleFunc func;
} TelnetFunc_t;
static TelnetFunc_t *TelnetFuncList;
 
static int TelnetGetLine(IPSocket *socket, uint8 *bufIn, int bytes)
{
   int i, j, length;
   char *ptr, *command = (char*)socket->userPtr;
   char bufOut[32];
 
   length = (int)strlen(command);
   for(j = 0; j < bytes; ++j)
   {
      if(bufIn[j] == 255)
         break;
      if(bufIn[j] == 8 || (bufIn[j] == 27 && bufIn[j+2] == 'D'))
      {
         if(bufIn[j] == 27)
            j += 2;
         if(length)
         {
            // Backspace
            command[--length] = 0;
            bufOut[0] = 8;
            bufOut[1] = ' ';
            bufOut[2] = 8;
            IPWrite(socket, (uint8*)bufOut, 3);
            IPWriteFlush(socket);
         }
      }
      else if(bufIn[j] == 27)
      {
         // Command History
         if(bufIn[j+2] == 'A')
         {
            if(++CommandIndex > COMMAND_BUFFER_COUNT)
               CommandIndex = COMMAND_BUFFER_COUNT;
         }
         else if(bufIn[j+2] == 'B')
         {
            if(--CommandIndex < 0)
               CommandIndex = 0;
         }
         else
            return -1;
         bufOut[0] = 8;
         bufOut[1] = ' ';
         bufOut[2] = 8;
         for(i = 0; i < length; ++i)
            IPWrite(socket, (uint8*)bufOut, 3);
         command[0] = 0;
         if(CommandIndex && CommandPtr[CommandIndex-1])
            strncat(command, CommandPtr[CommandIndex-1], COMMAND_BUFFER_SIZE-1);
         length = (int)strlen(command);
         IPWrite(socket, (uint8*)command, length);
         IPWriteFlush(socket);
         j += 2;
      }
      else
      {
         if(bufIn[j] == 0)
            bufIn[j] = '\n';  //Linux support
         if(length < COMMAND_BUFFER_SIZE-4 || (length <
            COMMAND_BUFFER_SIZE-2 && (bufIn[j] == '\r' || bufIn[j] == '\n')))
         {
            IPWrite(socket, (uint8*)bufIn+j, 1);
            IPWriteFlush(socket);
            command[length] = bufIn[j];
            command[++length] = 0;
         }
      }
      ptr = strstr(command, "\r\n");
      if(ptr == NULL)
         ptr = strstr(command, "\n");
      if(ptr)
      {
         // Save command in CommandHistory
         ptr[0] = 0;
         length = (int)strlen(command);
         if(length == 0)
         {
            IPPrintf(socket, "\n-> ");
            continue;
         }
         if(length < COMMAND_BUFFER_SIZE)
         {
            OS_SemaphorePend(semProtect, OS_WAIT_FOREVER);
            memmove(CommandHistory + length + 1, CommandHistory,
               sizeof(CommandHistory) - length - 1);
            strcpy(CommandHistory, command);
            CommandHistory[sizeof(CommandHistory)-1] = 0;
            for(i = COMMAND_BUFFER_COUNT-2; i >= 0; --i)
            {
               if(CommandPtr[i] == NULL || CommandPtr[i] + length + 1 >=
                  CommandHistory + sizeof(CommandHistory))
                  CommandPtr[i+1] = NULL;
               else
                  CommandPtr[i+1] = CommandPtr[i] + length + 1;
            }
            CommandPtr[0] = CommandHistory;
            OS_SemaphorePost(semProtect);
         }
         return 0;
      }
   }
   return -1;
}
 
 
static void TelnetServerCallback(IPSocket *socket)
{
   uint8 bufIn[COMMAND_BUFFER_SIZE+4];
   int bytes, i, k, found, rc;
   char *ptr, *command = (char*)socket->userPtr;
   char command2[COMMAND_BUFFER_SIZE];
   char *argv[10];
 
   if(socket->state > IP_TCP)
      return;
   for(;;)
   {
      memset(bufIn, 0, sizeof(bufIn));
      bytes = IPRead(socket, bufIn, sizeof(bufIn)-4);
      if(command == NULL)
      {
         socket->userPtr = command = (char*)malloc(COMMAND_BUFFER_SIZE);
         if(command == NULL)
         {
            IPClose(socket);
            return;
         }
         socket->timeoutReset = 60*15;
         bufIn[0] = 255; //IAC
         bufIn[1] = 251; //WILL
         bufIn[2] = 3;   //suppress go ahead
         bufIn[3] = 255; //IAC
         bufIn[4] = 251; //WILL
         bufIn[5] = 1;   //echo
         strcpy((char*)bufIn+6, "Welcome to Plasma.\r\n-> ");
         IPWrite(socket, bufIn, 6+23);
         IPWriteFlush(socket);
         command[0] = 0;
         OS_ThreadInfoSet(OS_ThreadSelf(), 0, (void*)socket);  //for stdin and stdout
         return;
      }
      if(bytes == 0)
         return;
      socket->dontFlush = 0;
      bufIn[bytes] = 0;
 
      //Get a complete command line
      rc = TelnetGetLine(socket, bufIn, bytes);
      if(rc)
         continue;
      strcpy(command2, command);
      command[0] = 0;
 
      //Process arguments
      for(i = 0; i < 10; ++i)
         argv[i] = "";
      i = 0;
      argv[i++] = command2;
      for(ptr = command2; *ptr && i < 10; ++ptr)
      {
         if(*ptr == ' ')
         {
            *ptr = 0;
            argv[i++] = ptr + 1;
         }
      }
      if(argv[0][0] == 0)
      {
         IPPrintf(socket, "-> ");
         continue;
      }
 
      //Check for file in or out
      for(k = 1; k < 9; ++k)
      {
         if(argv[k][0] == '>') //stdout to file?
         {
            if(argv[k][1])
               socket->fileOut = fopen(&argv[k][1], "a");
            else
               socket->fileOut = fopen(argv[k+1], "a");
            argv[k] = "";
         }
         if(argv[k][0] == '<') //stdin from file?
         {
            if(argv[k][1])
               socket->fileIn = fopen(&argv[k][1], "r");
            else
               socket->fileIn = fopen(argv[k+1], "r");
            argv[k] = "";
         }
      }
 
      //Find command
      found = 0;
      for(i = 0; TelnetFuncList[i].name; ++i)
      {
         if(strcmp(argv[0], TelnetFuncList[i].name) == 0 &&
            TelnetFuncList[i].func)
         {
            found = 1;
            TelnetFuncList[i].func(socket, argv);
            break;
         }
      }
#ifndef EXCLUDE_DLL
      if(found == 0)
      {
         FILE *file = fopen(argv[0], "r");
         if(file)
         {
            fclose(file);
            ConsoleRun(socket, argv);
         }
         else
         {
            strcpy((char*)bufIn, "/flash/bin/");
            strcat((char*)bufIn, argv[0]);
            argv[0] = (char*)bufIn;
            ConsoleRun(socket, argv);
         }
      }
#endif
      if(socket->fileOut)
      {
         fwrite("\r\n", 1, 2, (FILE*)socket->fileOut);
         fclose((FILE*)socket->fileOut);
         socket->fileOut = NULL;
      }
 
      if(socket->state > IP_TCP)
         return;
      CommandIndex = 0;
      if(socket->dontFlush == 0)
         IPPrintf(socket, "\r\n-> ");
   }
}
 
 
static void TelnetThread(void *socketIn)
{
   IPSocket *socket = (IPSocket*)socketIn;
 
   while(socket->state <= IP_TCP)
   {
      OS_SemaphorePend(socket->userSemaphore, OS_WAIT_FOREVER);
      TelnetServerCallback(socket);
   }
   if(socket->userPtr)
      free(socket->userPtr);
   socket->userPtr = NULL;
   OS_SemaphoreDelete(socket->userSemaphore);
   socket->userSemaphore = NULL;
   OS_ThreadExit();
}
 
 
static void TelnetServer(IPSocket *socket)
{
   if(socket->state <= IP_TCP && socket->userSemaphore == NULL)
   {
      socket->userSemaphore = OS_SemaphoreCreate("telnet", 0);
      OS_ThreadCreate("telnet", TelnetThread, socket, 100, 1024*8);
   }
   if(socket->userSemaphore)
      OS_SemaphorePost(socket->userSemaphore);
}
 
 
void TelnetInit(TelnetFunc_t *funcList)
{
   IPSocket *socket;
   TelnetFuncList = funcList;
   semProtect = OS_SemaphoreCreate("telprot", 1);
#ifndef WIN32
   socket = IPOpen(IP_MODE_TCP, 0, 23, TelnetServer);  //create thread
#else
   socket = IPOpen(IP_MODE_TCP, 0, 23, TelnetServerCallback);
#endif
}
 
 
//******************* Console ************************
 
#define STORAGE_SIZE 1024*64
static uint8 *myStorage;
static IPSocket *socketTelnet;
static char storageFilename[60];
 
 
int ConsoleScanf(char *format,
   int arg0, int arg1, int arg2, int arg3,
   int arg4, int arg5, int arg6, int arg7)
{
   IPSocket *socket = (IPSocket*)OS_ThreadInfoGet(OS_ThreadSelf(), 0);
   char *command = (char*)socket->userPtr;
   uint8 bufIn[256];
   int bytes;
   int rc;
 
   while(socket->state <= IP_TCP)
   {
      bytes = IPRead(socket, (unsigned char*)bufIn, sizeof(bufIn));
      rc = TelnetGetLine(socket, bufIn, bytes);
      if(rc == 0)
         break;
      OS_ThreadSleep(1);
   }
 
   rc = sscanf(command, format, arg0, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
   command[0] = 0;
   return rc;
}
 
 
int ConsoleKbhit(void)
{
   IPSocket *socket = (IPSocket*)OS_ThreadInfoGet(OS_ThreadSelf(), 0);
 
   if(socket->state > IP_TCP || socket->frameReadTail || socket->fileIn)
      return 1;
   return 0;
}
 
 
int ConsoleGetch(void)
{
   unsigned char buffer[8];
   int rc, i;
 
   for(i = 0; i < 100*60; ++i)
   {
      if(ConsoleKbhit())
         break;
      OS_ThreadSleep(5);
   }
 
   rc = IPRead(NULL, buffer, 1);
   if(rc <= 0)
      return -1;
   return buffer[0];
}
 
 
int ConsolePrintf(char *format,
   int arg0, int arg1, int arg2, int arg3,
   int arg4, int arg5, int arg6, int arg7)
{
   return IPPrintf(NULL, format, arg0, arg1, arg2, arg3, arg4, arg5, arg6, arg7);
}
 
 
static void ConsoleHelp(IPSocket *socket, char *argv[])
{
   char buf[200];
   int i;
   (void)argv;
   strcpy(buf, "Version " __DATE__ " " __TIME__ "\nCommands: ");
   for(i = 0; TelnetFuncList[i].name; ++i)
   {
      if(TelnetFuncList[i].func)
      {
         if(i)
            strcat(buf, ", ");
         strcat(buf, TelnetFuncList[i].name);
      }
   }
   IPPrintf(socket, buf);
}
 
 
static void ConsoleExit(IPSocket *socket, char *argv[])
{
   IPClose(socket);
}
 
 
static void ConsoleMemcpyReboot(int *dst, int *src, int length)
{
   OS_FuncPtr_t funcPtr = (OS_FuncPtr_t)dst;
   while(length-- > 0)
      *dst++ = *src++;
   funcPtr(NULL);
}
 
 
static void ConsoleReboot(IPSocket *socket, char *argv[])
{
   FILE *file = NULL;
   OS_FuncPtr_t funcPtr;
   unsigned char *ptr;
   int length;
   (void)socket;
 
   if(argv[1][0])
      file = fopen(argv[1], "r");
#ifndef EXCLUDE_FLASH
   if(file && strcmp(argv[2], "flash") == 0)
   {
      unsigned char buffer[64];
      int offset;
 
      FlashErase(0);  //erase 128KB sector
      offset = 0;
      for(;;)
      {
         length = fread(buffer, 1, sizeof(buffer), file);
         if(length == 0)
            break;
         FlashWrite((uint16*)buffer, offset, length);
         offset += length;
      }
      fclose(file);
      file = NULL;
   }
#endif
   if(file)
   {
      //Reboot running new image
      typedef void (*RebootFunc)(int *, int *, int);
      typedef void (*MemcpyFunc)(int *dst, int *src, int length);
      union {  //convert from function pointer to data pointer
         RebootFunc rebootFunc;
         MemcpyFunc memcpyFunc;
         unsigned char *ptr;
      } rfUnion;
 
      ptr=(unsigned char*)malloc(256+1024*128);
      if(ptr == NULL)
         return;
      rfUnion.memcpyFunc = ConsoleMemcpyReboot;
      memcpy(ptr, rfUnion.ptr, 256);   //rfUnion.ptr==ConsoleMemcpyReboot
      rfUnion.ptr = ptr;
      ptr += 256;
      length = fread(ptr, 1, 128*1024, file) + 3;
      fclose(file);
      printf("rebooting 0x%x 0x%x %d\n", (int)rfUnion.rebootFunc, (int)ptr, length);
      OS_ThreadSleep(100);
      OS_CriticalBegin();
      rfUnion.rebootFunc((int*)RAM_EXTERNAL_BASE, (int*)ptr, length>>2);
   }
   funcPtr = NULL;
   OS_CriticalBegin();
   funcPtr(NULL);        //jump to address 0
}
 
 
static void ConsoleCat(IPSocket *socket, char *argv[])
{
   FILE *file;
   uint8 buf[200];
   int bytes;
 
   file = fopen(argv[1], "r");
   if(file == NULL)
      return;
   for(;;)
   {
      bytes = fread(buf, 1, sizeof(buf), file);
      if(bytes == 0)
         break;
      IPWrite(socket, buf, bytes);
   }
   fclose(file);
}
 
 
static void ConsoleCp(IPSocket *socket, char *argv[])
{
   FILE *fileIn, *fileOut;
   uint8 buf[200];
   int bytes;
   (void)socket;
 
   fileOut = fopen(argv[2], "r");
   if(fileOut)
   {
      IPPrintf(socket, "File already exists!\n");
      fclose(fileOut);
      return;
   }
   fileIn = fopen(argv[1], "r");
   if(fileIn == NULL)
   {
      IPPrintf(socket, "Error!\n");
      return;
   }
   fileOut = fopen(argv[2], "w");
   if(fileOut)
   {
      for(;;)
      {
         bytes = fread(buf, 1, sizeof(buf), fileIn);
         if(bytes == 0)
            break;
         fwrite(buf, 1, bytes, fileOut);
      }
      fclose(fileOut);
   }
   fclose(fileIn);
}
 
 
static void ConsoleRm(IPSocket *socket, char *argv[])
{
   (void)socket;
   OS_fdelete(argv[1]);
}
 
 
static void ConsoleMkdir(IPSocket *socket, char *argv[])
{
   (void)socket;
   OS_fmkdir(argv[1]);
}
 
 
static void ConsoleLs(IPSocket *socket, char *argv[])
{
   FILE *file;
   char buf[200], buf2[80];
   int bytes, width;
 
   file = fopen(argv[1], "r");
   if(file == NULL)
      return;
   width = 0;
   for(;;)
   {
      bytes = OS_fdir(file, buf);
      if(bytes)
         break;
      if((unsigned char)buf[0] == 255)
         continue;
      bytes = OS_flength(buf);
      sprintf(buf2, "%s:%d                    ", buf, bytes);
      bytes = strlen(buf2);
      bytes -= bytes % 20;
      buf2[bytes] = 0;
      width += bytes;
      if(width == 80)
         --bytes;
      if(width > 80)
      {
         IPPrintf(socket, "\n");
         width = bytes;
      }
      IPPrintf(socket, "%s", buf2);
   }
   fclose(file);
}
 
 
#ifndef EXCLUDE_FLASH
static void ConsoleFlashErase(IPSocket *socket, char *argv[])
{
   int bytes;
   OS_FuncPtr_t funcPtr = NULL;
   (void)argv;
   IPPrintf(socket, "\r\nErasing\n");
   OS_ThreadSleep(10);
   OS_CriticalBegin();
   for(bytes = 1024*128; bytes < 1024*1024*16; bytes += 1024*128)
   {
      UartPrintfCritical(".");
      FlashErase(bytes);
   }
   funcPtr(NULL);      //jump to address 0
}
#endif
 
 
static void ConsoleMath(IPSocket *socket, char *argv[])
{
   int v1, v2, ch;
   if(argv[3][0] == 0)
   {
      IPPrintf(socket, "Usage: math <number> <operator> <value>\r\n");
      return;
   }
   v1 = atoi(argv[1]);
   ch = argv[2][0];
   v2 = atoi(argv[3]);
   if(ch == '+')
      v1 += v2;
   else if(ch == '-')
      v1 -= v2;
   else if(ch == '*')
      v1 *= v2;
   else if(ch == '/')
   {
      if(v2 != 0)
         v1 /= v2;
   }
   IPPrintf(socket, "%d", v1);
}
 
 
static void PingCallback(IPSocket *socket)
{
   IPSocket *socket2 = (IPSocket*)socket->userPtr;
   IPClose(socket);
   if(socket2)
      IPPrintf(socket2, "Ping Reply");
   else
      printf("Ping Reply\n");
}
 
 
static void DnsResultCallback(IPSocket *socket, uint8 *arg, int ipIn)
{
   char buf[COMMAND_BUFFER_SIZE];
   IPSocket *socketTelnet = (IPSocket*)arg;
   IPSocket *socketPing;
   uint32 ip=ipIn;
   (void)socket;
 
   sprintf(buf,  "ip=%d.%d.%d.%d\r\n",
      (uint8)(ip >> 24), (uint8)(ip >> 16), (uint8)(ip >> 8), (uint8)ip);
   IPPrintf(socketTelnet, buf);
   socketPing = IPOpen(IP_MODE_PING, ip, 0, PingCallback);
   if(socketPing == NULL)
      return;
   socketPing->userPtr = socketTelnet;
   buf[0] = 'A';
   IPWrite(socketPing, (uint8*)buf, 1);
}
 
 
static void ConsolePing(IPSocket *socket, char *argv[])
{
   int ip0, ip1, ip2, ip3;
 
   if('0' <= argv[1][0] && argv[1][0] <= '9')
   {
      sscanf(argv[1], "%d.%d.%d.%d", &ip0, &ip1, &ip2, &ip3);
      ip0 = (ip0 << 24) | (ip1 << 16) | (ip2 << 8) | ip3;
      DnsResultCallback(socket, (uint8*)socket, ip0);
   }
   else
   {
      IPResolve(argv[1], DnsResultCallback, (void*)socket);
      IPPrintf(socket, "Sent DNS request");
   }
}
 
 
static void ConsoleTransferDone(IPSocket *socket, uint8 *data, int length)
{
   FILE *file;
   (void)socket;
 
   IPPrintf(socketTelnet, "Transfer Done");
   file = fopen(storageFilename, "w");
   if(file)
   {
      fwrite(data, 1, length, file);
      fclose(file);
   }
   if(myStorage)
      free(myStorage);
   myStorage = NULL;
}
 
 
static void ConsoleFtp(IPSocket *socket, char *argv[])
{
   int ip0, ip1, ip2, ip3;
   if(argv[1][0] == 0)
   {
      IPPrintf(socket, "ftp #.#.#.# User Password File");
      return;
   }
   sscanf(argv[1], "%d.%d.%d.%d", &ip0, &ip1, &ip2, &ip3);
   ip0 = (ip0 << 24) | (ip1 << 16) | (ip2 << 8) | ip3;
   socketTelnet = socket;
   if(myStorage == NULL)
      myStorage = (uint8*)malloc(STORAGE_SIZE);
   if(myStorage == NULL)
      return;
   strcpy(storageFilename, argv[4]);
   FtpTransfer(ip0, argv[2], argv[3], argv[4], myStorage, STORAGE_SIZE-1,
      0, ConsoleTransferDone);
}
 
 
static void ConsoleTftp(IPSocket *socket, char *argv[])
{
   int ip0, ip1, ip2, ip3;
   if(argv[1][0] == 0)
   {
      IPPrintf(socket, "tftp #.#.#.# File");
      return;
   }
   sscanf(argv[1], "%d.%d.%d.%d", &ip0, &ip1, &ip2, &ip3);
   ip0 = (ip0 << 24) | (ip1 << 16) | (ip2 << 8) | ip3;
   socketTelnet = socket;
   if(myStorage == NULL)
      myStorage = (uint8*)malloc(STORAGE_SIZE);
   if(myStorage == NULL)
      return;
   strcpy(storageFilename, argv[2]);
   TftpTransfer(ip0, argv[2], myStorage, STORAGE_SIZE-1, ConsoleTransferDone);
}
 
 
static void ConsoleMkfile(IPSocket *socket, char *argv[])
{
   OS_FILE *file;
   (void)argv;
   file = fopen("myfile.txt", "w");
   if(file == NULL)
      return;
   fwrite("Hello World!", 1, 12, file);
   fclose(file);
   IPPrintf(socket, "Created myfile.txt");
}
 
 
static void ConsoleUptime(IPSocket *socket, char *argv[])
{
   unsigned int ticks;
   unsigned int days, hours, minutes, seconds;
   (void)argv;
 
   //ticks per sec = 25E6/2^18 = 95.36743 -> 10.48576 ms/tick
   ticks = OS_ThreadTime();      // 1/(1-95.3674/95) = -259
   seconds = (ticks - ticks / 259) / 95;
   minutes = seconds / 60 % 60;
   hours = seconds / 3600 % 24;
   days = seconds / 3600 / 24;
   seconds %= 60;
   IPPrintf(socket, "%d days %2d:%2d:%2d\n", days, hours, minutes, seconds);
}
 
 
static void ConsoleDump(IPSocket *socket, char *argv[])
{
   FILE *fileIn;
   uint8 buf[16];
   int bytes, i, j;
 
   fileIn = fopen(argv[1], "r");
   if(fileIn == NULL)
      return;
   for(j = 0; j < 1024*1024*16; j += 16)
   {
      bytes = fread(buf, 1, 16, fileIn);
      if(bytes == 0)
         break;
      IPPrintf(socket, "%8x ", j);
      for(i = 0; i < bytes; ++i)
         IPPrintf(socket, "%2x ", buf[i]);
      for( ; i < 16; ++i)
         IPPrintf(socket, "   ");
      for(i = 0; i < bytes; ++i)
      {
         if(isprint(buf[i]))
            IPPrintf(socket, "%c", buf[i]);
         else
            IPPrintf(socket, ".");
      }
      IPPrintf(socket, "\n");
   }
   fclose(fileIn);
}
 
 
static void ConsoleGrep(IPSocket *socket, char *argv[])
{
   FILE *fileIn;
   char buf[200];
   int bytes;
   char *ptr, *ptrEnd;
 
   if(argv[1][0] == 0 || argv[2][0] == 0)
   {
      IPPrintf(socket, "Usage: grep pattern file\n");
      return;
   }
   fileIn = fopen(argv[2], "r");
   if(fileIn == NULL)
      return;
   bytes = 0;
   for(;;)
   {
      bytes += fread(buf + bytes, 1, sizeof(buf) - bytes - 1, fileIn);
      if(bytes == 0)
         break;
      buf[bytes] = 0;
      ptrEnd = strstr(buf, "\r");
      if(ptrEnd == NULL)
         ptrEnd = strstr(buf, "\n");
      if(ptrEnd)
      {
         *ptrEnd = 0;
         if(*++ptrEnd == '\n')
            ++ptrEnd;
      }
      ptr = strstr(buf, argv[1]);
      if(ptr)
         IPPrintf(socket, "%s\n", buf);
      if(ptrEnd)
      {
         bytes = strlen(ptrEnd);
         memcpy(buf, ptrEnd, bytes);
      }
      else
      {
         bytes = 0;
      }
   }
   fclose(fileIn);
}
 
 
#ifndef EXCLUDE_DLL
#ifndef WIN32
#undef DLL_SETUP
#define DLL_SETUP
#include "dll.h"
#else
typedef void *(*DllFunc)();
DllFunc DllFuncList[1];
#define ntohl(A) (((A)>>24)|(((A)&0x00ff0000)>>8)|(((A)&0xff00)<<8)|((A)<<24))
#define ntohs(A) (uint16)((((A)&0xff00)>>8)|((A)<<8))
#endif
 
typedef struct
{
   uint8 e_ident[16];
   uint16 e_e_type;
   uint16 e_machine;
   uint32 e_version;
   uint32 e_entry;
   uint32 e_phoff;
   uint32 e_shoff;
   uint32 e_flags;
   uint16 e_ehsize;
   uint16 e_phentsize;
   uint16 e_phnum;
   uint16 e_shentsize;
   uint16 e_shnum;
   uint16 e_shstrndx;
} ElfHeader;
 
typedef struct
{
   uint32 p_type;
   uint32 p_offset;
   uint32 p_vaddr;
   uint32 p_paddr;
   uint32 p_filesz;
   uint32 p_memsz;
   uint32 p_flags;
   uint32 p_align;
} Elf32_Phdr;
 
 
static unsigned int ConsoleLoadElf(FILE *file, uint8 *ptr)
{
   int i;
   ElfHeader *elfHeader = (ElfHeader*)ptr;
   Elf32_Phdr *elfProgram;
#ifdef WIN32
   elfHeader->e_entry = ntohl(elfHeader->e_entry);
   elfHeader->e_phoff = ntohl(elfHeader->e_phoff);
   elfHeader->e_phentsize = ntohs(elfHeader->e_phentsize);
   elfHeader->e_phnum = ntohs(elfHeader->e_phnum);
#endif
   //printf("Entry=0x%x ", elfHeader->e_entry);
   OS_ThreadSleep(10);
 
   for(i = 0; i < elfHeader->e_phnum; ++i)
   {
      elfProgram = (Elf32_Phdr*)(ptr + elfHeader->e_phoff +
                         elfHeader->e_phentsize * i);
#ifdef WIN32
      elfProgram->p_offset = ntohl(elfProgram->p_offset);
      elfProgram->p_vaddr = ntohl(elfProgram->p_vaddr);
      elfProgram->p_filesz = ntohl(elfProgram->p_filesz);
#endif
      //printf("0x%x 0x%x 0x%x\n", elfProgram->p_vaddr, elfProgram->p_offset, elfProgram->p_filesz);
      fseek(file, elfProgram->p_offset, 0);
#ifndef WIN32
      fread((char*)elfProgram->p_vaddr, 1, elfProgram->p_filesz, file);
#endif
   }
   return elfHeader->e_entry;
}
 
 
void ConsoleRun(IPSocket *socket, char *argv[])
{
   FILE *file;
   int bytes, i, run=0;
   uint8 code[256];
   char *argv2[12];
   DllFunc funcPtr;
 
   if(strcmp(argv[0], "run") == 0)
   {
      run = 1;
      ++argv;
   }
   file = fopen(argv[0], "r");
   if(file == NULL)
   {
      IPPrintf(socket, "Can't find %s", argv[0]);
      return;
   }
 
   memset(code, 0, sizeof(code));
   bytes = fread(code, 1, sizeof(code), file);  //load first bytes
   if(strncmp((char*)code + 1, "ELF", 3) == 0)
   {
      funcPtr = (DllFunc)ConsoleLoadElf(file, code);
      fclose(file);
      argv2[0] = (char*)socket;
      argv2[1] = (char*)DllFuncList;  //DllF = argv[-1]
      for(i = 0; i < 10; ++i)
      {
         argv2[i + 2] = argv[i];
         if(argv[i] == NULL || argv[i][0] == 0)
            break;
      }
#ifndef WIN32
      funcPtr(i, argv2 + 2);
#endif
      return;
   }
   if(run == 0)
   {
      fclose(file);
      return;
   }
 
   socket->fileIn = file;       //script file
   fseek(file, 0, 0);
}
 
 
typedef struct NameValue_t {
   struct NameValue_t *next;
   void *value;
   char name[4];
} NameValue_t;
 
//Find the value associated with the name
void *IPNameValue(const char *name, void *value)
{
   static NameValue_t *head;
   NameValue_t *node;
   OS_SemaphorePend(semProtect, OS_WAIT_FOREVER);
   for(node = head; node; node = node->next)
   {
      if(strcmp(node->name, name) == 0)
         break;
   }
   if(node == NULL)
   {
      node = (NameValue_t*)malloc(sizeof(NameValue_t) + (int)strlen(name));
      if(node == NULL)
         return NULL;
      strcpy(node->name, name);
      node->value = value;
      node->next = head;
      head = node;
   }
   if(value)
      node->value = value;
   OS_SemaphorePost(semProtect);
   return node->value;
}
#endif
 
 
#ifdef EDIT_FILE
extern void EditFile(IPSocket *socket, char *argv[]);
#endif
 
static TelnetFunc_t MyFuncs[] = {
   {"cat", ConsoleCat},
   {"cp", ConsoleCp},
   {"dump", ConsoleDump},
   {"exit", ConsoleExit},
#ifndef EXCLUDE_FLASH
   {"flashErase", ConsoleFlashErase},
#endif
   {"ftp", ConsoleFtp},
   {"grep", ConsoleGrep},
   {"help", ConsoleHelp},
   {"ls", ConsoleLs},
   {"math", ConsoleMath},
   {"mkdir", ConsoleMkdir},
   {"mkfile", ConsoleMkfile},
   {"ping", ConsolePing},
   {"reboot", ConsoleReboot},
   {"rm", ConsoleRm},
   {"tftp", ConsoleTftp},
   {"uptime", ConsoleUptime},
#ifndef EXCLUDE_DLL
   {"run", ConsoleRun},
#endif
#ifdef EDIT_FILE
   {"edit", EditFile},
#endif
   {NULL, NULL}
};
 
 
void ConsoleInit(void)
{
   FtpdInit(1);
   TftpdInit();
   TelnetInit(MyFuncs);
}

Line No.	Rev	Author	Line
1	354	rhoads	`/*--------------------------------------------------------------------`
2			`* TITLE: Plasma TCP/IP Network Utilities`
3			`* AUTHOR: Steve Rhoads (rhoadss@yahoo.com)`
4			`* DATE CREATED: 4/20/07`
5			`* FILENAME: netutil.c`
6			`* PROJECT: Plasma CPU core`
7			`* COPYRIGHT: Software placed into the public domain by the author.`
8			`* Software 'as is' without warranty. Author liable for nothing.`
9			`* DESCRIPTION:`
10			`* Plasma FTP server and FTP client and TFTP server and client`
11			`* and Telnet server.`
12			`--------------------------------------------------------------------/`
13	416	rhoads	`#define INSIDE_NETUTIL`
14			`#include "plasma.h"`
15	354	rhoads	`#include "rtos.h"`
16			`#include "tcpip.h"`
17
18	416	rhoads	`#ifndef EXCLUDE_DLL`
19	424	rhoads	`void ConsoleRun(IPSocket socket, char argv[]);`
20	354	rhoads	`#endif`
21
22			`//***************** FTP Server **********************`
23			`typedef struct {`
24			`IPSocket *socket;`
25			`int ip, port, bytes, done, canReceive;`
26			`FILE *file;`
27			`} FtpdInfo;`
28
29			`static void FtpdSender(IPSocket *socket)`
30			`{`
31			`unsigned char buf[600];`
32			`int i, bytes, bytes2;`
33			`FtpdInfo info = (FtpdInfo)socket->userPtr;`
34
35			`if(info == NULL \|\| info->done)`
36			`return;`
37			`fseek(info->file, info->bytes, 0);`
38			`for(i = 0; i < 100000; ++i)`
39			`{`
40			`bytes = fread(buf, 1, 512, info->file);`
41			`bytes2 = IPWrite(socket, buf, bytes);`
42			`info->bytes += bytes2;`
43			`if(bytes != bytes2)`
44			`return;`
45			`if(bytes < 512)`
46			`{`
47			`fclose(info->file);`
48			`IPClose(socket);`
49			`info->done = 1;`
50			`IPPrintf(info->socket, "226 Done\r\n");`
51			`return;`
52			`}`
53			`}`
54			`}`
55
56
57			`static void FtpdReceiver(IPSocket *socket)`
58			`{`
59			`unsigned char buf[600];`
60			`int bytes, state = socket->state;`
61			`FtpdInfo info = (FtpdInfo)socket->userPtr;`
62	419	rhoads	`int total = 0;`
63	354	rhoads
64			`if(info == NULL \|\| info->done)`
65			`return;`
66			`do`
67			`{`
68			`bytes = IPRead(socket, buf, sizeof(buf));`
69			`fwrite(buf, 1, bytes, info->file);`
70	419	rhoads	`total += bytes;`
71	354	rhoads	`} while(bytes);`
72
73	419	rhoads	`if(state > IP_TCP && total == 0)`
74	354	rhoads	`{`
75			`fclose(info->file);`
76			`info->done = 1;`
77			`IPPrintf(info->socket, "226 Done\r\n");`
78			`IPClose(socket);`
79			`return;`
80			`}`
81			`}`
82
83
84			`static void FtpdServer(IPSocket *socket)`
85			`{`
86			`uint8 buf[600];`
87			`int bytes;`
88			`int ip0, ip1, ip2, ip3, port0, port1;`
89			`IPSocket *socketOut;`
90	425	rhoads	`FtpdInfo *info;`
91	354	rhoads
92			`if(socket == NULL)`
93			`return;`
94	425	rhoads	`info = (FtpdInfo*)socket->userPtr;`
95	354	rhoads	`bytes = IPRead(socket, buf, sizeof(buf)-1);`
96			`buf[bytes] = 0;`
97			`//printf("(%s)\n", buf);`
98			`if(socket->userPtr == NULL)`
99			`{`
100			`info = (FtpdInfo*)malloc(sizeof(FtpdInfo));`
101			`if(info == NULL)`
102			`return;`
103			`memset(info, 0, sizeof(FtpdInfo));`
104			`socket->userPtr = info;`
105			`info->socket = socket;`
106			`socket->timeoutReset = 60;`
107			`IPPrintf(socket, "220 Connected to Plasma\r\n");`
108			`}`
109			`else if(socket->userPtr == (void*)-1)`
110			`{`
111			`return;`
112			`}`
113			`else if(strstr((char*)buf, "USER"))`
114			`{`
115			`if(strstr((char*)buf, "PlasmaSend"))`
116			`info->canReceive = 1;`
117			`IPPrintf(socket, "331 Password?\r\n");`
118			`}`
119			`else if(strstr((char*)buf, "PASS"))`
120			`{`
121			`IPPrintf(socket, "230 Logged in\r\n");`
122			`}`
123			`else if(strstr((char*)buf, "PORT"))`
124			`{`
125			`sscanf((char*)buf + 5, "%d,%d,%d,%d,%d,%d", &ip0, &ip1, &ip2, &ip3, &port0, &port1);`
126			`info->ip = (ip0 << 24) \| (ip1 << 16) \| (ip2 << 8) \| ip3;`
127			`info->port = (port0 << 8) \| port1;`
128			`//printf("ip=0x%x port=%d\n", info->ip, info->port);`
129			`IPPrintf(socket, "200 OK\r\n");`
130			`}`
131			`else if(strstr((char)buf, "RETR") \|\| strstr((char)buf, "STOR"))`
132			`{`
133			`char ptr = strstr((char)buf, "\r");`
134			`if(ptr)`
135			`*ptr = 0;`
136			`info->file = NULL;`
137			`info->bytes = 0;`
138			`info->done = 0;`
139			`if(strstr((char*)buf, "RETR"))`
140			`info->file = fopen((char*)buf + 5, "rb");`
141	416	rhoads	`else if(info->canReceive && strcmp((char*)buf+5, "/flash/web"))`
142	354	rhoads	`info->file = fopen((char*)buf + 5, "wb");`
143			`if(info->file)`
144			`{`
145			`IPPrintf(socket, "150 File ready\r\n");`
146			`if(strstr((char*)buf, "RETR"))`
147			`socketOut = IPOpen(IP_MODE_TCP, info->ip, info->port, FtpdSender);`
148			`else`
149			`socketOut = IPOpen(IP_MODE_TCP, info->ip, info->port, FtpdReceiver);`
150			`if(socketOut)`
151			`socketOut->userPtr = info;`
152			`}`
153			`else`
154			`{`
155			`IPPrintf(socket, "500 Error\r\n");`
156			`}`
157			`}`
158			`else if(strstr((char*)buf, "QUIT"))`
159			`{`
160			`if(socket->userPtr)`
161			`free(socket->userPtr);`
162			`socket->userPtr = (void*)-1;`
163			`IPPrintf(socket, "221 Bye\r\n");`
164			`IPClose(socket);`
165			`}`
166			`else if(bytes)`
167			`{`
168			`IPPrintf(socket, "500 Error\r\n");`
169			`}`
170			`}`
171
172
173			`void FtpdInit(int UseFiles)`
174			`{`
175			`(void)UseFiles;`
176			`IPOpen(IP_MODE_TCP, 0, 21, FtpdServer);`
177			`}`
178
179
180			`//***************** FTP Client **********************`
181
182			`typedef struct {`
183			`uint32 ip, port;`
184			`char user[80], passwd[80], filename[80];`
185			`uint8 *buf;`
186			`int size, bytes, send, state;`
187			`} FtpInfo;`
188
189
190			`static void FtpCallbackTransfer(IPSocket *socket)`
191			`{`
192			`int bytes, state = socket->state;`
193			`FtpInfo info = (FtpInfo)socket->userPtr;`
194
195			`//printf("FtpCallbackTransfer\n");`
196			`if(info == NULL)`
197			`return;`
198			`bytes = info->size - info->bytes;`
199			`if(info->send == 0)`
200			`bytes = IPRead(socket, info->buf + info->bytes, bytes);`
201			`else`
202			`bytes = IPWrite(socket, info->buf + info->bytes, bytes);`
203			`info->bytes += bytes;`
204			`if(info->bytes == info->size \|\| (bytes == 0 && state > IP_TCP))`
205			`{`
206	400	rhoads	`socket->userFunc(socket, info->buf, info->bytes);`
207	354	rhoads	`free(info);`
208			`socket->userPtr = NULL;`
209			`IPClose(socket);`
210			`}`
211			`}`
212
213
214			`static void FtpCallback(IPSocket *socket)`
215			`{`
216			`char buf[600];`
217			`FtpInfo info = (FtpInfo)socket->userPtr;`
218			`int bytes, value;`
219
220			`bytes = IPRead(socket, (uint8*)buf, sizeof(buf)-1);`
221			`if(bytes == 0)`
222			`return;`
223			`buf[bytes] = 0;`
224			`sscanf(buf, "%d", &value);`
225			`if(bytes > 2)`
226			`buf[bytes-2] = 0;`
227			`//printf("FtpCallback(%d:%s)\n", socket->userData, buf);`
228			`if(value / 100 != 2 && value / 100 != 3)`
229			`return;`
230			`buf[0] = 0;`
231			`switch(socket->userData) {`
232			`case 0:`
233			`sprintf(buf, "USER %s\r\n", info->user);`
234			`socket->userData = 1;`
235			`break;`
236			`case 1:`
237			`sprintf(buf, "PASS %s\r\n", info->passwd);`
238			`socket->userData = 2;`
239			`if(value == 331)`
240			`break; //possible fall-through`
241			`case 2:`
242			`sprintf(buf, "PORT %d,%d,%d,%d,%d,%d\r\n",`
243			`info->ip >> 24, (uint8)(info->ip >> 16),`
244			`(uint8)(info->ip >> 8), (uint8)info->ip,`
245			`(uint8)(info->port >> 8), (uint8)info->port);`
246			`socket->userData = 3;`
247			`break;`
248			`case 3:`
249			`if(info->send == 0)`
250			`sprintf(buf, "RETR %s\r\n", info->filename);`
251			`else`
252			`sprintf(buf, "STOR %s\r\n", info->filename);`
253			`socket->userData = 4;`
254			`break;`
255			`case 4:`
256			`sprintf(buf, "QUIT\r\n");`
257			`socket->userData = 9;`
258			`break;`
259			`}`
260			`IPWrite(socket, (uint8*)buf, strlen(buf));`
261			`IPWriteFlush(socket);`
262			`if(socket->userData == 9)`
263			`IPClose(socket);`
264			`}`
265
266
267			`IPSocket FtpTransfer(uint32 ip, char user, char *passwd,`
268			`char filename, uint8 buf, int size,`
269	400	rhoads	`int send, IPCallbackPtr callback)`
270	354	rhoads	`{`
271			`IPSocket socket, socketTransfer;`
272			`FtpInfo *info;`
273			`uint8 *ptr;`
274			`info = (FtpInfo*)malloc(sizeof(FtpInfo));`
275			`if(info == NULL)`
276			`return NULL;`
277			`strncpy(info->user, user, 80);`
278			`strncpy(info->passwd, passwd, 80);`
279			`strncpy(info->filename, filename, 80);`
280			`info->buf = buf;`
281			`info->size = size;`
282			`info->send = send;`
283			`info->bytes = 0;`
284			`info->state = 0;`
285			`info->port = 2000;`
286			`socketTransfer = IPOpen(IP_MODE_TCP, 0, info->port, FtpCallbackTransfer);`
287	425	rhoads	`if(socketTransfer == NULL)`
288			`return NULL;`
289	354	rhoads	`socketTransfer->userPtr = info;`
290			`socketTransfer->userFunc = callback;`
291			`socket = IPOpen(IP_MODE_TCP, ip, 21, FtpCallback);`
292	425	rhoads	`if(socket == NULL)`
293			`return NULL;`
294	354	rhoads	`socket->userPtr = info;`
295			`socket->userFunc = callback;`
296			`ptr = socket->headerSend;`
297			`info->ip = IPAddressSelf();`
298			`return socket;`
299			`}`
300
301
302			`//***************** TFTP Server **********************`
303
304
305			`static void TftpdCallback(IPSocket *socket)`
306			`{`
307			`unsigned char buf[512+4];`
308			`int bytes, blockNum;`
309			`FILE file = (FILE)socket->userPtr;`
310			`bytes = IPRead(socket, buf, sizeof(buf));`
311			`//printf("TfptdCallback bytes=%d\n", bytes);`
312			`if(bytes < 4 \|\| buf[0])`
313			`return;`
314			`if(buf[1] == 1) //RRQ = Read Request`
315			`{`
316			`if(file)`
317			`fclose(file);`
318			`file = fopen((char*)buf+2, "rb");`
319			`socket->userPtr = file;`
320			`if(file == NULL)`
321			`{`
322			`buf[0] = 0;`
323			`buf[1] = 5; //ERROR`
324			`buf[2] = 0;`
325			`buf[3] = 0;`
326			`buf[4] = 'X'; //Error string`
327			`buf[5] = 0;`
328			`IPWrite(socket, buf, 6);`
329			`return;`
330			`}`
331			`}`
332			`if(buf[1] == 1 \|\| buf[1] == 4) //ACK`
333			`{`
334			`if(file == NULL)`
335			`return;`
336			`if(buf[1] == 1)`
337			`blockNum = 0;`
338			`else`
339			`blockNum = (buf[2] << 8) \| buf[3];`
340			`++blockNum;`
341			`buf[0] = 0;`
342			`buf[1] = 3; //DATA`
343			`buf[2] = (uint8)(blockNum >> 8);`
344			`buf[3] = (uint8)blockNum;`
345			`fseek(file, (blockNum-1)*512, 0);`
346			`bytes = fread(buf+4, 1, 512, file);`
347			`IPWrite(socket, buf, bytes+4);`
348			`}`
349			`}`
350
351
352			`void TftpdInit(void)`
353			`{`
354			`IPSocket *socket;`
355			`socket = IPOpen(IP_MODE_UDP, 0, 69, TftpdCallback);`
356			`}`
357
358
359			`//***************** TFTP Client **********************`
360
361
362			`static void TftpCallback(IPSocket *socket)`
363			`{`
364			`unsigned char buf[512+4];`
365			`int bytes, blockNum, length;`
366
367			`bytes = IPRead(socket, buf, sizeof(buf));`
368			`if(bytes < 4 \|\| buf[0])`
369			`return;`
370			`blockNum = (buf[2] << 8) \| buf[3];`
371			`length = blockNum * 512 - 512 + bytes - 4;`
372			`//printf("TftpCallback(%d,%d)\n", buf[1], blockNum);`
373			`if(length > (int)socket->userData)`
374			`{`
375			`bytes -= length - (int)socket->userData;`
376			`length = (int)socket->userData;`
377			`}`
378			`if(buf[1] == 3) //DATA`
379			`{`
380			`memcpy((uint8)socket->userPtr + blockNum 512 - 512, buf+4, bytes-4);`
381			`buf[1] = 4; //ACK`
382			`IPWrite(socket, buf, 4);`
383			`if(bytes-4 < 512)`
384			`{`
385	416	rhoads	`socket->userFunc(socket, (uint8*)socket->userPtr, length);`
386	354	rhoads	`IPClose(socket);`
387			`}`
388			`}`
389			`}`
390
391
392			`IPSocket TftpTransfer(uint32 ip, char filename, uint8 *buffer, int size,`
393	400	rhoads	`IPCallbackPtr callback)`
394	354	rhoads	`{`
395			`IPSocket *socket;`
396			`uint8 buf[512+4];`
397			`int bytes;`
398			`socket = IPOpen(IP_MODE_UDP, ip, 69, TftpCallback);`
399	425	rhoads	`if(socket == NULL)`
400			`return NULL;`
401	354	rhoads	`socket->userPtr = buffer;`
402			`socket->userData = size;`
403			`socket->userFunc = callback;`
404			`buf[0] = 0;`
405			`buf[1] = 1; //read`
406			`strcpy((char*)buf+2, filename);`
407			`bytes = strlen(filename);`
408			`strcpy((char*)buf+bytes+3, "octet");`
409			`IPWrite(socket, buf, bytes+9);`
410			`return socket;`
411			`}`
412
413
414			`//***************** Telnet Server **********************`
415
416			`#define COMMAND_BUFFER_SIZE 80`
417			`#define COMMAND_BUFFER_COUNT 10`
418			`static char CommandHistory[400];`
419			`static char *CommandPtr[COMMAND_BUFFER_COUNT];`
420			`static int CommandIndex;`
421	416	rhoads	`static OS_Semaphore_t *semProtect;`
422	354	rhoads
423			`typedef void (ConsoleFunc)(IPSocket socket, char *argv[]);`
424			`typedef struct {`
425			`char *name;`
426			`ConsoleFunc func;`
427			`} TelnetFunc_t;`
428			`static TelnetFunc_t *TelnetFuncList;`
429
430	416	rhoads	`static int TelnetGetLine(IPSocket socket, uint8 bufIn, int bytes)`
431	354	rhoads	`{`
432	416	rhoads	`int i, j, length;`
433			`char ptr, command = (char*)socket->userPtr;`
434	354	rhoads	`char bufOut[32];`
435
436	416	rhoads	`length = (int)strlen(command);`
437			`for(j = 0; j < bytes; ++j)`
438			`{`
439			`if(bufIn[j] == 255)`
440			`break;`
441			`if(bufIn[j] == 8 \|\| (bufIn[j] == 27 && bufIn[j+2] == 'D'))`
442			`{`
443			`if(bufIn[j] == 27)`
444			`j += 2;`
445			`if(length)`
446			`{`
447			`// Backspace`
448			`command[--length] = 0;`
449			`bufOut[0] = 8;`
450			`bufOut[1] = ' ';`
451			`bufOut[2] = 8;`
452			`IPWrite(socket, (uint8*)bufOut, 3);`
453			`IPWriteFlush(socket);`
454			`}`
455			`}`
456			`else if(bufIn[j] == 27)`
457			`{`
458			`// Command History`
459			`if(bufIn[j+2] == 'A')`
460			`{`
461			`if(++CommandIndex > COMMAND_BUFFER_COUNT)`
462			`CommandIndex = COMMAND_BUFFER_COUNT;`
463			`}`
464			`else if(bufIn[j+2] == 'B')`
465			`{`
466			`if(--CommandIndex < 0)`
467			`CommandIndex = 0;`
468			`}`
469			`else`
470			`return -1;`
471			`bufOut[0] = 8;`
472			`bufOut[1] = ' ';`
473			`bufOut[2] = 8;`
474			`for(i = 0; i < length; ++i)`
475			`IPWrite(socket, (uint8*)bufOut, 3);`
476			`command[0] = 0;`
477			`if(CommandIndex && CommandPtr[CommandIndex-1])`
478			`strncat(command, CommandPtr[CommandIndex-1], COMMAND_BUFFER_SIZE-1);`
479			`length = (int)strlen(command);`
480			`IPWrite(socket, (uint8*)command, length);`
481			`IPWriteFlush(socket);`
482			`j += 2;`
483			`}`
484			`else`
485			`{`
486			`if(bufIn[j] == 0)`
487			`bufIn[j] = '\n'; //Linux support`
488			`if(length < COMMAND_BUFFER_SIZE-4 \|\| (length <`
489			`COMMAND_BUFFER_SIZE-2 && (bufIn[j] == '\r' \|\| bufIn[j] == '\n')))`
490			`{`
491			`IPWrite(socket, (uint8*)bufIn+j, 1);`
492			`IPWriteFlush(socket);`
493			`command[length] = bufIn[j];`
494			`command[++length] = 0;`
495			`}`
496			`}`
497			`ptr = strstr(command, "\r\n");`
498			`if(ptr == NULL)`
499			`ptr = strstr(command, "\n");`
500			`if(ptr)`

Browse

Tools

Subversion Repositories plasma

[/] [plasma/] [trunk/] [kernel/] [netutil.c] - Blame information for rev 436