NetworkAdapter.cpp 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177
  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 = NetworkByteBuffer::create_zeroed(size_in_bytes);
  31. auto* eth = (EthernetFrameHeader*)buffer.data();
  32. eth->set_source(mac_address());
  33. eth->set_destination(destination);
  34. eth->set_ether_type(EtherType::ARP);
  35. memcpy(eth->payload(), &packet, sizeof(ARPPacket));
  36. send_packet({ (const u8*)eth, size_in_bytes });
  37. }
  38. 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)
  39. {
  40. size_t ipv4_packet_size = sizeof(IPv4Packet) + payload_size;
  41. VERIFY(ipv4_packet_size <= mtu());
  42. size_t ethernet_frame_size = ipv4_payload_offset() + payload_size;
  43. VERIFY(packet.buffer->size() == ethernet_frame_size);
  44. memset(packet.buffer->data(), 0, ipv4_payload_offset());
  45. auto& eth = *(EthernetFrameHeader*)packet.buffer->data();
  46. eth.set_source(mac_address());
  47. eth.set_destination(destination_mac);
  48. eth.set_ether_type(EtherType::IPv4);
  49. auto& ipv4 = *(IPv4Packet*)eth.payload();
  50. ipv4.set_version(4);
  51. ipv4.set_internet_header_length(5);
  52. ipv4.set_source(source_ipv4);
  53. ipv4.set_destination(destination_ipv4);
  54. ipv4.set_protocol((u8)protocol);
  55. ipv4.set_length(sizeof(IPv4Packet) + payload_size);
  56. ipv4.set_ident(1);
  57. ipv4.set_ttl(ttl);
  58. ipv4.set_checksum(ipv4.compute_checksum());
  59. }
  60. void NetworkAdapter::did_receive(ReadonlyBytes payload)
  61. {
  62. InterruptDisabler disabler;
  63. m_packets_in++;
  64. m_bytes_in += payload.size();
  65. if (m_packet_queue_size == max_packet_buffers) {
  66. // FIXME: Keep track of the number of dropped packets
  67. return;
  68. }
  69. auto packet = acquire_packet_buffer(payload.size());
  70. if (!packet) {
  71. dbgln("Discarding packet because we're out of memory");
  72. return;
  73. }
  74. memcpy(packet->buffer->data(), payload.data(), payload.size());
  75. m_packet_queue.append(*packet);
  76. m_packet_queue_size++;
  77. if (on_receive)
  78. on_receive();
  79. }
  80. size_t NetworkAdapter::dequeue_packet(u8* buffer, size_t buffer_size, Time& packet_timestamp)
  81. {
  82. InterruptDisabler disabler;
  83. if (m_packet_queue.is_empty())
  84. return 0;
  85. auto packet_with_timestamp = m_packet_queue.take_first();
  86. m_packet_queue_size--;
  87. packet_timestamp = packet_with_timestamp->timestamp;
  88. auto& packet_buffer = packet_with_timestamp->buffer;
  89. size_t packet_size = packet_buffer->size();
  90. VERIFY(packet_size <= buffer_size);
  91. memcpy(buffer, packet_buffer->data(), packet_size);
  92. release_packet_buffer(*packet_with_timestamp);
  93. return packet_size;
  94. }
  95. RefPtr<PacketWithTimestamp> NetworkAdapter::acquire_packet_buffer(size_t size)
  96. {
  97. InterruptDisabler disabler;
  98. if (m_unused_packets.is_empty()) {
  99. auto buffer = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  100. if (!buffer)
  101. return {};
  102. auto packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { buffer.release_nonnull(), kgettimeofday() });
  103. if (!packet)
  104. return {};
  105. packet->buffer->set_size(size);
  106. return packet;
  107. }
  108. auto packet = m_unused_packets.take_first();
  109. if (packet->buffer->capacity() >= size) {
  110. packet->timestamp = kgettimeofday();
  111. packet->buffer->set_size(size);
  112. return packet;
  113. }
  114. auto buffer = KBuffer::try_create_with_size(size, Memory::Region::Access::ReadWrite, "Packet Buffer", AllocationStrategy::AllocateNow);
  115. if (!buffer)
  116. return {};
  117. packet = adopt_ref_if_nonnull(new (nothrow) PacketWithTimestamp { buffer.release_nonnull(), kgettimeofday() });
  118. if (!packet)
  119. return {};
  120. packet->buffer->set_size(size);
  121. return packet;
  122. }
  123. void NetworkAdapter::release_packet_buffer(PacketWithTimestamp& packet)
  124. {
  125. InterruptDisabler disabler;
  126. m_unused_packets.append(packet);
  127. }
  128. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  129. {
  130. m_ipv4_address = address;
  131. }
  132. void NetworkAdapter::set_ipv4_netmask(const IPv4Address& netmask)
  133. {
  134. m_ipv4_netmask = netmask;
  135. }
  136. void NetworkAdapter::set_ipv4_gateway(const IPv4Address& gateway)
  137. {
  138. m_ipv4_gateway = gateway;
  139. }
  140. void NetworkAdapter::set_interface_name(const PCI::Address& pci_address)
  141. {
  142. // Note: This stands for e - "Ethernet", p - "Port" as for PCI bus, "s" for slot as for PCI slot
  143. auto name = String::formatted("ep{}s{}", pci_address.bus(), pci_address.device());
  144. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  145. m_name = move(name);
  146. }
  147. void NetworkAdapter::set_loopback_name()
  148. {
  149. auto name = String("loop");
  150. VERIFY(!NetworkingManagement::the().lookup_by_name(name));
  151. m_name = move(name);
  152. }
  153. }