NetworkTask.cpp 26 KB

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