mirror of
https://github.com/fergalmoran/ladybird.git
synced 2026-01-04 07:36:50 +00:00
Kernel: More work on ICMP support.
We can now kinda sorta respond to ICMP::EchoRequest although there's still something not entirely right with the packets.
This commit is contained in:
@@ -156,6 +156,7 @@ void handle_ipv4(const EthernetFrameHeader& eth, int frame_size)
|
||||
|
||||
void handle_icmp(const EthernetFrameHeader& eth, int frame_size)
|
||||
{
|
||||
(void)frame_size;
|
||||
auto& ipv4_packet = *static_cast<const IPv4Packet*>(eth.payload());
|
||||
auto& icmp_header = *static_cast<const ICMPHeader*>(ipv4_packet.payload());
|
||||
kprintf("handle_icmp: type=%b, code=%b\n", icmp_header.type(), icmp_header.code());
|
||||
@@ -165,7 +166,7 @@ void handle_icmp(const EthernetFrameHeader& eth, int frame_size)
|
||||
// It's for me!
|
||||
if (icmp_header.type() == ICMPType::EchoRequest) {
|
||||
auto& request = reinterpret_cast<const ICMPEchoPacket&>(icmp_header);
|
||||
kprintf("ICMP echo request: id=%u, seq=%u\n", (int)request.identifier, (int)request.sequence_number);
|
||||
kprintf("ICMP echo request: id=%u, seq=%u, len=%u\n", (int)request.identifier, (int)request.sequence_number, ipv4_packet.length() - sizeof(ICMPEchoPacket));
|
||||
byte* response_buffer = (byte*)kmalloc(ipv4_packet.length());
|
||||
memset(response_buffer, 0, ipv4_packet.length());
|
||||
struct [[gnu::packed]] EchoResponse {
|
||||
@@ -178,13 +179,13 @@ void handle_icmp(const EthernetFrameHeader& eth, int frame_size)
|
||||
response.ipv4.set_source(e1000.ipv4_address());
|
||||
response.ipv4.set_destination(ipv4_packet.source());
|
||||
response.ipv4.set_protocol(IPv4Protocol::ICMP);
|
||||
response.ipv4.set_length(sizeof(IPv4ICMPPacket));
|
||||
response.ipv4.set_length(ipv4_packet.length());
|
||||
response.icmp_echo.header.set_type(ICMPType::EchoReply);
|
||||
response.icmp_echo.header.set_code(0);
|
||||
response.icmp_echo.identifier = request.identifier;
|
||||
response.icmp_echo.sequence_number = request.sequence_number;
|
||||
memcpy(response.icmp_echo.payload, request.payload, ipv4_packet.length() - sizeof(ICMPEchoPacket));
|
||||
e1000.send_ipv4(eth.source(), &response, ipv4_packet.length());
|
||||
memcpy(response.icmp_echo.payload(), request.payload(), ipv4_packet.length() - sizeof(EchoResponse));
|
||||
e1000.send_ipv4(eth.source(), response_buffer, ipv4_packet.length());
|
||||
kfree(response_buffer);
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user