NetworkAdapter.cpp 2.8 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192
  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 <AK/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. {
  26. // FIXME: I wanna lock :(
  27. ASSERT_INTERRUPTS_DISABLED();
  28. all_adapters().resource().set(this);
  29. }
  30. NetworkAdapter::~NetworkAdapter()
  31. {
  32. // FIXME: I wanna lock :(
  33. ASSERT_INTERRUPTS_DISABLED();
  34. all_adapters().resource().remove(this);
  35. }
  36. void NetworkAdapter::send(const MACAddress& destination, const ARPPacket& packet)
  37. {
  38. int size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  39. auto* eth = (EthernetFrameHeader*)kmalloc(size_in_bytes);
  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. kfree(eth);
  46. }
  47. void NetworkAdapter::send_ipv4(const MACAddress& destination_mac, const IPv4Address& destination_ipv4, IPv4Protocol protocol, ByteBuffer&& payload)
  48. {
  49. size_t size_in_bytes = sizeof(EthernetFrameHeader) + sizeof(IPv4Packet) + payload.size();
  50. auto buffer = ByteBuffer::create_zeroed(size_in_bytes);
  51. auto& eth = *(EthernetFrameHeader*)buffer.pointer();
  52. eth.set_source(mac_address());
  53. eth.set_destination(destination_mac);
  54. eth.set_ether_type(EtherType::IPv4);
  55. auto& ipv4 = *(IPv4Packet*)eth.payload();
  56. ipv4.set_version(4);
  57. ipv4.set_internet_header_length(5);
  58. ipv4.set_source(ipv4_address());
  59. ipv4.set_destination(destination_ipv4);
  60. ipv4.set_protocol((byte)protocol);
  61. ipv4.set_length(sizeof(IPv4Packet) + payload.size());
  62. ipv4.set_ident(1);
  63. ipv4.set_ttl(64);
  64. ipv4.set_checksum(ipv4.compute_checksum());
  65. memcpy(ipv4.payload(), payload.pointer(), payload.size());
  66. send_raw((const byte*)&eth, size_in_bytes);
  67. }
  68. void NetworkAdapter::did_receive(const byte* data, int length)
  69. {
  70. InterruptDisabler disabler;
  71. m_packet_queue.append(ByteBuffer::copy(data, length));
  72. }
  73. ByteBuffer NetworkAdapter::dequeue_packet()
  74. {
  75. InterruptDisabler disabler;
  76. if (m_packet_queue.is_empty())
  77. return { };
  78. return m_packet_queue.take_first();
  79. }
  80. void NetworkAdapter::set_ipv4_address(const IPv4Address& address)
  81. {
  82. m_ipv4_address = address;
  83. }