/* * Copyright (c) 2018-2020, Andreas Kling * * SPDX-License-Identifier: BSD-2-Clause */ #include #include #include #include #include #include #include #include namespace Kernel { void UDPSocket::for_each(Function callback) { sockets_by_port().for_each_shared([&](auto const& socket) { callback(*socket.value); }); } ErrorOr UDPSocket::try_for_each(Function(UDPSocket const&)> callback) { return sockets_by_port().with_shared([&](auto const& sockets) -> ErrorOr { for (auto& socket : sockets) TRY(callback(*socket.value)); return {}; }); } static Singleton>> s_map; MutexProtected>& UDPSocket::sockets_by_port() { return *s_map; } LockRefPtr UDPSocket::from_port(u16 port) { return sockets_by_port().with_shared([&](auto const& table) -> LockRefPtr { auto it = table.find(port); if (it == table.end()) return {}; return (*it).value; }); } UDPSocket::UDPSocket(int protocol, NonnullOwnPtr receive_buffer) : IPv4Socket(SOCK_DGRAM, protocol, move(receive_buffer), {}) { } UDPSocket::~UDPSocket() { sockets_by_port().with_exclusive([&](auto& table) { table.remove(local_port()); }); } ErrorOr> UDPSocket::try_create(int protocol, NonnullOwnPtr receive_buffer) { return adopt_nonnull_lock_ref_or_enomem(new (nothrow) UDPSocket(protocol, move(receive_buffer))); } ErrorOr UDPSocket::protocol_size(ReadonlyBytes raw_ipv4_packet) { auto& ipv4_packet = *(IPv4Packet const*)(raw_ipv4_packet.data()); auto& udp_packet = *static_cast(ipv4_packet.payload()); return udp_packet.length() - sizeof(UDPPacket); } ErrorOr UDPSocket::protocol_receive(ReadonlyBytes raw_ipv4_packet, UserOrKernelBuffer& buffer, size_t buffer_size, [[maybe_unused]] int flags) { auto& ipv4_packet = *(IPv4Packet const*)(raw_ipv4_packet.data()); auto& udp_packet = *static_cast(ipv4_packet.payload()); VERIFY(udp_packet.length() >= sizeof(UDPPacket)); // FIXME: This should be rejected earlier. size_t read_size = min(buffer_size, udp_packet.length() - sizeof(UDPPacket)); SOCKET_TRY(buffer.write(udp_packet.payload(), read_size)); return read_size; } ErrorOr UDPSocket::protocol_send(UserOrKernelBuffer const& data, size_t data_length) { auto routing_decision = route_to(peer_address(), local_address(), bound_interface()); if (routing_decision.is_zero()) return set_so_error(EHOSTUNREACH); auto ipv4_payload_offset = routing_decision.adapter->ipv4_payload_offset(); data_length = min(data_length, routing_decision.adapter->mtu() - ipv4_payload_offset - sizeof(UDPPacket)); const size_t udp_buffer_size = sizeof(UDPPacket) + data_length; auto packet = routing_decision.adapter->acquire_packet_buffer(ipv4_payload_offset + udp_buffer_size); if (!packet) return set_so_error(ENOMEM); memset(packet->buffer->data() + ipv4_payload_offset, 0, sizeof(UDPPacket)); auto& udp_packet = *reinterpret_cast(packet->buffer->data() + ipv4_payload_offset); udp_packet.set_source_port(local_port()); udp_packet.set_destination_port(peer_port()); udp_packet.set_length(udp_buffer_size); SOCKET_TRY(data.read(udp_packet.payload(), data_length)); routing_decision.adapter->fill_in_ipv4_header(*packet, local_address(), routing_decision.next_hop, peer_address(), IPv4Protocol::UDP, udp_buffer_size, type_of_service(), ttl()); routing_decision.adapter->send_packet(packet->bytes()); return data_length; } ErrorOr UDPSocket::protocol_connect(OpenFileDescription&) { set_role(Role::Connected); set_connected(true); return {}; } ErrorOr UDPSocket::protocol_allocate_local_port() { constexpr u16 first_ephemeral_port = 32768; constexpr u16 last_ephemeral_port = 60999; constexpr u16 ephemeral_port_range_size = last_ephemeral_port - first_ephemeral_port; u16 first_scan_port = first_ephemeral_port + get_good_random() % ephemeral_port_range_size; return sockets_by_port().with_exclusive([&](auto& table) -> ErrorOr { for (u16 port = first_scan_port;;) { auto it = table.find(port); if (it == table.end()) { set_local_port(port); table.set(port, this); return port; } ++port; if (port > last_ephemeral_port) port = first_ephemeral_port; if (port == first_scan_port) break; } return set_so_error(EADDRINUSE); }); } ErrorOr UDPSocket::protocol_bind() { return sockets_by_port().with_exclusive([&](auto& table) -> ErrorOr { if (table.contains(local_port())) return set_so_error(EADDRINUSE); table.set(local_port(), this); return {}; }); } }