TheCloud/thor-os
1
0
Fork 0
mirror of https://github.com/wichtounet/thor-os.git synced 2025-09-16 07:57:13 -04:00
Code Issues Packages Projects Releases Wiki Activity

Complete ARP parsing

Browse Source
This commit is contained in:
Baptiste Wicht 2016-07-06 18:47:53 +02:00
parent 4e756e71e4
commit 234ea4f11a
1 changed files with 47 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

50
kernel/src/arp_layer.cpp
View File

@ -26,11 +26,13 @@ void network::arp::decode(network::ethernet::packet& packet){
auto hw_type = switch_endian_16(arp_header->hw_type);
auto protocol_type = switch_endian_16(arp_header->protocol_type);
// We only support ethernet hardware frames
if(hw_type != 0x1){
logging::logf(logging::log_level::ERROR, "arp: Unhandled hardware type %h\n", size_t(hw_type));
return;
}
// We only support IPV4 protocol
if(protocol_type != 0x800){
logging::logf(logging::log_level::ERROR, "arp: Unhandled protocol type %h\n", size_t(protocol_type));
return;
@ -40,7 +42,49 @@ void network::arp::decode(network::ethernet::packet& packet){
auto protocol_len = arp_header->protocol_len;
auto operation = switch_endian_16(arp_header->operation);
logging::logf(logging::log_level::TRACE, "arp: Start ARP packet handling %h\n", size_t(hw_len));
logging::logf(logging::log_level::TRACE, "arp: Start ARP packet handling %h\n", size_t(protocol_len));
logging::logf(logging::log_level::TRACE, "arp: Start ARP packet handling %h\n", size_t(operation));
// This should never happen
if(hw_len != 0x6 || protocol_len != 0x4){
logging::logf(logging::log_level::ERROR, "arp: Unable to process the given length hw:%h prot:%h\n", size_t(hw_len), size_t(protocol_len));
return;
}
if(operation == 0x1){
logging::logf(logging::log_level::TRACE, "arp: Handle Request\n");
size_t source_hw = 0;
size_t target_hw = 0;
for(size_t i = 0; i < 3; ++i){
source_hw |= uint64_t(switch_endian_16(arp_header->source_hw_addr[i])) << ((3 - i) * 16);
target_hw |= uint64_t(switch_endian_16(arp_header->target_hw_addr[i])) << ((3 - i) * 16);
}
logging::logf(logging::log_level::TRACE, "arp: Source HW Address %h \n", source_hw);
logging::logf(logging::log_level::TRACE, "arp: Target HW Address %h \n", target_hw);
uint8_t source_prot[4];
uint8_t target_prot[4];
for(size_t i = 0; i < 2; ++i){
auto source = switch_endian_16(arp_header->source_protocol_addr[i]);
auto target = switch_endian_16(arp_header->target_protocol_addr[i]);
source_prot[2*i] = source >> 8;
source_prot[2*i+1] = source;
target_prot[2*i] = target >> 8;
target_prot[2*i+1] = target;
}
logging::logf(logging::log_level::TRACE, "arp: Source Protocol Address %u.%u.%u.%u \n",
uint64_t(source_prot[0]), uint64_t(source_prot[1]), uint64_t(source_prot[2]), uint64_t(source_prot[3]));
logging::logf(logging::log_level::TRACE, "arp: Target Protocol Address %u.%u.%u.%u \n",
uint64_t(target_prot[0]), uint64_t(target_prot[1]), uint64_t(target_prot[2]), uint64_t(target_prot[3]));
} else if(operation == 0x2){
logging::logf(logging::log_level::TRACE, "arp: Handle Query\n");
} else {
logging::logf(logging::log_level::TRACE, "arp: Unhandled operation %h\n", size_t(operation));
}
}