More work on TCP, splitted UDI arch dependent out of udi.h, slight work on AxWin
[tpg/acess2.git] / Modules / IPStack / tcp.c
index cfc3efc..dd94b92 100644 (file)
@@ -3,14 +3,17 @@
  * - TCP Handling
  */
 #include "ipstack.h"
+#include "ipv4.h"
 #include "tcp.h"
 
 #define TCP_MIN_DYNPORT        0x1000
+#define TCP_MAX_HALFOPEN       1024    // Should be enough
 
 // === PROTOTYPES ===
 void   TCP_Initialise();
-void   *TCP_Open(tInterface *Interface, Uint16 LocalPort, void *Address, Uint16 Port);
+void   TCP_StartConnection(tTCPConnection *Conn);
 void   TCP_GetPacket(tInterface *Interface, void *Address, int Length, void *Buffer);
+void   TCP_INT_HandleConnectionPacket(tTCPConnection *Connection, tTCPHeader *Header);
 Uint16 TCP_GetUnusedPort();
  int   TCP_AllocatePort(Uint16 Port);
  int   TCP_DeallocatePort(Uint16 Port);
@@ -33,7 +36,9 @@ tSocketFile   gTCP_ClientFile = {NULL, "tcpc", TCP_Client_Init};
 
 // === GLOBALS ===
  int   giTCP_NumHalfopen = 0;
+tSpinlock      glTCP_Listeners;
 tTCPListener   *gTCP_Listeners;
+tSpinlock      glTCP_OutbountCons;
 tTCPConnection *gTCP_OutbountCons;
 Uint32 gaTCP_PortBitmap[0x800];
  int   giTCP_NextOutPort = TCP_MIN_DYNPORT;
@@ -47,19 +52,57 @@ void TCP_Initialise()
 {
        IPStack_AddFile(&gTCP_ServerFile);
        IPStack_AddFile(&gTCP_ClientFile);
+       IPv4_RegisterCallback(IP4PROT_TCP, TCP_GetPacket);
 }
 
 /**
- * \fn void *TCP_Open(tInterface *Interface, Uint16 LocalPort, void *Address, Uint16 Port)
  * \brief Open a connection to another host using TCP
  */
 void TCP_StartConnection(tTCPConnection *Conn)
