NetworkAdapter.cpp 6.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. * All rights reserved.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions are met:
  7. *
  8. * 1. Redistributions of source code must retain the above copyright notice, this
  9. * list of conditions and the following disclaimer.
  10. *
  11. * 2. Redistributions in binary form must reproduce the above copyright notice,
  12. * this list of conditions and the following disclaimer in the documentation
  13. * and/or other materials provided with the distribution.
  14. *
  15. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  16. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  17. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  18. * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
  19. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  20. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  21. * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  22. * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  23. * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  24. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25. */
  26. #include <AK/HashTable.h>
  27. #include <AK/StringBuilder.h>
  28. #include <Kernel/Heap/kmalloc.h>
  29. #include <Kernel/Lock.h>
  30. #include <Kernel/Net/EtherType.h>
  31. #include <Kernel/Net/EthernetFrameHeader.h>
  32. #include <Kernel/Net/LoopbackAdapter.h>
  33. #include <Kernel/Net/NetworkAdapter.h>
  34. #include <Kernel/StdLib.h>
  35. static Lockable<HashTable<NetworkAdapter*>>& all_adapters()
  36. {
  37. static Lockable<HashTable<NetworkAdapter*>>* table;
  38. if (!table)
  39. table = new Lockable<HashTable<NetworkAdapter*>>;
  40. return *table;
  41. }
  42. void NetworkAdapter::for_each(Function<void(NetworkAdapter&)> callback)
  43. {
  44. LOCKER(all_adapters().lock());
  45. for (auto& it : all_adapters().resource())
  46. callback(*it);
  47. }
  48. RefPtr<NetworkAdapter> NetworkAdapter::from_ipv4_address(const IPv4Address& address)
  49. {
  50. LOCKER(all_adapters().lock());
  51. for (auto* adapter : all_adapters().resource()) {
  52. if (adapter->ipv4_address() == address)
  53. return adapter;
  54. }
  55. if (address[0] == 127)
  56. return LoopbackAdapter::the();
  57. return nullptr;
  58. }
  59. RefPtr<NetworkAdapter> NetworkAdapter::lookup_by_name(const StringView& name)
  60. {
  61. NetworkAdapter* found_adapter = nullptr;
  62. for_each([&](auto& adapter) {
  63. if (adapter.name() == name)
  64. found_adapter = &adapter;
  65. });
  66. return found_adapter;
  67. }
  68. NetworkAdapter::NetworkAdapter()
  69. {
  70. // FIXME: I wanna lock :(
  71. all_adapters().resource().set(this);
  72. }
  73. NetworkAdapter::~NetworkAdapter()
  74. {
  75. // FIXME: I wanna lock :(
  76. all_adapters().resource().remove(this);
  77. }
  78. void NetworkAdapter::send(const MACAddress& destination, const ARPPacket& packet)
  79. {
  80. int size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  81. auto buffer = ByteBuffer::create_zeroed(size_in_bytes);
  82. auto* eth = (EthernetFrameHeader*)buffer.data();
  83. eth->set_source(mac_address());
  84. eth->set_destination(destination);
  85. eth->set_ether_type(EtherType::ARP);
  86. m_packets_out++;
  87. m_bytes_out += size_in_bytes;
  88. memcpy(eth->payload(), &packet, sizeof(ARPPacket));
  89. send_raw((const u8*)eth, size_in_bytes);
  90. }
  91. void NetworkAdapter::send_ipv4(const MACAddress& destination_mac, const IPv4Address& destination_ipv4, IPv4Protocol protocol, const u8* payload, size_t payload_size, u8 ttl)
  92. {
  93. size_t ipv4_packet_size = sizeof(IPv4Packet) + payload_size;
  94. if (ipv4_packet_size > mtu()) {
  95. // FIXME: Implement IP fragmentation.
  96. ASSERT_NOT_REACHED();
  97. }
  98. size_t ethernet_frame_size = sizeof(EthernetFrameHeader) + sizeof(IPv4Packet) + payload_size;
  99. auto buffer = ByteBuffer::create_zeroed(ethernet_frame_size);
  100. auto& eth = *(EthernetFrameHeader*)buffer.data();
  101. eth.set_source(mac_address());
  102. eth.set_destination(destination_mac);
  103. eth.set_ether_type(EtherType::IPv4);
  104. auto& ipv4 = *(IPv4Packet*)eth.payload();
  105. ipv4.set_version(4);
  106. ipv4.set_internet_header_length(5);
  107. ipv4.set_source(ipv4_address());
  108. ipv4.set_destination(destination_ipv4);
  109. ipv4.set_protocol((u8)protocol);
  110. ipv4.set_length(sizeof(IPv4Packet) + payload_size);
  111. ipv4.set_ident(1);
  112. ipv4.set_ttl(ttl);
  113. ipv4.set_checksum(ipv4.compute_checksum());
  114. m_packets_out++;
  115. m_bytes_out += ethernet_frame_size;
  116. memcpy(ipv4.payload(), payload, payload_size);
  117. send_raw((const u8*)&eth, ethernet_frame_size);
  118. }
  119. void NetworkAdapter::did_receive(const u8* data, size_t length)
  120. {
  121. InterruptDisabler disabler;
  122. m_packets_in++;
  123. m_bytes_in += length;
  124. Optional<KBuffer> buffer;
  125. if (m_unused_packet_buffers.is_empty()) {
  126. buffer = KBuffer::copy(data, length);
  127. } else {
  128. buffer = m_unused_packet_buffers.take_first();
  129. --m_unused_packet_buffers_count;
  130. if (length <= buffer.value().size()) {
  131. memcpy(buffer.value().data(), data, length);
  132. buffer.value().set_size(length);
  133. } else {
  134. buffer = KBuffer::copy(data, length);
  135. }
  136. }
  137. m_packet_queue.append(buffer.value());
  138. if (on_receive)
  139. on_receive();
  140. }
  141. size_t NetworkAdapter::dequeue_packet(u8* buffer, size_t buffer_size)
  142. {
  143. InterruptDisabler disabler;
  144. if (m_packet_queue.is_empty())
  145. return 0;
  146. auto packet = m_packet_queue.take_first();
  147. size_t packet_size = packet.size();
  148. ASSERT(packet_size <= buffer_size);
  149. memcpy(buffer, packet.data(), packet_size);
  150. if (m_unused_packet_buffers_count < 100) {
  151. m_unused_packet_buffers.append(packet);
  152. ++m_unused_packet_buffers_count;
  153. }
  154. return packet_size;
  155. }
  156. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  157. {
  158. m_ipv4_address = address;
  159. }
  160. void NetworkAdapter::set_ipv4_netmask(const IPv4Address& netmask)
  161. {
  162. m_ipv4_netmask = netmask;
  163. }
  164. void NetworkAdapter::set_ipv4_gateway(const IPv4Address& gateway)
  165. {
  166. m_ipv4_gateway = gateway;
  167. }
  168. void NetworkAdapter::set_interface_name(const StringView& basename)
  169. {
  170. // FIXME: Find a unique name for this interface, starting with $basename.
  171. StringBuilder builder;
  172. builder.append(basename);
  173. builder.append('0');
  174. m_name = builder.to_string();
  175. }