NetworkTask.cpp 26 KB

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