NetworkAdapter.cpp 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <AK/StringBuilder.h>
  7. #include <Kernel/Arch/x86/InterruptDisabler.h>
  8. #include <Kernel/Heap/kmalloc.h>
  9. #include <Kernel/Net/EtherType.h>
  10. #include <Kernel/Net/NetworkAdapter.h>
  11. #include <Kernel/Net/NetworkingManagement.h>
  12. #include <Kernel/Process.h>
  13. #include <Kernel/StdLib.h>
  14. namespace Kernel {
  15. NetworkAdapter::NetworkAdapter()
  16. {
  17. }
  18. NetworkAdapter::~NetworkAdapter()
  19. {
  20. }
  21. void NetworkAdapter::send_packet(ReadonlyBytes packet)
  22. {
  23. m_packets_out++;
  24. m_bytes_out += packet.size();
  25. send_raw(packet);
  26. }
  27. void NetworkAdapter::send(const MACAddress& destination, const ARPPacket& packet)
  28. {
  29. size_t size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  30. auto buffer_result = NetworkByteBuffer::create_zeroed(size_in_bytes);
  31. if (!buffer_result.has_value()) {
  32. dbgln("Dropping ARP packet targeted at {} as there is not enough memory to buffer it", packet.target_hardware_address().to_string());
  33. return;
  34. }
  35. auto* eth = (EthernetFrameHeader*)buffer_result->data();
  36. eth->set_source(mac_address());
  37. eth->set_destination(destination);
  38. eth->set_ether_type(EtherType::ARP);
  39. memcpy(eth->payload(), &packet, sizeof(ARPPacket));
  40. send_packet({ (const u8*)eth, size_in_bytes });
  41. }
  42. void NetworkAdapter::fill_in_ipv4_header(PacketWithTimestamp& packet, IPv4Address const& source_ipv4, MACAddress const& destination_mac, IPv4Address const& destination_ipv4, IPv4Protocol protocol, size_t payload_size, u8 ttl)
  43. {
  44. size_t ipv4_packet_size = sizeof(IPv4Packet) + payload_size;
  45. VERIFY(ipv4_packet_size <= mtu());
  46. size_t ethernet_frame_size = ipv4_payload_offset() + payload_size;
  47. VERIFY(packet.buffer->size() == ethernet_frame_size);
  48. memset(packet.buffer->data(), 0, ipv4_payload_offset());
  49. auto& eth = *(EthernetFrameHeader*)packet.buffer->data();
  50. eth.set_source(mac_address());
  51. eth.set_destination(destination_mac);
  52. eth.set_ether_type(EtherType::IPv4);
  53. auto& ipv4 = *(IPv4Packet*)eth.payload();
  54. ipv4.set_version(4);
  55. ipv4.set_internet_header_length(5);
  56. ipv4.set_source(source_ipv4);
  57. ipv4.set_destination(destination_ipv4);
  58. ipv4.set_protocol((u8)protocol);
  59. ipv4.set_length(sizeof(IPv4Packet) + payload_size);
  60. ipv4.set_ident(1);
  61. ipv4.set_ttl(ttl);
  62. ipv4.set_checksum(ipv4.compute_checksum());
  63. }
  64. void NetworkAdapter::did_receive(ReadonlyBytes payload)
  65. {
  66. InterruptDisabler disabler;
  67. m_packets_in++;
  68. m_bytes_in += payload.size();
  69. if (m_packet_queue_size == max_packet_buffers) {
  70. // FIXME: Keep track of the number of dropped packets
  71. return;
  72. }
  73. auto packet = acquire_packet_buffer(payload.size());
  74. if (!packet) {
  75. dbgln("Discarding packet because we're out of memory");
  76. return;
  77. }
  78. memcpy(packet->buffer->data(), payload.data(), payload.size());
  79. m_packet_queue.append(*packet);
  80. m_packet_queue_size++;
  81. if (on_receive)
  82. on_receive();
  83. }
  84. size_t NetworkAdapter::dequeue_packet(u8* buffer, size_t buffer_size, Time& packet_timestamp)
  85. {
  86. InterruptDisabler disabler;
  87. if (m_packet_queue.is_empty())
  88. return 0;
  89. auto packet_with_timestamp = m_packet_queue.take_first();
  90. m_packet_queue_size--;
  91. packet_timestamp = packet_with_timestamp->timestamp;
  92. auto& packet_buffer = packet_with_timestamp->buffer;
  93. size_t packet_size = packet_buffer->size();
  94. VERIFY(packet_size <= buffer_size);
  95. memcpy(buffer, packet_buffer->data(), packet_size);
  96. release_packet_buffer(*packet_with_timestamp);
  97. return packet_size;
  98. }
  99. RefPtr<PacketWithTimestamp> NetworkAdapter::acquire_packet_buffer(size_t size)
  100. {
  101. InterruptDisabler disabler;
  102. if (m_unused_packets.is_empty()) {
  103. auto buffer_or_error = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  104. if (buffer_or_error.is_error())
  105. return {};
  106. auto buffer = buffer_or_error.release_value();
  107. auto packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { move(buffer), kgettimeofday() });
  108. if (!packet)
  109. return {};
  110. packet->buffer->set_size(size);
  111. return packet;
  112. }
  113. auto packet = m_unused_packets.take_first();
  114. if (packet->buffer->capacity() >= size) {
  115. packet->timestamp = kgettimeofday();
  116. packet->buffer->set_size(size);
  117. return packet;
  118. }
  119. auto buffer_or_error = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  120. if (buffer_or_error.is_error())
  121. return {};
  122. packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { buffer_or_error.release_value(), kgettimeofday() });
  123. if (!packet)
  124. return {};
  125. packet->buffer->set_size(size);
  126. return packet;
  127. }
  128. void NetworkAdapter::release_packet_buffer(PacketWithTimestamp& packet)
  129. {
  130. InterruptDisabler disabler;
  131. m_unused_packets.append(packet);
  132. }
  133. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  134. {
  135. m_ipv4_address = address;
  136. }
  137. void NetworkAdapter::set_ipv4_netmask(const IPv4Address& netmask)
  138. {
  139. m_ipv4_netmask = netmask;
  140. }
  141. void NetworkAdapter::set_ipv4_gateway(const IPv4Address& gateway)
  142. {
  143. m_ipv4_gateway = gateway;
  144. }
  145. void NetworkAdapter::set_interface_name(const PCI::Address& pci_address)
  146. {
  147. // Note: This stands for e - "Ethernet", p - "Port" as for PCI bus, "s" for slot as for PCI slot
  148. auto name = String::formatted("ep{}s{}", pci_address.bus(), pci_address.device());
  149. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  150. m_name = move(name);
  151. }
  152. void NetworkAdapter::set_loopback_name()
  153. {
  154. auto name = String("loop");
  155. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  156. m_name = move(name);
  157. }
  158. }