NetworkTask.cpp 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559
  1. /*
  2. * Copyright (c) 2018-2021, Andreas Kling <kling@serenityos.org>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Debug.h>
  7. #include <Kernel/Lock.h>
  8. #include <Kernel/Net/ARP.h>
  9. #include <Kernel/Net/EtherType.h>
  10. #include <Kernel/Net/EthernetFrameHeader.h>
  11. #include <Kernel/Net/ICMP.h>
  12. #include <Kernel/Net/IPv4.h>
  13. #include <Kernel/Net/IPv4Socket.h>
  14. #include <Kernel/Net/LoopbackAdapter.h>
  15. #include <Kernel/Net/NetworkTask.h>
  16. #include <Kernel/Net/Routing.h>
  17. #include <Kernel/Net/TCP.h>
  18. #include <Kernel/Net/TCPSocket.h>
  19. #include <Kernel/Net/UDP.h>
  20. #include <Kernel/Net/UDPSocket.h>
  21. #include <Kernel/Process.h>
  22. namespace Kernel {
  23. static void handle_arp(const EthernetFrameHeader&, size_t frame_size);
  24. static void handle_ipv4(const EthernetFrameHeader&, size_t frame_size, const Time& packet_timestamp);
  25. static void handle_icmp(const EthernetFrameHeader&, const IPv4Packet&, const Time& packet_timestamp);
  26. static void handle_udp(const IPv4Packet&, const Time& packet_timestamp);
  27. static void handle_tcp(const IPv4Packet&, const Time& packet_timestamp);
  28. static Thread* network_task = nullptr;
  29. [[noreturn]] static void NetworkTask_main(void*);
  30. void NetworkTask::spawn()
  31. {
  32. RefPtr<Thread> thread;
  33. Process::create_kernel_process(thread, "NetworkTask", NetworkTask_main, nullptr);
  34. network_task = thread;
  35. }
  36. bool NetworkTask::is_current()
  37. {
  38. return Thread::current() == network_task;
  39. }
  40. void NetworkTask_main(void*)
  41. {
  42. WaitQueue packet_wait_queue;
  43. int pending_packets = 0;
  44. NetworkAdapter::for_each([&](auto& adapter) {
  45. dmesgln("NetworkTask: {} network adapter found: hw={}", adapter.class_name(), adapter.mac_address().to_string());
  46. if (String(adapter.class_name()) == "LoopbackAdapter") {
  47. adapter.set_ipv4_address({ 127, 0, 0, 1 });
  48. adapter.set_ipv4_netmask({ 255, 0, 0, 0 });
  49. adapter.set_ipv4_gateway({ 0, 0, 0, 0 });
  50. }
  51. adapter.on_receive = [&]() {
  52. pending_packets++;
  53. packet_wait_queue.wake_all();
  54. };
  55. });
  56. auto dequeue_packet = [&pending_packets](u8* buffer, size_t buffer_size, Time& packet_timestamp) -> size_t {
  57. if (pending_packets == 0)
  58. return 0;
  59. size_t packet_size = 0;
  60. NetworkAdapter::for_each([&](auto& adapter) {
  61. if (packet_size || !adapter.has_queued_packets())
  62. return;
  63. packet_size = adapter.dequeue_packet(buffer, buffer_size, packet_timestamp);
  64. pending_packets--;
  65. dbgln_if(NETWORK_TASK_DEBUG, "NetworkTask: Dequeued packet from {} ({} bytes)", adapter.name(), packet_size);
  66. });
  67. return packet_size;
  68. };
  69. size_t buffer_size = 64 * KiB;
  70. auto buffer_region = MM.allocate_kernel_region(buffer_size, "Kernel Packet Buffer", Region::Access::Read | Region::Access::Write);
  71. auto buffer = (u8*)buffer_region->vaddr().get();
  72. Time packet_timestamp;
  73. for (;;) {
  74. size_t packet_size = dequeue_packet(buffer, buffer_size, packet_timestamp);
  75. if (!packet_size) {
  76. packet_wait_queue.wait_forever("NetworkTask");
  77. continue;
  78. }
  79. if (packet_size < sizeof(EthernetFrameHeader)) {
  80. dbgln("NetworkTask: Packet is too small to be an Ethernet packet! ({})", packet_size);
  81. continue;
  82. }
  83. auto& eth = *(const EthernetFrameHeader*)buffer;
  84. dbgln_if(ETHERNET_DEBUG, "NetworkTask: From {} to {}, ether_type={:#04x}, packet_size={}", eth.source().to_string(), eth.destination().to_string(), eth.ether_type(), packet_size);
  85. switch (eth.ether_type()) {
  86. case EtherType::ARP:
  87. handle_arp(eth, packet_size);
  88. break;
  89. case EtherType::IPv4:
  90. handle_ipv4(eth, packet_size, packet_timestamp);
  91. break;
  92. case EtherType::IPv6:
  93. // ignore
  94. break;
  95. default:
  96. dbgln_if(ETHERNET_DEBUG, "NetworkTask: Unknown ethernet type {:#04x}", eth.ether_type());
  97. }
  98. }
  99. }
  100. void handle_arp(const EthernetFrameHeader& eth, size_t frame_size)
  101. {
  102. constexpr size_t minimum_arp_frame_size = sizeof(EthernetFrameHeader) + sizeof(ARPPacket);
  103. if (frame_size < minimum_arp_frame_size) {
  104. dbgln("handle_arp: Frame too small ({}, need {})", frame_size, minimum_arp_frame_size);
  105. return;
  106. }
  107. auto& packet = *static_cast<const ARPPacket*>(eth.payload());
  108. if (packet.hardware_type() != 1 || packet.hardware_address_length() != sizeof(MACAddress)) {
  109. dbgln("handle_arp: Hardware type not ethernet ({:#04x}, len={})", packet.hardware_type(), packet.hardware_address_length());
  110. return;
  111. }
  112. if (packet.protocol_type() != EtherType::IPv4 || packet.protocol_address_length() != sizeof(IPv4Address)) {
  113. dbgln("handle_arp: Protocol type not IPv4 ({:#04x}, len={})", packet.protocol_type(), packet.protocol_address_length());
  114. return;
  115. }
  116. dbgln_if(ARP_DEBUG, "handle_arp: operation={:#04x}, sender={}/{}, target={}/{}",
  117. packet.operation(),
  118. packet.sender_hardware_address().to_string(),
  119. packet.sender_protocol_address().to_string(),
  120. packet.target_hardware_address().to_string(),
  121. packet.target_protocol_address().to_string());
  122. if (!packet.sender_hardware_address().is_zero() && !packet.sender_protocol_address().is_zero()) {
  123. // Someone has this IPv4 address. I guess we can try to remember that.
  124. // FIXME: Protect against ARP spamming.
  125. // FIXME: Support static ARP table entries.
  126. update_arp_table(packet.sender_protocol_address(), packet.sender_hardware_address());
  127. }
  128. if (packet.operation() == ARPOperation::Request) {
  129. // Who has this IP address?
  130. if (auto adapter = NetworkAdapter::from_ipv4_address(packet.target_protocol_address())) {
  131. // We do!
  132. dbgln("handle_arp: Responding to ARP request for my IPv4 address ({})", adapter->ipv4_address());
  133. ARPPacket response;
  134. response.set_operation(ARPOperation::Response);
  135. response.set_target_hardware_address(packet.sender_hardware_address());
  136. response.set_target_protocol_address(packet.sender_protocol_address());
  137. response.set_sender_hardware_address(adapter->mac_address());
  138. response.set_sender_protocol_address(adapter->ipv4_address());
  139. adapter->send(packet.sender_hardware_address(), response);
  140. }
  141. return;
  142. }
  143. }
  144. void handle_ipv4(const EthernetFrameHeader& eth, size_t frame_size, const Time& packet_timestamp)
  145. {
  146. constexpr size_t minimum_ipv4_frame_size = sizeof(EthernetFrameHeader) + sizeof(IPv4Packet);
  147. if (frame_size < minimum_ipv4_frame_size) {
  148. dbgln("handle_ipv4: Frame too small ({}, need {})", frame_size, minimum_ipv4_frame_size);
  149. return;
  150. }
  151. auto& packet = *static_cast<const IPv4Packet*>(eth.payload());
  152. if (packet.length() < sizeof(IPv4Packet)) {
  153. dbgln("handle_ipv4: IPv4 packet too short ({}, need {})", packet.length(), sizeof(IPv4Packet));
  154. return;
  155. }
  156. size_t actual_ipv4_packet_length = frame_size - sizeof(EthernetFrameHeader);
  157. if (packet.length() > actual_ipv4_packet_length) {
  158. dbgln("handle_ipv4: IPv4 packet claims to be longer than it is ({}, actually {})", packet.length(), actual_ipv4_packet_length);
  159. return;
  160. }
  161. dbgln_if(IPV4_DEBUG, "handle_ipv4: source={}, destination={}", packet.source(), packet.destination());
  162. NetworkAdapter::for_each([&](auto& adapter) {
  163. if (adapter.link_up()) {
  164. auto my_net = adapter.ipv4_address().to_u32() & adapter.ipv4_netmask().to_u32();
  165. auto their_net = packet.source().to_u32() & adapter.ipv4_netmask().to_u32();
  166. if (my_net == their_net)
  167. update_arp_table(packet.source(), eth.source());
  168. }
  169. });
  170. switch ((IPv4Protocol)packet.protocol()) {
  171. case IPv4Protocol::ICMP:
  172. return handle_icmp(eth, packet, packet_timestamp);
  173. case IPv4Protocol::UDP:
  174. return handle_udp(packet, packet_timestamp);
  175. case IPv4Protocol::TCP:
  176. return handle_tcp(packet, packet_timestamp);
  177. default:
  178. dbgln_if(IPV4_DEBUG, "handle_ipv4: Unhandled protocol {:#02x}", packet.protocol());
  179. break;
  180. }
  181. }
  182. void handle_icmp(const EthernetFrameHeader& eth, const IPv4Packet& ipv4_packet, const Time& packet_timestamp)
  183. {
  184. auto& icmp_header = *static_cast<const ICMPHeader*>(ipv4_packet.payload());
  185. dbgln_if(ICMP_DEBUG, "handle_icmp: source={}, destination={}, type={:#02x}, code={:#02x}", ipv4_packet.source().to_string(), ipv4_packet.destination().to_string(), icmp_header.type(), icmp_header.code());
  186. {
  187. NonnullRefPtrVector<IPv4Socket> icmp_sockets;
  188. {
  189. Locker locker(IPv4Socket::all_sockets().lock(), Lock::Mode::Shared);
  190. for (auto* socket : IPv4Socket::all_sockets().resource()) {
  191. if (socket->protocol() != (unsigned)IPv4Protocol::ICMP)
  192. continue;
  193. icmp_sockets.append(*socket);
  194. }
  195. }
  196. for (auto& socket : icmp_sockets)
  197. socket.did_receive(ipv4_packet.source(), 0, KBuffer::copy(&ipv4_packet, sizeof(IPv4Packet) + ipv4_packet.payload_size()), packet_timestamp);
  198. }
  199. auto adapter = NetworkAdapter::from_ipv4_address(ipv4_packet.destination());
  200. if (!adapter)
  201. return;
  202. if (icmp_header.type() == ICMPType::EchoRequest) {
  203. auto& request = reinterpret_cast<const ICMPEchoPacket&>(icmp_header);
  204. dbgln("handle_icmp: EchoRequest from {}: id={}, seq={}", ipv4_packet.source(), (u16)request.identifier, (u16)request.sequence_number);
  205. size_t icmp_packet_size = ipv4_packet.payload_size();
  206. if (icmp_packet_size < sizeof(ICMPEchoPacket)) {
  207. dbgln("handle_icmp: EchoRequest packet is too small, ignoring.");
  208. return;
  209. }
  210. auto buffer = ByteBuffer::create_zeroed(icmp_packet_size);
  211. auto& response = *(ICMPEchoPacket*)buffer.data();
  212. response.header.set_type(ICMPType::EchoReply);
  213. response.header.set_code(0);
  214. response.identifier = request.identifier;
  215. response.sequence_number = request.sequence_number;
  216. if (size_t icmp_payload_size = icmp_packet_size - sizeof(ICMPEchoPacket))
  217. memcpy(response.payload(), request.payload(), icmp_payload_size);
  218. response.header.set_checksum(internet_checksum(&response, icmp_packet_size));
  219. // FIXME: What is the right TTL value here? Is 64 ok? Should we use the same TTL as the echo request?
  220. auto response_buffer = UserOrKernelBuffer::for_kernel_buffer((u8*)&response);
  221. [[maybe_unused]] auto result = adapter->send_ipv4(eth.source(), ipv4_packet.source(), IPv4Protocol::ICMP, response_buffer, buffer.size(), 64);
  222. }
  223. }
  224. void handle_udp(const IPv4Packet& ipv4_packet, const Time& packet_timestamp)
  225. {
  226. if (ipv4_packet.payload_size() < sizeof(UDPPacket)) {
  227. dbgln("handle_udp: Packet too small ({}, need {})", ipv4_packet.payload_size(), sizeof(UDPPacket));
  228. return;
  229. }
  230. auto adapter = NetworkAdapter::from_ipv4_address(ipv4_packet.destination());
  231. if (!adapter && ipv4_packet.destination() != IPv4Address(255, 255, 255, 255)) {
  232. dbgln_if(UDP_DEBUG, "handle_udp: this packet is not for me, it's for {}", ipv4_packet.destination());
  233. return;
  234. }
  235. auto& udp_packet = *static_cast<const UDPPacket*>(ipv4_packet.payload());
  236. dbgln_if(UDP_DEBUG, "handle_udp: source={}:{}, destination={}:{}, length={}",
  237. ipv4_packet.source(), udp_packet.source_port(),
  238. ipv4_packet.destination(), udp_packet.destination_port(),
  239. udp_packet.length());
  240. auto socket = UDPSocket::from_port(udp_packet.destination_port());
  241. if (!socket) {
  242. dbgln_if(UDP_DEBUG, "handle_udp: No local UDP socket for {}:{}", ipv4_packet.destination(), udp_packet.destination_port());
  243. return;
  244. }
  245. VERIFY(socket->type() == SOCK_DGRAM);
  246. VERIFY(socket->local_port() == udp_packet.destination_port());
  247. socket->did_receive(ipv4_packet.source(), udp_packet.source_port(), KBuffer::copy(&ipv4_packet, sizeof(IPv4Packet) + ipv4_packet.payload_size()), packet_timestamp);
  248. }
  249. void handle_tcp(const IPv4Packet& ipv4_packet, const Time& packet_timestamp)
  250. {
  251. if (ipv4_packet.payload_size() < sizeof(TCPPacket)) {
  252. dbgln("handle_tcp: IPv4 payload is too small to be a TCP packet ({}, need {})", ipv4_packet.payload_size(), sizeof(TCPPacket));
  253. return;
  254. }
  255. auto& tcp_packet = *static_cast<const TCPPacket*>(ipv4_packet.payload());
  256. size_t minimum_tcp_header_size = 5 * sizeof(u32);
  257. size_t maximum_tcp_header_size = 15 * sizeof(u32);
  258. if (tcp_packet.header_size() < minimum_tcp_header_size || tcp_packet.header_size() > maximum_tcp_header_size) {
  259. dbgln("handle_tcp: TCP packet header has invalid size {}", tcp_packet.header_size());
  260. }
  261. if (ipv4_packet.payload_size() < tcp_packet.header_size()) {
  262. dbgln("handle_tcp: IPv4 payload is smaller than TCP header claims ({}, supposedly {})", ipv4_packet.payload_size(), tcp_packet.header_size());
  263. return;
  264. }
  265. size_t payload_size = ipv4_packet.payload_size() - tcp_packet.header_size();
  266. dbgln_if(TCP_DEBUG, "handle_tcp: source={}:{}, destination={}:{}, seq_no={}, ack_no={}, flags={:#04x} ({}{}{}{}), window_size={}, payload_size={}",
  267. ipv4_packet.source().to_string(),
  268. tcp_packet.source_port(),
  269. ipv4_packet.destination().to_string(),
  270. tcp_packet.destination_port(),
  271. tcp_packet.sequence_number(),
  272. tcp_packet.ack_number(),
  273. tcp_packet.flags(),
  274. tcp_packet.has_syn() ? "SYN " : "",
  275. tcp_packet.has_ack() ? "ACK " : "",
  276. tcp_packet.has_fin() ? "FIN " : "",
  277. tcp_packet.has_rst() ? "RST " : "",
  278. tcp_packet.window_size(),
  279. payload_size);
  280. auto adapter = NetworkAdapter::from_ipv4_address(ipv4_packet.destination());
  281. if (!adapter) {
  282. dbgln("handle_tcp: this packet is not for me, it's for {}", ipv4_packet.destination());
  283. return;
  284. }
  285. IPv4SocketTuple tuple(ipv4_packet.destination(), tcp_packet.destination_port(), ipv4_packet.source(), tcp_packet.source_port());
  286. dbgln_if(TCP_DEBUG, "handle_tcp: looking for socket; tuple={}", tuple.to_string());
  287. auto socket = TCPSocket::from_tuple(tuple);
  288. if (!socket) {
  289. dbgln("handle_tcp: No TCP socket for tuple {}", tuple.to_string());
  290. dbgln("handle_tcp: source={}:{}, destination={}:{}, seq_no={}, ack_no={}, flags={:#04x} ({}{}{}{}), window_size={}, payload_size={}",
  291. ipv4_packet.source().to_string(), tcp_packet.source_port(),
  292. ipv4_packet.destination().to_string(),
  293. tcp_packet.destination_port(),
  294. tcp_packet.sequence_number(),
  295. tcp_packet.ack_number(),
  296. tcp_packet.flags(),
  297. tcp_packet.has_syn() ? "SYN " : "",
  298. tcp_packet.has_ack() ? "ACK " : "",
  299. tcp_packet.has_fin() ? "FIN " : "",
  300. tcp_packet.has_rst() ? "RST " : "",
  301. tcp_packet.window_size(),
  302. payload_size);
  303. return;
  304. }
  305. Locker locker(socket->lock());
  306. VERIFY(socket->type() == SOCK_STREAM);
  307. VERIFY(socket->local_port() == tcp_packet.destination_port());
  308. dbgln_if(TCP_DEBUG, "handle_tcp: got socket {}; state={}", socket->tuple().to_string(), TCPSocket::to_string(socket->state()));
  309. socket->receive_tcp_packet(tcp_packet, ipv4_packet.payload_size());
  310. [[maybe_unused]] int unused_rc {};
  311. switch (socket->state()) {
  312. case TCPSocket::State::Closed:
  313. dbgln("handle_tcp: unexpected flags in Closed state");
  314. // TODO: we may want to send an RST here, maybe as a configurable option
  315. return;
  316. case TCPSocket::State::TimeWait:
  317. dbgln("handle_tcp: unexpected flags in TimeWait state");
  318. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  319. socket->set_state(TCPSocket::State::Closed);
  320. return;
  321. case TCPSocket::State::Listen:
  322. switch (tcp_packet.flags()) {
  323. case TCPFlags::SYN: {
  324. dbgln_if(TCP_DEBUG, "handle_tcp: incoming connection");
  325. auto& local_address = ipv4_packet.destination();
  326. auto& peer_address = ipv4_packet.source();
  327. auto client = socket->create_client(local_address, tcp_packet.destination_port(), peer_address, tcp_packet.source_port());
  328. if (!client) {
  329. dmesgln("handle_tcp: couldn't create client socket");
  330. return;
  331. }
  332. Locker locker(client->lock());
  333. dbgln_if(TCP_DEBUG, "handle_tcp: created new client socket with tuple {}", client->tuple().to_string());
  334. client->set_sequence_number(1000);
  335. client->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  336. [[maybe_unused]] auto rc2 = client->send_tcp_packet(TCPFlags::SYN | TCPFlags::ACK);
  337. client->set_state(TCPSocket::State::SynReceived);
  338. return;
  339. }
  340. default:
  341. dbgln("handle_tcp: unexpected flags in Listen state");
  342. // socket->send_tcp_packet(TCPFlags::RST);
  343. return;
  344. }
  345. case TCPSocket::State::SynSent:
  346. switch (tcp_packet.flags()) {
  347. case TCPFlags::SYN:
  348. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  349. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  350. socket->set_state(TCPSocket::State::SynReceived);
  351. return;
  352. case TCPFlags::ACK | TCPFlags::SYN:
  353. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  354. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  355. socket->set_state(TCPSocket::State::Established);
  356. socket->set_setup_state(Socket::SetupState::Completed);
  357. socket->set_connected(true);
  358. return;
  359. case TCPFlags::ACK | TCPFlags::FIN:
  360. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  361. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  362. socket->set_state(TCPSocket::State::Closed);
  363. socket->set_error(TCPSocket::Error::FINDuringConnect);
  364. socket->set_setup_state(Socket::SetupState::Completed);
  365. return;
  366. case TCPFlags::ACK | TCPFlags::RST:
  367. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  368. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  369. socket->set_state(TCPSocket::State::Closed);
  370. socket->set_error(TCPSocket::Error::RSTDuringConnect);
  371. socket->set_setup_state(Socket::SetupState::Completed);
  372. return;
  373. default:
  374. dbgln("handle_tcp: unexpected flags in SynSent state");
  375. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  376. socket->set_state(TCPSocket::State::Closed);
  377. socket->set_error(TCPSocket::Error::UnexpectedFlagsDuringConnect);
  378. socket->set_setup_state(Socket::SetupState::Completed);
  379. return;
  380. }
  381. case TCPSocket::State::SynReceived:
  382. switch (tcp_packet.flags()) {
  383. case TCPFlags::ACK:
  384. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  385. switch (socket->direction()) {
  386. case TCPSocket::Direction::Incoming:
  387. if (!socket->has_originator()) {
  388. dbgln("handle_tcp: connection doesn't have an originating socket; maybe it went away?");
  389. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  390. socket->set_state(TCPSocket::State::Closed);
  391. return;
  392. }
  393. socket->set_state(TCPSocket::State::Established);
  394. socket->set_setup_state(Socket::SetupState::Completed);
  395. socket->release_to_originator();
  396. return;
  397. case TCPSocket::Direction::Outgoing:
  398. socket->set_state(TCPSocket::State::Established);
  399. socket->set_setup_state(Socket::SetupState::Completed);
  400. socket->set_connected(true);
  401. return;
  402. default:
  403. dbgln("handle_tcp: got ACK in SynReceived state but direction is invalid ({})", TCPSocket::to_string(socket->direction()));
  404. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  405. socket->set_state(TCPSocket::State::Closed);
  406. return;
  407. }
  408. return;
  409. default:
  410. dbgln("handle_tcp: unexpected flags in SynReceived state");
  411. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  412. socket->set_state(TCPSocket::State::Closed);
  413. return;
  414. }
  415. case TCPSocket::State::CloseWait:
  416. switch (tcp_packet.flags()) {
  417. default:
  418. dbgln("handle_tcp: unexpected flags in CloseWait state");
  419. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  420. socket->set_state(TCPSocket::State::Closed);
  421. return;
  422. }
  423. case TCPSocket::State::LastAck:
  424. switch (tcp_packet.flags()) {
  425. case TCPFlags::ACK:
  426. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  427. socket->set_state(TCPSocket::State::Closed);
  428. return;
  429. default:
  430. dbgln("handle_tcp: unexpected flags in LastAck state");
  431. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  432. socket->set_state(TCPSocket::State::Closed);
  433. return;
  434. }
  435. case TCPSocket::State::FinWait1:
  436. switch (tcp_packet.flags()) {
  437. case TCPFlags::ACK:
  438. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  439. socket->set_state(TCPSocket::State::FinWait2);
  440. return;
  441. case TCPFlags::FIN:
  442. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  443. socket->set_state(TCPSocket::State::Closing);
  444. return;
  445. default:
  446. dbgln("handle_tcp: unexpected flags in FinWait1 state");
  447. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  448. socket->set_state(TCPSocket::State::Closed);
  449. return;
  450. }
  451. case TCPSocket::State::FinWait2:
  452. switch (tcp_packet.flags()) {
  453. case TCPFlags::FIN:
  454. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  455. socket->set_state(TCPSocket::State::TimeWait);
  456. return;
  457. case TCPFlags::ACK | TCPFlags::RST:
  458. socket->set_state(TCPSocket::State::Closed);
  459. return;
  460. default:
  461. dbgln("handle_tcp: unexpected flags in FinWait2 state");
  462. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  463. socket->set_state(TCPSocket::State::Closed);
  464. return;
  465. }
  466. case TCPSocket::State::Closing:
  467. switch (tcp_packet.flags()) {
  468. case TCPFlags::ACK:
  469. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  470. socket->set_state(TCPSocket::State::TimeWait);
  471. return;
  472. default:
  473. dbgln("handle_tcp: unexpected flags in Closing state");
  474. unused_rc = socket->send_tcp_packet(TCPFlags::RST);
  475. socket->set_state(TCPSocket::State::Closed);
  476. return;
  477. }
  478. case TCPSocket::State::Established:
  479. if (tcp_packet.has_rst()) {
  480. socket->set_state(TCPSocket::State::Closed);
  481. return;
  482. }
  483. if (tcp_packet.has_fin()) {
  484. if (payload_size != 0)
  485. socket->did_receive(ipv4_packet.source(), tcp_packet.source_port(), KBuffer::copy(&ipv4_packet, sizeof(IPv4Packet) + ipv4_packet.payload_size()), packet_timestamp);
  486. socket->set_ack_number(tcp_packet.sequence_number() + payload_size + 1);
  487. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  488. socket->set_state(TCPSocket::State::CloseWait);
  489. socket->set_connected(false);
  490. return;
  491. }
  492. socket->set_ack_number(tcp_packet.sequence_number() + payload_size);
  493. dbgln_if(TCP_DEBUG, "Got packet with ack_no={}, seq_no={}, payload_size={}, acking it with new ack_no={}, seq_no={}",
  494. tcp_packet.ack_number(), tcp_packet.sequence_number(), payload_size, socket->ack_number(), socket->sequence_number());
  495. if (payload_size) {
  496. if (socket->did_receive(ipv4_packet.source(), tcp_packet.source_port(), KBuffer::copy(&ipv4_packet, sizeof(IPv4Packet) + ipv4_packet.payload_size()), packet_timestamp))
  497. unused_rc = socket->send_tcp_packet(TCPFlags::ACK);
  498. }
  499. }
  500. }
  501. }