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

Add support to prepare ethernet packets

Browse Source
This commit is contained in:
Baptiste Wicht 2016-07-08 22:29:35 +02:00
parent a3bd976bd5
commit 6b76696629
2 changed files with 35 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
kernel/include/ethernet_layer.hpp
View File

@ -49,6 +49,8 @@ static_assert(sizeof(header) == 14, "The size of the Ethernet header is 14 bytes
void decode(packet& packet);
packet prepare_packet(size_t size, size_t destination, ether_type type);
} // end of ethernet namespace
} // end of network namespace

33
kernel/src/ethernet_layer.cpp
View File

@ -12,6 +12,7 @@
#include "logging.hpp"
#include "kernel_utils.hpp"
#include "arp_layer.hpp"
#include "network.hpp"
namespace {
@ -29,6 +30,20 @@ network::ethernet::ether_type decode_ether_type(network::ethernet::header* heade
}
}
uint16_t type_to_code(network::ethernet::ether_type type){
switch(type){
case network::ethernet::ether_type::IPV4:
return 0x800;
case network::ethernet::ether_type::IPV6:
return 0x86DD;
case network::ethernet::ether_type::ARP:
return 0x806;
case network::ethernet::ether_type::UNKNOWN:
logging::logf(logging::log_level::ERROR, "ethernet: Decoding UNKOWN code\n");
return 0x0;
}
}
} //end of anonymous namespace
void network::ethernet::decode(packet& packet){
@ -69,3 +84,21 @@ void network::ethernet::decode(packet& packet){
break;
}
}
network::ethernet::packet network::ethernet::prepare_packet(size_t size, size_t destination, ether_type type){
auto total_size = size + sizeof(header);
network::ethernet::packet p(new char[total_size], total_size);
p.index = sizeof(header);
auto& inter = network::interface(0); //TODO Select the interface ?
auto source_mac = inter.mac_address;
header* ether_header = reinterpret_cast<header*>(p.payload);
ether_header->type = switch_endian_16(type_to_code(type));
for(size_t i = 0; i < 6; ++i){
ether_header->source.mac[i] = (source_mac >> ((5 - i) * 8)) & 0xF;
ether_header->target.mac[i] = (destination >> ((5 - i) * 8)) & 0xF;
}
}