NetworkAdapter.cpp 5.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181
  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 = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  104. if (!buffer)
  105. return {};
  106. auto packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { buffer.release_nonnull(), kgettimeofday() });
  107. if (!packet)
  108. return {};
  109. packet->buffer->set_size(size);
  110. return packet;
  111. }
  112. auto packet = m_unused_packets.take_first();
  113. if (packet->buffer->capacity() >= size) {
  114. packet->timestamp = kgettimeofday();
  115. packet->buffer->set_size(size);
  116. return packet;
  117. }
  118. auto buffer = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  119. if (!buffer)
  120. return {};
  121. packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { buffer.release_nonnull(), kgettimeofday() });
  122. if (!packet)
  123. return {};
  124. packet->buffer->set_size(size);
  125. return packet;
  126. }
  127. void NetworkAdapter::release_packet_buffer(PacketWithTimestamp& packet)
  128. {
  129. InterruptDisabler disabler;
  130. m_unused_packets.append(packet);
  131. }
  132. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  133. {
  134. m_ipv4_address = address;
  135. }
  136. void NetworkAdapter::set_ipv4_netmask(const IPv4Address& netmask)
  137. {
  138. m_ipv4_netmask = netmask;
  139. }
  140. void NetworkAdapter::set_ipv4_gateway(const IPv4Address& gateway)
  141. {
  142. m_ipv4_gateway = gateway;
  143. }
  144. void NetworkAdapter::set_interface_name(const PCI::Address& pci_address)
  145. {
  146. // Note: This stands for e - "Ethernet", p - "Port" as for PCI bus, "s" for slot as for PCI slot
  147. auto name = String::formatted("ep{}s{}", pci_address.bus(), pci_address.device());
  148. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  149. m_name = move(name);
  150. }
  151. void NetworkAdapter::set_loopback_name()
  152. {
  153. auto name = String("loop");
  154. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  155. m_name = move(name);
  156. }
  157. }