NetworkTask.cpp 26 KB

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