-{      
+{
+       tTCPHeader      hdr;
+       
+       hdr->SourcePort = Conn->LocalPort;
+       hdr->DestPort = Conn->RemotePort;
+       Conn->NextSequenceSend = rand();
+       hdr->SequenceNumber = Conn->NextSequenceSend;
+       hdr->DataOffset = (sizeof(tTCPHeader)+3)/4;
+       hdr->Flags = TCP_FLAG_SYN;
+       hdr->WindowSize = 0;    // TODO
+       hdr->Checksum = 0;      // TODO
+       hdr->UrgentPointer = 0;
        // SEND PACKET
-       // Send a TCP SYN to the target to open the connection
+       TCP_SendPacket( Conn, sizeof(tTCPHeader), &hdr );
        return ;
 }
 
+/**
+ * \brief Sends a packet from the specified connection, calculating the checksums
+ * \param Conn Connection
+ * \param Length       Length of data
+ * \param Data Packet data
+ */
+void TCP_SendPacket( tTCPConnection *Conn, size_t Length, tTCPHeader *Data )
+{
+       size_t  buflen;
+       Uint32  *buf;
+       switch( Conn->Interface.Type )
+       {
+       case 4:
+               buflen = 4 + 4 + 4 + ((Length+1)&1);
+               buf = malloc( buflen );
+               buf[0] = Conn->Interface.IP4.Address.L;
+               buf[1] = Conn->RemoteIP.v4.L;
+               buf[2] = (htons(Length)<<16) | (6<<8) | 0;
+               Data->Checksum = 0;
+               memcpy( &buf[3], Data, buflen );
+               Data->Checksum = IPv4_Checksum( buf, buflen );
+               free(buf);
+               IPv4_SendPacket(Conn->Interface, Conn->RemoteIP.v4, IP4PROT_TCP, 0, sizeof(tTCPHeader), &hdr);
+               break;
+       }
+}
+
 /**
  * \fn void TCP_GetPacket(tInterface *Interface, void *Address, int Length, void *Buffer)
  * \brief Handles a packet from the IP Layer
@@ -70,10 +113,32 @@ void TCP_GetPacket(tInterface *Interface, void *Address, int Length, void *Buffe
        tTCPListener    *srv;
        tTCPConnection  *conn;
        
+       Log("[TCP  ] sizeof(tTCPHeader) = %i", sizeof(tTCPHeader));
+       Log("[TCP  ] DestPort = %i", ntohs(hdr->DestPort));
+       Log("[TCP  ] DestPort = %i", ntohs(hdr->DestPort));
+       Log("[TCP  ] SequenceNumber = %i", ntohl(hdr->SequenceNumber));
+       Log("[TCP  ] AcknowlegementNumber = %i", ntohl(hdr->AcknowlegementNumber));
+       Log("[TCP  ] DataOffset = %i", hdr->DataOffset >> 4);
+       Log("[TCP  ] Flags = {");
+       Log("[TCP  ]   CWR = %B", !!(hdr->Flags & TCP_FLAG_CWR));
+       Log("[TCP  ]   ECE = %B", !!(hdr->Flags & TCP_FLAG_ECE));
+       Log("[TCP  ]   URG = %B", !!(hdr->Flags & TCP_FLAG_URG));
+       Log("[TCP  ]   ACK = %B", !!(hdr->Flags & TCP_FLAG_ACK));
+       Log("[TCP  ]   PSH = %B", !!(hdr->Flags & TCP_FLAG_PSH));
+       Log("[TCP  ]   RST = %B", !!(hdr->Flags & TCP_FLAG_RST));
+       Log("[TCP  ]   SYN = %B", !!(hdr->Flags & TCP_FLAG_SYN));
+       Log("[TCP  ]   FIN = %B", !!(hdr->Flags & TCP_FLAG_FIN));
+       Log("[TCP  ] }");
+       Log("[TCP  ] WindowSize = %i", htons(hdr->WindowSize));
+       Log("[TCP  ] Checksum = 0x%x", htons(hdr->Checksum));
+       Log("[TCP  ] UrgentPointer = 0x%x", htons(hdr->UrgentPointer));
+       
        // Check Servers
        {
                for( srv = gTCP_Listeners; srv; srv = srv->Next )
                {
+                       // Check if the server is active
+                       if(srv->Port == 0)      continue;
                        // Check the interface
                        if(srv->Interface && srv->Interface != Interface)       continue;
                        // Check the destination port
@@ -95,7 +160,7 @@ void TCP_GetPacket(tInterface *Interface, void *Address, int Length, void *Buffe
                                        continue;
                                
                                // We have a response!
-                               //TODO
+                               TCP_INT_HandleConnectionPacket(conn, hdr)
                                
                                return;
                        }
@@ -112,11 +177,31 @@ void TCP_GetPacket(tInterface *Interface, void *Address, int Length, void *Buffe
        {
                for( conn = gTCP_OutbountCons; conn; conn = conn->Next )
                {
-                       // TODO
+                       // Check that it is coming in on the same interface
+                       if(conn->Interface != Interface)        continue;
+                       
+                       // Check Source Port
+                       if(conn->RemotePort != hdr->SourcePort) continue;
+                       
+                       // Check Source IP
+                       if(conn->Interface->Type == 6 && !IP6_EQU(conn->RemoteIP.v6, *(tIPv6*)Address))
+                               continue;
+                       if(conn->Interface->Type == 4 && !IP4_EQU(conn->RemoteIP.v4, *(tIPv4*)Address))
+                               continue;
+                       
+                       TCP_INT_HandleConnectionPacket(conn, hdr)
                }
        }
 }
 
+/**
+ * \brief Handles a packet sent to a specific connection
+ */
+void TCP_INT_HandleConnectionPacket(tTCPConnection *Connection, tTCPHeader *Header)
+{
+       
+}
+
 /**
  * \fn Uint16 TCP_GetUnusedPort()
  * \brief Gets an unused port and allocates it
@@ -177,14 +262,56 @@ int TCP_DeallocatePort(Uint16 Port)
 // --- Server
 tVFS_Node *TCP_Server_Init(tInterface *Interface)
 {
-       return NULL;
+       tTCPListener    *srv = malloc( sizeof(tTCPListener) );
+       
+       srv->Interface = Interface;
+       srv->Port = 0;
+       srv->NextID = 0;
+       srv->Connections = NULL;
+       srv->Next = NULL;
+       srv->Node.ImplPtr = srv;
+       srv->Node.NumACLs = 1;
+       srv->Node.ACLs = &gVFS_ACL_EveryoneRW;
+       srv->Node.ReadDir = TCP_Server_ReadDir;
+       srv->Node.FindDir = TCP_Server_FindDir;
+       srv->Node.IOCtl = TCP_Server_IOCtl;
+       srv->Node.Close = TCP_Server_Close;
+       
+       LOCK(&glTCP_Listeners);
+       srv->Next = gTCP_Listeners;
+       gTCP_Listeners = srv;
+       RELEASE(&glTCP_Listeners);
+       
+       return &srv->Node;
 }
 
+/**
+ * \brief Wait for a new connection and return the connection ID
+ * \note Blocks until a new connection is made
+ * \param Node Server node
+ * \param Pos  Position (ignored)
+ */
 char *TCP_Server_ReadDir(tVFS_Node *Node, int Pos)
 {
-       return NULL;
+       tTCPListener    *srv = Node->ImplPtr;
+       tTCPConnection  *conn;
+       char    *ret;
+       
+       while( srv->NewConnections == NULL )    Threads_Yield();
+       
+       conn = srv->NewConnections;
+       srv->NewConnections = conn->Next;
+       
+       ret = malloc(9);
+       itoa(ret, conn->ImplInt, 16, '0', 8);
+       return ret;
 }
 
+/**
+ * \brief Gets a client connection node
+ * \param Node Server node
+ * \param Name Hexadecimal ID of the node
+ */
 tVFS_Node *TCP_Server_FindDir(tVFS_Node *Node, char *Name)
 {
        return NULL;
@@ -192,9 +319,44 @@ tVFS_Node *TCP_Server_FindDir(tVFS_Node *Node, char *Name)
 
 int TCP_Server_IOCtl(tVFS_Node *Node, int ID, void *Data)
 {
+       tTCPListener    *srv = Node->ImplPtr;
+       
+       switch(ID)
+       {
+       case 4: // Get/Set Port
+               if(!Data)       // Get Port
+                       return srv->Port;
+               
+               if(srv->Port)   // Wait, you can't CHANGE the port
+                       return -1;
+               
+               if(!CheckMem(Data, sizeof(Uint16)))     // Sanity check
+                       return -1;
+               
+               // Permissions check
+               if(Threads_GetUID() != 0
+               && *(Uint16*)Data != 0
+               && *(Uint16*)Data < 1024)
+                       return -1;
+               
+               // TODO: Check if a port is in use
+               
+               // Set Port
+               srv->Port = *(Uint16*)Data;
+               if(srv->Port == 0)      // Allocate a random port
+                       srv->Port = TCP_GetUnusedPort();
+               else    // Else, mark this as used
+                       TCP_AllocatePort(srv->Port);
+               return srv->Port;
+       }
        return 0;
 }
 
+void TCP_Server_Close(tVFS_Node *Node)
+{
+       free(Node->ImplPtr);
+}
+
 // --- Client
 tVFS_Node *TCP_Client_Init(tInterface *Interface)
 {
@@ -214,6 +376,11 @@ tVFS_Node *TCP_Client_Init(tInterface *Interface)
        conn->Node.IOCtl = TCP_Client_IOCtl;
        conn->Node.Close = TCP_Client_Close;
        
+       LOCK(&glTCP_OutbountCons);
+       conn->Next = gTCP_OutbountCons;
+       gTCP_OutbountCons = conn;
+       RELEASE(&glTCP_OutbountCons);
+       
        return &conn->Node;
 }
 
@@ -233,7 +400,7 @@ int TCP_Client_IOCtl(tVFS_Node *Node, int ID, void *Data)
        
        switch(ID)
        {
-       case 5: // Get/Set local port
+       case 4: // Get/Set local port
                if(!Data)
                        return conn->LocalPort;
                if(conn->State != TCP_ST_CLOSED)
@@ -247,14 +414,14 @@ int TCP_Client_IOCtl(tVFS_Node *Node, int ID, void *Data)
                conn->LocalPort = *(Uint16*)Data;
                return 0;
        
-       case 6: // Get/Set remote port
+       case 5: // Get/Set remote port
                if(!Data)       return conn->RemotePort;
                if(conn->State != TCP_ST_CLOSED)        return -1;
                if(!CheckMem(Data, sizeof(Uint16)))     return -1;
                conn->RemotePort = *(Uint16*)Data;
                return 0;
        
-       case 7: // Set Remote IP
+       case 6: // Set Remote IP
                if( conn->State != TCP_ST_CLOSED )
                        return -1;
                if( conn->Interface->Type == 4 )
@@ -269,7 +436,7 @@ int TCP_Client_IOCtl(tVFS_Node *Node, int ID, void *Data)
                }
                return 0;
        
-       case 8: // Connect
+       case 7: // Connect
                if(conn->LocalPort == -1)
                        conn->LocalPort = TCP_GetUnusedPort();
                if(conn->RemotePort == -1)

UCC git Repository :: git.ucc.asn.au