DER.cpp 9.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338
  1. /*
  2. * Copyright (c) 2021, the SerenityOS developers.
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <AK/Stream.h>
  7. #include <AK/Try.h>
  8. #include <AK/Utf8View.h>
  9. #include <LibCrypto/ASN1/DER.h>
  10. namespace Crypto::ASN1 {
  11. ErrorOr<Tag> Decoder::read_tag()
  12. {
  13. auto byte = TRY(read_byte());
  14. u8 class_ = byte & 0xc0;
  15. u8 type = byte & 0x20;
  16. u8 kind = byte & 0x1f;
  17. if (kind == 0x1f) {
  18. kind = 0;
  19. while (byte & 0x80) {
  20. byte = TRY(read_byte());
  21. kind = (kind << 7) | (byte & 0x7f);
  22. }
  23. }
  24. return Tag { (Kind)kind, (Class)class_, (Type)type };
  25. }
  26. ErrorOr<size_t> Decoder::read_length()
  27. {
  28. auto byte = TRY(read_byte());
  29. size_t length = byte;
  30. if (byte & 0x80) {
  31. auto count = byte & 0x7f;
  32. if (count == 0x7f)
  33. return Error::from_string_literal("ASN1::Decoder: Length has an invalid count value");
  34. auto data = TRY(read_bytes(count));
  35. length = 0;
  36. if (data.size() > sizeof(size_t))
  37. return Error::from_string_literal("ASN1::Decoder: Length is larger than the target type");
  38. for (auto&& byte : data)
  39. length = (length << 8) | (size_t)byte;
  40. }
  41. return length;
  42. }
  43. ErrorOr<u8> Decoder::read_byte()
  44. {
  45. if (m_stack.is_empty())
  46. return Error::from_string_literal("ASN1::Decoder: Reading byte from an empty stack");
  47. auto& entry = m_stack.last();
  48. if (entry.is_empty())
  49. return Error::from_string_literal("ASN1::Decoder: Reading byte from an empty entry");
  50. auto byte = entry[0];
  51. entry = entry.slice(1);
  52. return byte;
  53. }
  54. ErrorOr<ReadonlyBytes> Decoder::peek_entry_bytes()
  55. {
  56. if (m_stack.is_empty())
  57. return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty stack");
  58. auto entry = m_stack.last();
  59. return entry;
  60. }
  61. ErrorOr<ReadonlyBytes> Decoder::read_bytes(size_t length)
  62. {
  63. if (m_stack.is_empty())
  64. return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty stack");
  65. auto& entry = m_stack.last();
  66. if (entry.size() < length)
  67. return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty entry");
  68. auto bytes = entry.slice(0, length);
  69. entry = entry.slice(length);
  70. return bytes;
  71. }
  72. ErrorOr<bool> Decoder::decode_boolean(ReadonlyBytes data)
  73. {
  74. if (data.size() != 1)
  75. return Error::from_string_literal("ASN1::Decoder: Decoding boolean from a non boolean-sized span");
  76. return data[0] != 0;
  77. }
  78. ErrorOr<UnsignedBigInteger> Decoder::decode_arbitrary_sized_integer(ReadonlyBytes data)
  79. {
  80. if (data.size() < 1)
  81. return Error::from_string_literal("ASN1::Decoder: Decoding arbitrary sized integer from an empty span");
  82. if (data.size() > 1
  83. && ((data[0] == 0xff && data[1] & 0x80)
  84. || (data[0] == 0x00 && !(data[1] & 0x80)))) {
  85. return Error::from_string_literal("ASN1::Decoder: Arbitrary sized integer has an invalid format");
  86. }
  87. bool is_negative = data[0] & 0x80;
  88. if (is_negative)
  89. return Error::from_string_literal("ASN1::Decoder: Decoding a negative unsigned arbitrary sized integer");
  90. return UnsignedBigInteger::import_data(data.data(), data.size());
  91. }
  92. ErrorOr<StringView> Decoder::decode_octet_string(ReadonlyBytes bytes)
  93. {
  94. return StringView { bytes.data(), bytes.size() };
  95. }
  96. ErrorOr<nullptr_t> Decoder::decode_null(ReadonlyBytes data)
  97. {
  98. if (data.size() != 0)
  99. return Error::from_string_literal("ASN1::Decoder: Decoding null from a non-empty span");
  100. return nullptr;
  101. }
  102. ErrorOr<Vector<int>> Decoder::decode_object_identifier(ReadonlyBytes data)
  103. {
  104. Vector<int> result;
  105. result.append(0); // Reserved space.
  106. u32 value = 0;
  107. for (auto&& byte : data) {
  108. if (value == 0 && byte == 0x80)
  109. return Error::from_string_literal("ASN1::Decoder: Invalid first byte in object identifier");
  110. value = (value << 7) | (byte & 0x7f);
  111. if (!(byte & 0x80)) {
  112. result.append(value);
  113. value = 0;
  114. }
  115. }
  116. if (result.size() == 1 || result[1] >= 1600)
  117. return Error::from_string_literal("ASN1::Decoder: Invalid encoding in object identifier");
  118. result[0] = result[1] / 40;
  119. result[1] = result[1] % 40;
  120. return result;
  121. }
  122. ErrorOr<StringView> Decoder::decode_printable_string(ReadonlyBytes data)
  123. {
  124. Utf8View view { data };
  125. if (!view.validate())
  126. return Error::from_string_literal("ASN1::Decoder: Invalid UTF-8 in printable string");
  127. return StringView { data };
  128. }
  129. ErrorOr<BitStringView> Decoder::decode_bit_string(ReadonlyBytes data)
  130. {
  131. if (data.size() < 1)
  132. return Error::from_string_literal("ASN1::Decoder: Decoding bit string from empty span");
  133. auto unused_bits = data[0];
  134. auto total_size_in_bits = (data.size() - 1) * 8;
  135. if (unused_bits > total_size_in_bits)
  136. return Error::from_string_literal("ASN1::Decoder: Number of unused bits is larger than the total size");
  137. return BitStringView { data.slice(1), unused_bits };
  138. }
  139. ErrorOr<Tag> Decoder::peek()
  140. {
  141. if (m_stack.is_empty())
  142. return Error::from_string_literal("ASN1::Decoder: Peeking using an empty stack");
  143. if (eof())
  144. return Error::from_string_literal("ASN1::Decoder: Peeking using a decoder that is at EOF");
  145. if (m_current_tag.has_value())
  146. return m_current_tag.value();
  147. m_current_tag = TRY(read_tag());
  148. return m_current_tag.value();
  149. }
  150. bool Decoder::eof() const
  151. {
  152. return m_stack.is_empty() || m_stack.last().is_empty();
  153. }
  154. ErrorOr<void> Decoder::enter()
  155. {
  156. if (m_stack.is_empty())
  157. return Error::from_string_literal("ASN1::Decoder: Entering using an empty stack");
  158. auto tag = TRY(peek());
  159. if (tag.type != Type::Constructed)
  160. return Error::from_string_literal("ASN1::Decoder: Entering a non-constructed type");
  161. auto length = TRY(read_length());
  162. auto data = TRY(read_bytes(length));
  163. m_current_tag.clear();
  164. m_stack.append(data);
  165. return {};
  166. }
  167. ErrorOr<void> Decoder::leave()
  168. {
  169. if (m_stack.is_empty())
  170. return Error::from_string_literal("ASN1::Decoder: Leaving using an empty stack");
  171. if (m_stack.size() == 1)
  172. return Error::from_string_literal("ASN1::Decoder: Leaving the main context");
  173. m_stack.take_last();
  174. m_current_tag.clear();
  175. return {};
  176. }
  177. ErrorOr<void> pretty_print(Decoder& decoder, Stream& stream, int indent)
  178. {
  179. while (!decoder.eof()) {
  180. auto tag = TRY(decoder.peek());
  181. StringBuilder builder;
  182. for (int i = 0; i < indent; ++i)
  183. builder.append(' ');
  184. builder.appendff("<{}> ", class_name(tag.class_));
  185. if (tag.type == Type::Constructed) {
  186. builder.appendff("[{}] {} ({})", type_name(tag.type), static_cast<u8>(tag.kind), kind_name(tag.kind));
  187. TRY(decoder.enter());
  188. builder.append('\n');
  189. TRY(stream.write_until_depleted(builder.string_view().bytes()));
  190. TRY(pretty_print(decoder, stream, indent + 2));
  191. TRY(decoder.leave());
  192. continue;
  193. } else {
  194. if (tag.class_ != Class::Universal)
  195. builder.appendff("[{}] {} {}", type_name(tag.type), static_cast<u8>(tag.kind), kind_name(tag.kind));
  196. else
  197. builder.appendff("[{}] {}", type_name(tag.type), kind_name(tag.kind));
  198. switch (tag.kind) {
  199. case Kind::Eol: {
  200. TRY(decoder.read<ReadonlyBytes>());
  201. break;
  202. }
  203. case Kind::Boolean: {
  204. auto value = TRY(decoder.read<bool>());
  205. builder.appendff(" {}", value);
  206. break;
  207. }
  208. case Kind::Integer: {
  209. auto value = TRY(decoder.read<ReadonlyBytes>());
  210. builder.append(" 0x"sv);
  211. for (auto ch : value)
  212. builder.appendff("{:0>2x}", ch);
  213. break;
  214. }
  215. case Kind::BitString: {
  216. auto value = TRY(decoder.read<BitmapView>());
  217. builder.append(" 0b"sv);
  218. for (size_t i = 0; i < value.size(); ++i)
  219. builder.append(value.get(i) ? '1' : '0');
  220. break;
  221. }
  222. case Kind::OctetString: {
  223. auto value = TRY(decoder.read<StringView>());
  224. builder.append(" 0x"sv);
  225. for (auto ch : value)
  226. builder.appendff("{:0>2x}", ch);
  227. break;
  228. }
  229. case Kind::Null: {
  230. TRY(decoder.read<decltype(nullptr)>());
  231. break;
  232. }
  233. case Kind::ObjectIdentifier: {
  234. auto value = TRY(decoder.read<Vector<int>>());
  235. for (auto& id : value)
  236. builder.appendff(" {}", id);
  237. break;
  238. }
  239. case Kind::UTCTime:
  240. case Kind::GeneralizedTime:
  241. case Kind::IA5String:
  242. case Kind::VisibleString:
  243. case Kind::BMPString:
  244. case Kind::PrintableString: {
  245. auto value = TRY(decoder.read<StringView>());
  246. builder.append(' ');
  247. builder.append(value);
  248. break;
  249. }
  250. case Kind::Utf8String: {
  251. auto value = TRY(decoder.read<Utf8View>());
  252. builder.append(' ');
  253. for (auto cp : value)
  254. builder.append_code_point(cp);
  255. break;
  256. }
  257. case Kind::Sequence:
  258. case Kind::Set:
  259. return Error::from_string_literal("ASN1::Decoder: Unexpected Primitive");
  260. default: {
  261. dbgln("PrettyPrint error: Unhandled kind {}", static_cast<u8>(tag.kind));
  262. }
  263. }
  264. }
  265. builder.append('\n');
  266. TRY(stream.write_until_depleted(builder.string_view().bytes()));
  267. }
  268. return {};
  269. }
  270. }