UDPSocket.cpp 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149
  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 <Kernel/Devices/RandomDevice.h>
  27. #include <Kernel/Net/NetworkAdapter.h>
  28. #include <Kernel/Net/Routing.h>
  29. #include <Kernel/Net/UDP.h>
  30. #include <Kernel/Net/UDPSocket.h>
  31. #include <Kernel/Process.h>
  32. #include <Kernel/Random.h>
  33. namespace Kernel {
  34. void UDPSocket::for_each(Function<void(const UDPSocket&)> callback)
  35. {
  36. LOCKER(sockets_by_port().lock(), Lock::Mode::Shared);
  37. for (auto it : sockets_by_port().resource())
  38. callback(*it.value);
  39. }
  40. Lockable<HashMap<u16, UDPSocket*>>& UDPSocket::sockets_by_port()
  41. {
  42. static Lockable<HashMap<u16, UDPSocket*>>* s_map;
  43. if (!s_map)
  44. s_map = new Lockable<HashMap<u16, UDPSocket*>>;
  45. return *s_map;
  46. }
  47. SocketHandle<UDPSocket> UDPSocket::from_port(u16 port)
  48. {
  49. RefPtr<UDPSocket> socket;
  50. {
  51. LOCKER(sockets_by_port().lock(), Lock::Mode::Shared);
  52. auto it = sockets_by_port().resource().find(port);
  53. if (it == sockets_by_port().resource().end())
  54. return {};
  55. socket = (*it).value;
  56. ASSERT(socket);
  57. }
  58. return { *socket };
  59. }
  60. UDPSocket::UDPSocket(int protocol)
  61. : IPv4Socket(SOCK_DGRAM, protocol)
  62. {
  63. }
  64. UDPSocket::~UDPSocket()
  65. {
  66. LOCKER(sockets_by_port().lock());
  67. sockets_by_port().resource().remove(local_port());
  68. }
  69. NonnullRefPtr<UDPSocket> UDPSocket::create(int protocol)
  70. {
  71. return adopt(*new UDPSocket(protocol));
  72. }
  73. KResultOr<size_t> UDPSocket::protocol_receive(const KBuffer& packet_buffer, void* buffer, size_t buffer_size, int flags)
  74. {
  75. (void)flags;
  76. auto& ipv4_packet = *(const IPv4Packet*)(packet_buffer.data());
  77. auto& udp_packet = *static_cast<const UDPPacket*>(ipv4_packet.payload());
  78. ASSERT(udp_packet.length() >= sizeof(UDPPacket)); // FIXME: This should be rejected earlier.
  79. ASSERT(buffer_size >= (udp_packet.length() - sizeof(UDPPacket)));
  80. memcpy(buffer, udp_packet.payload(), udp_packet.length() - sizeof(UDPPacket));
  81. return udp_packet.length() - sizeof(UDPPacket);
  82. }
  83. KResultOr<size_t> UDPSocket::protocol_send(const void* data, size_t data_length)
  84. {
  85. auto routing_decision = route_to(peer_address(), local_address(), bound_interface());
  86. if (routing_decision.is_zero())
  87. return KResult(-EHOSTUNREACH);
  88. auto buffer = ByteBuffer::create_zeroed(sizeof(UDPPacket) + data_length);
  89. auto& udp_packet = *(UDPPacket*)(buffer.data());
  90. udp_packet.set_source_port(local_port());
  91. udp_packet.set_destination_port(peer_port());
  92. udp_packet.set_length(sizeof(UDPPacket) + data_length);
  93. memcpy(udp_packet.payload(), data, data_length);
  94. klog() << "sending as udp packet from " << routing_decision.adapter->ipv4_address().to_string().characters() << ":" << local_port() << " to " << peer_address().to_string().characters() << ":" << peer_port() << "!";
  95. routing_decision.adapter->send_ipv4(routing_decision.next_hop, peer_address(), IPv4Protocol::UDP, buffer, ttl());
  96. return data_length;
  97. }
  98. KResult UDPSocket::protocol_connect(FileDescription&, ShouldBlock)
  99. {
  100. m_role = Role::Connected;
  101. set_connected(true);
  102. return KSuccess;
  103. }
  104. int UDPSocket::protocol_allocate_local_port()
  105. {
  106. static const u16 first_ephemeral_port = 32768;
  107. static const u16 last_ephemeral_port = 60999;
  108. static const u16 ephemeral_port_range_size = last_ephemeral_port - first_ephemeral_port;
  109. u16 first_scan_port = first_ephemeral_port + get_good_random<u16>() % ephemeral_port_range_size;
  110. LOCKER(sockets_by_port().lock());
  111. for (u16 port = first_scan_port;;) {
  112. auto it = sockets_by_port().resource().find(port);
  113. if (it == sockets_by_port().resource().end()) {
  114. set_local_port(port);
  115. sockets_by_port().resource().set(port, this);
  116. return port;
  117. }
  118. ++port;
  119. if (port > last_ephemeral_port)
  120. port = first_ephemeral_port;
  121. if (port == first_scan_port)
  122. break;
  123. }
  124. return -EADDRINUSE;
  125. }
  126. KResult UDPSocket::protocol_bind()
  127. {
  128. LOCKER(sockets_by_port().lock());
  129. if (sockets_by_port().resource().contains(local_port()))
  130. return KResult(-EADDRINUSE);
  131. sockets_by_port().resource().set(local_port(), this);
  132. return KSuccess;
  133. }
  134. }