* Acess2 IP Stack
* - Routing Tables
*/
-#define DEBUG 0
+#define DEBUG 1
#define VERSION VER2(0,10)
#include <acess.h>
#include <tpl_drv_common.h>
// === IMPORTS ===
tVFS_Node *IPStack_Root_FindDir(tVFS_Node *Node, const char *Filename);
-// === TYPES ===
-typedef struct sRoute {
- struct sRoute *Next;
-
- tVFS_Node Node;
-
- tInterface *Interface; // Interface for this route
- int AddressType; // 0: Invalid, 4: IPv4, 6: IPv4
- void *Network; // Network - Pointer to tIPv4/tIPv6/... at end of structure
- int SubnetBits; // Number of bits in \a Network that are valid
- void *NextHop; // Next Hop address - Pointer to tIPv4/tIPv6/... at end of structure
- int Metric; // Route priority
-} tRoute;
-
// === PROTOTYPES ===
// - Routes directory
char *IPStack_RouteDir_ReadDir(tVFS_Node *Node, int Pos);
tVFS_Node *IPStack_RouteDir_FindDir(tVFS_Node *Node, const char *Name);
int IPStack_RouteDir_IOCtl(tVFS_Node *Node, int ID, void *Data);
int IPStack_Route_Create(const char *InterfaceName);
+tRoute *IPStack_FindRoute(int AddressType, tInterface *Interface, void *Address);
// - Individual Routes
int IPStack_Route_IOCtl(tVFS_Node *Node, int ID, void *Data);
static const char *casIOCtls_RouteDir[] = {
DRV_IOCTLNAMES,
"add_route", // Add a route - char *InterfaceName
+ "locate_route", // Find the best route for an address - struct {int Type, char Address[]} *
NULL
};
int IPStack_RouteDir_IOCtl(tVFS_Node *Node, int ID, void *Data)
{
int tmp;
+ ENTER("pNode iID pData", Node, ID, Data);
switch(ID)
{
// --- Standard IOCtls (0-3) ---
return tmp;
case 4: // Add Route
- if( !CheckString(Data) ) return -1;
- return IPStack_Route_Create(Data);
+ if( !CheckString(Data) ) LEAVE_RET('i', -1);
+ tmp = IPStack_Route_Create(Data);
+ LEAVE('i', tmp);
+ return tmp;
+
+ case 5: // Locate Route
+ {
+ struct {
+ int Type;
+ Uint8 Addr[];
+ } *data = Data;
+ tRoute *rt;
+
+ if( !CheckMem(Data, sizeof(int)) )
+ LEAVE_RET('i', -1);
+ if( !CheckMem(Data, sizeof(int) + IPStack_GetAddressSize(data->Type)) )
+ LEAVE_RET('i', -1);
+
+ Log_Debug("IPStack", "Route_RouteDir_IOCtl - FindRoute %i, %s",
+ data->Type, IPStack_PrintAddress(data->Type, data->Addr) );
+ rt = IPStack_FindRoute(data->Type, NULL, data->Addr);
+
+ if( !rt )
+ LEAVE_RET('i', 0);
+
+ LEAVE('i', rt->Node.Inode);
+ return rt->Node.Inode;
+ }
+ break;
}
+ LEAVE('i', 0);
return 0;
}
// Note: Oh man! This is such a hack
{
tVFS_Node *node = IPStack_Root_FindDir(NULL, InterfaceName);
- if( !node ) return 0;
+ if( !node ) {
+ Log_Debug("IPStack", "IPStack_Route_Create - Unknown interface '%s'\n", InterfaceName);
+ return 0;
+ }
iface = node->ImplPtr;
}
gIP_Routes = gIP_RoutesEnd = rt;
}
+ Log_Log("IPStack", "Route entry for '%s' created", InterfaceName);
+
return rt->Node.Inode;
}
+/**
+ */
+tRoute *IPStack_FindRoute(int AddressType, tInterface *Interface, void *Address)
+{
+ tRoute *rt;
+ tRoute *best = NULL;
+
+ ENTER("iAddressType pInterface sAddress",
+ AddressType, Interface, IPStack_PrintAddress(AddressType, Address));
+
+ if( Interface && AddressType != Interface->Type ) {
+ LOG("Interface->Type (%i) != AddressType", Interface->Type);
+ LEAVE('n');
+ return NULL;
+ }
+
+ for( rt = gIP_Routes; rt; rt = rt->Next )
+ {
+ // Check interface
+ if( Interface && rt->Interface != Interface ) continue;
+ // Check address type
+ if( rt->AddressType != AddressType ) continue;
+
+ LOG("Checking network %s/%i", IPStack_PrintAddress(AddressType, rt->Network), rt->SubnetBits);
+
+ // Check if the address matches
+ if( !IPStack_CompareAddress(AddressType, rt->Network, Address, rt->SubnetBits) )
+ continue;
+
+ if( best ) {
+ // More direct routes are preferred
+ if( best->SubnetBits > rt->SubnetBits ) {
+ LOG("Skipped - less direct (%i < %i)", rt->SubnetBits, best->SubnetBits);
+ continue;
+ }
+ // If equally direct, choose the best metric
+ if( best->SubnetBits == rt->SubnetBits && best->Metric < rt->Metric ) {
+ LOG("Skipped - higher metric (%i > %i)", rt->Metric, best->Metric);
+ continue;
+ }
+ }
+
+ best = rt;
+ }
+
+ LEAVE('p', best);
+ return best;
+}
+
/**
* \brief Names for route IOCtl Calls
*/
static const char *casIOCtls_Route[] = {
DRV_IOCTLNAMES,
- "get_network", // Get network - (void *Data)
- "set_network", // Set network - (void *Data)
- "get_nexthop", // Get next hop - (void *Data)
- "set_nexthop", // Set next hop - (void *Data)
- "getset_subnetbits", // Get/Set subnet bits - (int *Bits)
- "getset_metric", // Get/Set metric - (int *Metric)
+ "get_type", // Get address type - (void), returns integer type
+ "get_network", // Get network - (void *Data), returns boolean success
+ "set_network", // Set network - (void *Data), returns boolean success
+ "get_nexthop", // Get next hop - (void *Data), returns boolean success
+ "set_nexthop", // Set next hop - (void *Data), returns boolean success
+ "getset_subnetbits", // Get/Set subnet bits - (int *Bits), returns current value
+ "getset_metric", // Get/Set metric - (int *Metric), returns current value
+ "get_interface", // Get interface name - (char *Name), returns name length, NULL OK
NULL
};
LEAVE('i', tmp);
return tmp;
- // Get Network
+ // Get address type
case 4:
+ return rt->AddressType;
+
+ // Get Network
+ case 5:
if( !CheckMem(Data, addrSize) ) return -1;
memcpy(Data, rt->Network, addrSize);
return 1;
// Set Network
- case 5:
+ case 6:
if( !CheckMem(Data, addrSize) ) return -1;
memcpy(rt->Network, Data, addrSize);
return 1;
// Get Next Hop
- case 6:
+ case 7:
if( !CheckMem(Data, addrSize) ) return -1;
memcpy(Data, rt->NextHop, addrSize);
return 1;
// Set Next Hop
- case 7:
+ case 8:
if( !CheckMem(Data, addrSize) ) return -1;
memcpy(rt->NextHop, Data, addrSize);
return 1;
// Get/Set Subnet Bits
- case 8:
+ case 9:
if( Data ) {
if( !CheckMem(Data, sizeof(int)) ) return -1;
if( *iData < 0 || *iData > addrSize*8 )
return rt->SubnetBits;
// Get/Set Metric
- case 9:
+ case 10:
if( Data ) {
if( !CheckMem(Data, sizeof(int)) ) return -1;
if( *iData < 0 ) return -1;
}
return rt->Metric;
+ // Get interface name
+ case 11:
+ if( Data ) {
+ if( !CheckMem(Data, strlen(rt->Interface->Name) + 1) )
+ return -1;
+ strcpy(Data, rt->Interface->Name);
+ }
+ return strlen(rt->Interface->Name);
+
default:
- return 0;
+ return -1;
}
}