NetworkAdapter.cpp 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596
  1. #include <Kernel/NetworkAdapter.h>
  2. #include <Kernel/StdLib.h>
  3. #include <Kernel/EthernetFrameHeader.h>
  4. #include <Kernel/kmalloc.h>
  5. #include <Kernel/EtherType.h>
  6. #include <AK/HashTable.h>
  7. #include <Kernel/Lock.h>
  8. static Lockable<HashTable<NetworkAdapter*>>& all_adapters()
  9. {
  10. static Lockable<HashTable<NetworkAdapter*>>* table;
  11. if (!table)
  12. table = new Lockable<HashTable<NetworkAdapter*>>;
  13. return *table;
  14. }
  15. NetworkAdapter* NetworkAdapter::from_ipv4_address(const IPv4Address& address)
  16. {
  17. LOCKER(all_adapters().lock());
  18. for (auto* adapter : all_adapters().resource()) {
  19. if (adapter->ipv4_address() == address)
  20. return adapter;
  21. }
  22. return nullptr;
  23. }
  24. NetworkAdapter::NetworkAdapter()
  25. : m_packet_queue_alarm(*this)
  26. {
  27. // FIXME: I wanna lock :(
  28. all_adapters().resource().set(this);
  29. }
  30. NetworkAdapter::~NetworkAdapter()
  31. {
  32. // FIXME: I wanna lock :(
  33. all_adapters().resource().remove(this);
  34. }
  35. void NetworkAdapter::send(const MACAddress& destination, const ARPPacket& packet)
  36. {
  37. int size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  38. auto buffer = ByteBuffer::create_zeroed(size_in_bytes);
  39. auto* eth = (EthernetFrameHeader*)buffer.pointer();
  40. eth->set_source(mac_address());
  41. eth->set_destination(destination);
  42. eth->set_ether_type(EtherType::ARP);
  43. memcpy(eth->payload(), &packet, sizeof(ARPPacket));
  44. send_raw((byte*)eth, size_in_bytes);
  45. }
  46. void NetworkAdapter::send_ipv4(const MACAddress& destination_mac, const IPv4Address& destination_ipv4, IPv4Protocol protocol, ByteBuffer&& payload)
  47. {
  48. size_t size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(IPv4Packet) + payload.size();
  49. auto buffer = ByteBuffer::create_zeroed(size_in_bytes);
  50. auto& eth = *(EthernetFrameHeader*)buffer.pointer();
  51. eth.set_source(mac_address());
  52. eth.set_destination(destination_mac);
  53. eth.set_ether_type(EtherType::IPv4);
  54. auto& ipv4 = *(IPv4Packet*)eth.payload();
  55. ipv4.set_version(4);
  56. ipv4.set_internet_header_length(5);
  57. ipv4.set_source(ipv4_address());
  58. ipv4.set_destination(destination_ipv4);
  59. ipv4.set_protocol((byte)protocol);
  60. ipv4.set_length(sizeof(IPv4Packet) + payload.size());
  61. ipv4.set_ident(1);
  62. ipv4.set_ttl(64);
  63. ipv4.set_checksum(ipv4.compute_checksum());
  64. memcpy(ipv4.payload(), payload.pointer(), payload.size());
  65. send_raw((const byte*)&eth, size_in_bytes);
  66. }
  67. void NetworkAdapter::did_receive(const byte* data, int length)
  68. {
  69. InterruptDisabler disabler;
  70. m_packet_queue.append(ByteBuffer::copy(data, length));
  71. }
  72. ByteBuffer NetworkAdapter::dequeue_packet()
  73. {
  74. InterruptDisabler disabler;
  75. if (m_packet_queue.is_empty())
  76. return { };
  77. return m_packet_queue.take_first();
  78. }
  79. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  80. {
  81. m_ipv4_address = address;
  82. }
  83. bool PacketQueueAlarm::is_ringing() const
  84. {
  85. return m_adapter.has_queued_packets();
  86. }