3 * - IPv6 Protcol Handling
10 extern tInterface *gIP_Interfaces;
11 extern Uint32 IPv4_Netmask(int FixedBits);
14 int IPv6_Initialise();
15 void IPv6_int_GetPacket(tAdapter *Interface, tMacAddr From, int Length, void *Buffer);
16 tInterface *IPv6_GetInterface(tAdapter *Adapter, tIPv6 Address, int Broadcast);
20 * \brief Initialise the IPv6 handling code
24 Link_RegisterType(IPV6_ETHERNET_ID, IPv6_int_GetPacket);
29 * \fn void IPv6_int_GetPacket(tInterface *Interface, tMacAddr From, int Length, void *Buffer)
30 * \brief Process an IPv6 Packet
31 * \param Interface Input interface
32 * \param From Source MAC address
33 * \param Length Packet length
34 * \param Buffer Packet data
36 void IPv6_int_GetPacket(tAdapter *Interface, tMacAddr From, int Length, void *Buffer)
38 tIPv6Header *hdr = Buffer;
39 if(Length < sizeof(tIPv6Header)) return;
41 hdr->Head = ntohl(hdr->Head);
43 //if( ((hdr->Head >> (20+8)) & 0xF) != 6 )
44 if( hdr->Version != 6 )
47 Log_Debug("IPv6", "hdr = {");
48 //Log_Debug("IPv6", " .Version = %i", (hdr->Head >> (20+8)) & 0xF );
49 //Log_Debug("IPv6", " .TrafficClass = %i", (hdr->Head >> (20)) & 0xFF );
50 //Log_Debug("IPv6", " .FlowLabel = %i", hdr->Head & 0xFFFFF );
51 Log_Debug("IPv6", " .Version = %i", hdr->Version );
52 Log_Debug("IPv6", " .TrafficClass = %i", hdr->TrafficClass );
53 Log_Debug("IPv6", " .FlowLabel = %i", hdr->FlowLabel );
54 Log_Debug("IPv6", " .PayloadLength = 0x%04x", ntohs(hdr->PayloadLength) );
55 Log_Debug("IPv6", " .NextHeader = 0x%02x", hdr->NextHeader );
56 Log_Debug("IPv6", " .HopLimit = 0x%02x", hdr->HopLimit );
57 Log_Debug("IPv6", " .Source = %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x", hdr->Source );
58 Log_Debug("IPv6", " .Destination = %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x", hdr->Destination );
59 Log_Debug("IPv6", "}");
64 * \fn tInterface *IPv6_GetInterface(tAdapter *Adapter, tIPv6 Address)
65 * \brief Searches an adapter for a matching address
66 * \param Adapter Source adapter
67 * \param Address Destination Address
68 * \param Broadcast Allow broadcast?
70 tInterface *IPv6_GetInterface(tAdapter *Adapter, tIPv6 Address, int Broadcast)
73 tInterface *iface = NULL;
76 for( iface = gIP_Interfaces; iface; iface = iface->Next)
78 // Check for this adapter
79 if( iface->Adapter != Adapter ) continue;
81 // Skip non-IPv6 Interfaces
82 if( iface->Type != 6 ) continue;
84 // If the address is a perfect match, return this interface
85 if( IP6_EQU(Address, iface->IP6.Address) ) return iface;
87 // Check if we want to match broadcast addresses
88 if( !Broadcast ) continue;
90 // Check for broadcast
91 if( iface->IP6.SubnetBits > 32 && Address.L[0] != iface->IP6.Address.L[0] )
93 if( iface->IP6.SubnetBits > 64 && Address.L[1] != iface->IP6.Address.L[1] )
95 if( iface->IP6.SubnetBits > 96 && Address.L[2] != iface->IP6.Address.L[2] )
98 j = iface->IP6.SubnetBits / 32;
99 i = iface->IP6.SubnetBits % 32;
100 netmask = IPv4_Netmask( iface->IP6.SubnetBits % 32 );
102 // Check the last bit of the netmask
103 if( (Address.L[j] >> i) != (iface->IP6.Address.L[j] >> i) ) continue;
105 // Check that the host portion is one
106 if( (Address.L[j] & ~netmask) != (0xFFFFFFFF & ~netmask) ) continue;
107 if( j >= 2 && Address.L[3] != 0xFFFFFFFF) continue;
108 if( j >= 1 && Address.L[2] != 0xFFFFFFFF) continue;
109 if( j >= 0 && Address.L[1] != 0xFFFFFFFF) continue;