Packet.cpp 6.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. * Copyright (c) 2021, Sergey Bugaev <bugaevc@serenityos.org>
  4. *
  5. * SPDX-License-Identifier: BSD-2-Clause
  6. */
  7. #include "Packet.h"
  8. #include "Name.h"
  9. #include "PacketHeader.h"
  10. #include <AK/Debug.h>
  11. #include <AK/MemoryStream.h>
  12. #include <AK/StringBuilder.h>
  13. #include <LibCore/MemoryStream.h>
  14. #include <arpa/inet.h>
  15. namespace DNS {
  16. void Packet::add_question(Question const& question)
  17. {
  18. m_questions.empend(question);
  19. VERIFY(m_questions.size() <= UINT16_MAX);
  20. }
  21. void Packet::add_answer(Answer const& answer)
  22. {
  23. m_answers.empend(answer);
  24. VERIFY(m_answers.size() <= UINT16_MAX);
  25. }
  26. ErrorOr<ByteBuffer> Packet::to_byte_buffer() const
  27. {
  28. PacketHeader header;
  29. header.set_id(m_id);
  30. if (is_query())
  31. header.set_is_query();
  32. else
  33. header.set_is_response();
  34. header.set_authoritative_answer(m_authoritative_answer);
  35. // FIXME: What should this be?
  36. header.set_opcode(0);
  37. header.set_response_code(m_code);
  38. header.set_truncated(false); // hopefully...
  39. header.set_recursion_desired(m_recursion_desired);
  40. // FIXME: what should the be for requests?
  41. header.set_recursion_available(m_recursion_available);
  42. header.set_question_count(m_questions.size());
  43. header.set_answer_count(m_answers.size());
  44. Core::Stream::AllocatingMemoryStream stream;
  45. TRY(stream.write_value(header));
  46. for (auto& question : m_questions) {
  47. TRY(stream.write_value(question.name()));
  48. TRY(stream.write_value(htons((u16)question.record_type())));
  49. TRY(stream.write_value(htons(question.raw_class_code())));
  50. }
  51. for (auto& answer : m_answers) {
  52. TRY(stream.write_value(answer.name()));
  53. TRY(stream.write_value(htons((u16)answer.type())));
  54. TRY(stream.write_value(htons(answer.raw_class_code())));
  55. TRY(stream.write_value(htonl(answer.ttl())));
  56. if (answer.type() == RecordType::PTR) {
  57. Name name { answer.record_data() };
  58. TRY(stream.write_value(htons(name.serialized_size())));
  59. TRY(stream.write_value(name));
  60. } else {
  61. TRY(stream.write_value(htons(answer.record_data().length())));
  62. TRY(stream.write_entire_buffer(answer.record_data().bytes()));
  63. }
  64. }
  65. auto buffer = TRY(ByteBuffer::create_uninitialized(stream.used_buffer_size()));
  66. TRY(stream.read_entire_buffer(buffer));
  67. return buffer;
  68. }
  69. class [[gnu::packed]] DNSRecordWithoutName {
  70. public:
  71. DNSRecordWithoutName() = default;
  72. u16 type() const { return m_type; }
  73. u16 record_class() const { return m_class; }
  74. u32 ttl() const { return m_ttl; }
  75. u16 data_length() const { return m_data_length; }
  76. void* data() { return this + 1; }
  77. void const* data() const { return this + 1; }
  78. private:
  79. NetworkOrdered<u16> m_type;
  80. NetworkOrdered<u16> m_class;
  81. NetworkOrdered<u32> m_ttl;
  82. NetworkOrdered<u16> m_data_length;
  83. };
  84. static_assert(sizeof(DNSRecordWithoutName) == 10);
  85. Optional<Packet> Packet::from_raw_packet(u8 const* raw_data, size_t raw_size)
  86. {
  87. if (raw_size < sizeof(PacketHeader)) {
  88. dbgln("DNS response not large enough ({} out of {}) to be a DNS packet.", raw_size, sizeof(PacketHeader));
  89. return {};
  90. }
  91. auto& header = *(PacketHeader const*)(raw_data);
  92. dbgln_if(LOOKUPSERVER_DEBUG, "Got packet (ID: {})", header.id());
  93. dbgln_if(LOOKUPSERVER_DEBUG, " Question count: {}", header.question_count());
  94. dbgln_if(LOOKUPSERVER_DEBUG, " Answer count: {}", header.answer_count());
  95. dbgln_if(LOOKUPSERVER_DEBUG, " Authority count: {}", header.authority_count());
  96. dbgln_if(LOOKUPSERVER_DEBUG, "Additional count: {}", header.additional_count());
  97. Packet packet;
  98. packet.m_id = header.id();
  99. packet.m_query_or_response = header.is_response();
  100. packet.m_code = header.response_code();
  101. // FIXME: Should we parse further in this case?
  102. if (packet.code() != Code::NOERROR)
  103. return packet;
  104. size_t offset = sizeof(PacketHeader);
  105. for (u16 i = 0; i < header.question_count(); i++) {
  106. auto name = Name::parse(raw_data, offset, raw_size);
  107. struct RawDNSAnswerQuestion {
  108. NetworkOrdered<u16> record_type;
  109. NetworkOrdered<u16> class_code;
  110. };
  111. auto& record_and_class = *(RawDNSAnswerQuestion const*)&raw_data[offset];
  112. u16 class_code = record_and_class.class_code & ~MDNS_WANTS_UNICAST_RESPONSE;
  113. bool mdns_wants_unicast_response = record_and_class.class_code & MDNS_WANTS_UNICAST_RESPONSE;
  114. packet.m_questions.empend(name, (RecordType)(u16)record_and_class.record_type, (RecordClass)class_code, mdns_wants_unicast_response);
  115. offset += 4;
  116. auto& question = packet.m_questions.last();
  117. dbgln_if(LOOKUPSERVER_DEBUG, "Question #{}: name=_{}_, type={}, class={}", i, question.name(), question.record_type(), question.class_code());
  118. }
  119. for (u16 i = 0; i < header.answer_count(); ++i) {
  120. auto name = Name::parse(raw_data, offset, raw_size);
  121. auto& record = *(DNSRecordWithoutName const*)(&raw_data[offset]);
  122. DeprecatedString data;
  123. offset += sizeof(DNSRecordWithoutName);
  124. switch ((RecordType)record.type()) {
  125. case RecordType::PTR: {
  126. size_t dummy_offset = offset;
  127. data = Name::parse(raw_data, dummy_offset, raw_size).as_string();
  128. break;
  129. }
  130. case RecordType::CNAME:
  131. // Fall through
  132. case RecordType::A:
  133. // Fall through
  134. case RecordType::TXT:
  135. // Fall through
  136. case RecordType::AAAA:
  137. // Fall through
  138. case RecordType::SRV:
  139. data = { record.data(), record.data_length() };
  140. break;
  141. default:
  142. // FIXME: Parse some other record types perhaps?
  143. dbgln("data=(unimplemented record type {})", (u16)record.type());
  144. }
  145. dbgln_if(LOOKUPSERVER_DEBUG, "Answer #{}: name=_{}_, type={}, ttl={}, length={}, data=_{}_", i, name, record.type(), record.ttl(), record.data_length(), data);
  146. u16 class_code = record.record_class() & ~MDNS_CACHE_FLUSH;
  147. bool mdns_cache_flush = record.record_class() & MDNS_CACHE_FLUSH;
  148. packet.m_answers.empend(name, (RecordType)record.type(), (RecordClass)class_code, record.ttl(), data, mdns_cache_flush);
  149. offset += record.data_length();
  150. }
  151. return packet;
  152. }
  153. }