+ rt->Metric = DEFAUTL_METRIC;
+ memset(rt->Network, 0, size);
+ memset(rt->NextHop, 0, size);
+
+ // Add to list
+ if( gIP_RoutesEnd ) {
+ gIP_RoutesEnd->Next = rt;
+ gIP_RoutesEnd = rt;
+ }
+ else {
+ gIP_Routes = gIP_RoutesEnd = rt;
+ }
+
+ Log_Log("IPStack", "Route entry for '%s' created", InterfaceName);
+
+ return rt;
+}
+
+/**
+ * \brief Add and fill a route
+ */
+tRoute *IPStack_AddRoute(const char *Interface, void *Network, int SubnetBits, void *NextHop, int Metric)
+{
+ tRoute *rt = IPStack_Route_Create(Interface);
+ int addrSize;
+
+ if( !rt ) return NULL;
+
+ addrSize = IPStack_GetAddressSize(rt->Interface->Type);
+
+ memcpy(rt->Network, Network, addrSize);
+ if( NextHop )
+ memcpy(rt->NextHop, NextHop, addrSize);
+ rt->SubnetBits = SubnetBits;
+ if( Metric )
+ rt->Metric = Metric;
+
+ return rt;
+}
+
+/**
+ */
+tRoute *IPStack_FindRoute(int AddressType, tInterface *Interface, void *Address)
+{
+ tRoute *rt;
+ tRoute *best = NULL;
+ tInterface *iface;
+ int addrSize;
+
+ 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;
+ }
+
+ // Get address size
+ addrSize = IPStack_GetAddressSize(AddressType);
+
+ // Check against explicit routes
+ 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;
+ }
+
+ // Check against implicit routes
+ if( !best && !Interface )
+ {
+ for( iface = gIP_Interfaces; iface; iface = iface->Next )
+ {
+ if( Interface && iface != Interface ) continue;
+ if( iface->Type != AddressType ) continue;
+
+
+ // Check if the address matches
+ if( !IPStack_CompareAddress(AddressType, iface->Address, Address, iface->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;
+ }
+ }
+
+ rt = &iface->Route;
+ memcpy(rt->Network, iface->Address, addrSize);
+ memset(rt->NextHop, 0, addrSize);
+ rt->Metric = DEFAUTL_METRIC;
+ rt->SubnetBits = iface->SubnetBits;
+
+ best = rt;
+ }
+ }
+ if( !best && Interface )
+ {
+ rt = &Interface->Route;
+ // Make sure route is up to date
+ memcpy(rt->Network, Interface->Address, addrSize);
+ memset(rt->NextHop, 0, addrSize);
+ rt->Metric = DEFAUTL_METRIC;
+ rt->SubnetBits = Interface->SubnetBits;
+
+ if( IPStack_CompareAddress(AddressType, rt->Network, Address, rt->SubnetBits) )
+ {
+ best = rt;
+ }
+ }
+
+ LEAVE('p', best);
+ return best;
+}
+
+/**
+ * \brief Names for route IOCtl Calls
+ */
+static const char *casIOCtls_Route[] = {
+ DRV_IOCTLNAMES,
+ "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
+ };
+
+/**
+ * \brief IOCtl for /Devices/ip/routes/#
+ */
+int IPStack_Route_IOCtl(tVFS_Node *Node, int ID, void *Data)
+{
+ int *iData = Data;
+ tRoute *rt = Node->ImplPtr;
+ int addrSize = IPStack_GetAddressSize(rt->AddressType);
+
+ switch(ID)
+ {
+ // --- Standard IOCtls (0-3) ---
+ BASE_IOCTLS(DRV_TYPE_MISC, STR(IDENT), VERSION, casIOCtls_Route)
+
+ // 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 6:
+ if( !CheckMem(Data, addrSize) ) return -1;
+ memcpy(rt->Network, Data, addrSize);
+ return 1;
+
+ // Get Next Hop
+ case 7:
+ if( !CheckMem(Data, addrSize) ) return -1;
+ memcpy(Data, rt->NextHop, addrSize);
+ return 1;
+ // Set Next Hop
+ case 8:
+ if( !CheckMem(Data, addrSize) ) return -1;
+ memcpy(rt->NextHop, Data, addrSize);
+ return 1;
+
+ // Get/Set Subnet Bits
+ case 9:
+ if( Data ) {
+ if( !CheckMem(Data, sizeof(int)) ) return -1;
+ if( *iData < 0 || *iData > addrSize*8 )
+ return -1;
+ rt->SubnetBits = *iData;
+ }
+ return rt->SubnetBits;
+
+ // Get/Set Metric
+ case 10:
+ if( Data ) {
+ if( !CheckMem(Data, sizeof(int)) ) return -1;
+ if( *iData < 0 ) return -1;
+ rt->Metric = *iData;
+ }
+ 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 -1;
+ }