NetworkAdapter.cpp 4.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141
  1. #include <AK/HashTable.h>
  2. #include <AK/StringBuilder.h>
  3. #include <Kernel/Lock.h>
  4. #include <Kernel/Net/EtherType.h>
  5. #include <Kernel/Net/EthernetFrameHeader.h>
  6. #include <Kernel/Net/NetworkAdapter.h>
  7. #include <Kernel/StdLib.h>
  8. #include <Kernel/Heap/kmalloc.h>
  9. static Lockable<HashTable<NetworkAdapter*>>& all_adapters()
  10. {
  11. static Lockable<HashTable<NetworkAdapter*>>* table;
  12. if (!table)
  13. table = new Lockable<HashTable<NetworkAdapter*>>;
  14. return *table;
  15. }
  16. void NetworkAdapter::for_each(Function<void(NetworkAdapter&)> callback)
  17. {
  18. LOCKER(all_adapters().lock());
  19. for (auto& it : all_adapters().resource())
  20. callback(*it);
  21. }
  22. WeakPtr<NetworkAdapter> NetworkAdapter::from_ipv4_address(const IPv4Address& address)
  23. {
  24. LOCKER(all_adapters().lock());
  25. for (auto* adapter : all_adapters().resource()) {
  26. if (adapter->ipv4_address() == address)
  27. return adapter->make_weak_ptr();
  28. }
  29. return nullptr;
  30. }
  31. WeakPtr<NetworkAdapter> NetworkAdapter::lookup_by_name(const StringView& name)
  32. {
  33. NetworkAdapter* found_adapter = nullptr;
  34. for_each([&](auto& adapter) {
  35. if (adapter.name() == name)
  36. found_adapter = &adapter;
  37. });
  38. return found_adapter ? found_adapter->make_weak_ptr() : nullptr;
  39. }
  40. NetworkAdapter::NetworkAdapter()
  41. {
  42. // FIXME: I wanna lock :(
  43. all_adapters().resource().set(this);
  44. }
  45. NetworkAdapter::~NetworkAdapter()
  46. {
  47. // FIXME: I wanna lock :(
  48. all_adapters().resource().remove(this);
  49. }
  50. void NetworkAdapter::send(const MACAddress& destination, const ARPPacket& packet)
  51. {
  52. int size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  53. auto buffer = ByteBuffer::create_zeroed(size_in_bytes);
  54. auto* eth = (EthernetFrameHeader*)buffer.data();
  55. eth->set_source(mac_address());
  56. eth->set_destination(destination);
  57. eth->set_ether_type(EtherType::ARP);
  58. m_packets_out++;
  59. m_bytes_out += size_in_bytes;
  60. memcpy(eth->payload(), &packet, sizeof(ARPPacket));
  61. send_raw((const u8*)eth, size_in_bytes);
  62. }
  63. void NetworkAdapter::send_ipv4(const MACAddress& destination_mac, const IPv4Address& destination_ipv4, IPv4Protocol protocol, const u8* payload, size_t payload_size, u8 ttl)
  64. {
  65. size_t ipv4_packet_size = sizeof(IPv4Packet) + payload_size;
  66. if (ipv4_packet_size > mtu()) {
  67. // FIXME: Implement IP fragmentation.
  68. ASSERT_NOT_REACHED();
  69. }
  70. size_t ethernet_frame_size = sizeof(EthernetFrameHeader) + sizeof(IPv4Packet) + payload_size;
  71. auto buffer = ByteBuffer::create_zeroed(ethernet_frame_size);
  72. auto& eth = *(EthernetFrameHeader*)buffer.data();
  73. eth.set_source(mac_address());
  74. eth.set_destination(destination_mac);
  75. eth.set_ether_type(EtherType::IPv4);
  76. auto& ipv4 = *(IPv4Packet*)eth.payload();
  77. ipv4.set_version(4);
  78. ipv4.set_internet_header_length(5);
  79. ipv4.set_source(ipv4_address());
  80. ipv4.set_destination(destination_ipv4);
  81. ipv4.set_protocol((u8)protocol);
  82. ipv4.set_length(sizeof(IPv4Packet) + payload_size);
  83. ipv4.set_ident(1);
  84. ipv4.set_ttl(ttl);
  85. ipv4.set_checksum(ipv4.compute_checksum());
  86. m_packets_out++;
  87. m_bytes_out += ethernet_frame_size;
  88. memcpy(ipv4.payload(), payload, payload_size);
  89. send_raw((const u8*)&eth, ethernet_frame_size);
  90. }
  91. void NetworkAdapter::did_receive(const u8* data, int length)
  92. {
  93. InterruptDisabler disabler;
  94. m_packets_in++;
  95. m_bytes_in += length;
  96. m_packet_queue.append(KBuffer::copy(data, length));
  97. if (on_receive)
  98. on_receive();
  99. }
  100. Optional<KBuffer> NetworkAdapter::dequeue_packet()
  101. {
  102. InterruptDisabler disabler;
  103. if (m_packet_queue.is_empty())
  104. return {};
  105. return m_packet_queue.take_first();
  106. }
  107. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  108. {
  109. m_ipv4_address = address;
  110. }
  111. void NetworkAdapter::set_ipv4_netmask(const IPv4Address& netmask)
  112. {
  113. m_ipv4_netmask = netmask;
  114. }
  115. void NetworkAdapter::set_ipv4_gateway(const IPv4Address& gateway)
  116. {
  117. m_ipv4_gateway = gateway;
  118. }
  119. void NetworkAdapter::set_interface_name(const StringView& basename)
  120. {
  121. // FIXME: Find a unique name for this interface, starting with $basename.
  122. StringBuilder builder;
  123. builder.append(basename);
  124. builder.append('0');
  125. m_name = builder.to_string();
  126. }