123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338 |
- /*
- * Copyright (c) 2021, the SerenityOS developers.
- *
- * SPDX-License-Identifier: BSD-2-Clause
- */
- #include <AK/Stream.h>
- #include <AK/Try.h>
- #include <AK/Utf8View.h>
- #include <LibCrypto/ASN1/DER.h>
- namespace Crypto::ASN1 {
- ErrorOr<Tag> Decoder::read_tag()
- {
- auto byte = TRY(read_byte());
- u8 class_ = byte & 0xc0;
- u8 type = byte & 0x20;
- u8 kind = byte & 0x1f;
- if (kind == 0x1f) {
- kind = 0;
- while (byte & 0x80) {
- byte = TRY(read_byte());
- kind = (kind << 7) | (byte & 0x7f);
- }
- }
- return Tag { (Kind)kind, (Class)class_, (Type)type };
- }
- ErrorOr<size_t> Decoder::read_length()
- {
- auto byte = TRY(read_byte());
- size_t length = byte;
- if (byte & 0x80) {
- auto count = byte & 0x7f;
- if (count == 0x7f)
- return Error::from_string_literal("ASN1::Decoder: Length has an invalid count value");
- auto data = TRY(read_bytes(count));
- length = 0;
- if (data.size() > sizeof(size_t))
- return Error::from_string_literal("ASN1::Decoder: Length is larger than the target type");
- for (auto&& byte : data)
- length = (length << 8) | (size_t)byte;
- }
- return length;
- }
- ErrorOr<u8> Decoder::read_byte()
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Reading byte from an empty stack");
- auto& entry = m_stack.last();
- if (entry.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Reading byte from an empty entry");
- auto byte = entry[0];
- entry = entry.slice(1);
- return byte;
- }
- ErrorOr<ReadonlyBytes> Decoder::peek_entry_bytes()
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty stack");
- auto entry = m_stack.last();
- return entry;
- }
- ErrorOr<ReadonlyBytes> Decoder::read_bytes(size_t length)
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty stack");
- auto& entry = m_stack.last();
- if (entry.size() < length)
- return Error::from_string_literal("ASN1::Decoder: Reading bytes from an empty entry");
- auto bytes = entry.slice(0, length);
- entry = entry.slice(length);
- return bytes;
- }
- ErrorOr<bool> Decoder::decode_boolean(ReadonlyBytes data)
- {
- if (data.size() != 1)
- return Error::from_string_literal("ASN1::Decoder: Decoding boolean from a non boolean-sized span");
- return data[0] != 0;
- }
- ErrorOr<UnsignedBigInteger> Decoder::decode_arbitrary_sized_integer(ReadonlyBytes data)
- {
- if (data.size() < 1)
- return Error::from_string_literal("ASN1::Decoder: Decoding arbitrary sized integer from an empty span");
- if (data.size() > 1
- && ((data[0] == 0xff && data[1] & 0x80)
- || (data[0] == 0x00 && !(data[1] & 0x80)))) {
- return Error::from_string_literal("ASN1::Decoder: Arbitrary sized integer has an invalid format");
- }
- bool is_negative = data[0] & 0x80;
- if (is_negative)
- return Error::from_string_literal("ASN1::Decoder: Decoding a negative unsigned arbitrary sized integer");
- return UnsignedBigInteger::import_data(data.data(), data.size());
- }
- ErrorOr<StringView> Decoder::decode_octet_string(ReadonlyBytes bytes)
- {
- return StringView { bytes.data(), bytes.size() };
- }
- ErrorOr<nullptr_t> Decoder::decode_null(ReadonlyBytes data)
- {
- if (data.size() != 0)
- return Error::from_string_literal("ASN1::Decoder: Decoding null from a non-empty span");
- return nullptr;
- }
- ErrorOr<Vector<int>> Decoder::decode_object_identifier(ReadonlyBytes data)
- {
- Vector<int> result;
- result.append(0); // Reserved space.
- u32 value = 0;
- for (auto&& byte : data) {
- if (value == 0 && byte == 0x80)
- return Error::from_string_literal("ASN1::Decoder: Invalid first byte in object identifier");
- value = (value << 7) | (byte & 0x7f);
- if (!(byte & 0x80)) {
- result.append(value);
- value = 0;
- }
- }
- if (result.size() == 1 || result[1] >= 1600)
- return Error::from_string_literal("ASN1::Decoder: Invalid encoding in object identifier");
- result[0] = result[1] / 40;
- result[1] = result[1] % 40;
- return result;
- }
- ErrorOr<StringView> Decoder::decode_printable_string(ReadonlyBytes data)
- {
- Utf8View view { data };
- if (!view.validate())
- return Error::from_string_literal("ASN1::Decoder: Invalid UTF-8 in printable string");
- return StringView { data };
- }
- ErrorOr<BitStringView> Decoder::decode_bit_string(ReadonlyBytes data)
- {
- if (data.size() < 1)
- return Error::from_string_literal("ASN1::Decoder: Decoding bit string from empty span");
- auto unused_bits = data[0];
- auto total_size_in_bits = (data.size() - 1) * 8;
- if (unused_bits > total_size_in_bits)
- return Error::from_string_literal("ASN1::Decoder: Number of unused bits is larger than the total size");
- return BitStringView { data.slice(1), unused_bits };
- }
- ErrorOr<Tag> Decoder::peek()
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Peeking using an empty stack");
- if (eof())
- return Error::from_string_literal("ASN1::Decoder: Peeking using a decoder that is at EOF");
- if (m_current_tag.has_value())
- return m_current_tag.value();
- m_current_tag = TRY(read_tag());
- return m_current_tag.value();
- }
- bool Decoder::eof() const
- {
- return m_stack.is_empty() || m_stack.last().is_empty();
- }
- ErrorOr<void> Decoder::enter()
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Entering using an empty stack");
- auto tag = TRY(peek());
- if (tag.type != Type::Constructed)
- return Error::from_string_literal("ASN1::Decoder: Entering a non-constructed type");
- auto length = TRY(read_length());
- auto data = TRY(read_bytes(length));
- m_current_tag.clear();
- m_stack.append(data);
- return {};
- }
- ErrorOr<void> Decoder::leave()
- {
- if (m_stack.is_empty())
- return Error::from_string_literal("ASN1::Decoder: Leaving using an empty stack");
- if (m_stack.size() == 1)
- return Error::from_string_literal("ASN1::Decoder: Leaving the main context");
- m_stack.take_last();
- m_current_tag.clear();
- return {};
- }
- ErrorOr<void> pretty_print(Decoder& decoder, Stream& stream, int indent)
- {
- while (!decoder.eof()) {
- auto tag = TRY(decoder.peek());
- StringBuilder builder;
- for (int i = 0; i < indent; ++i)
- builder.append(' ');
- builder.appendff("<{}> ", class_name(tag.class_));
- if (tag.type == Type::Constructed) {
- builder.appendff("[{}] {} ({})", type_name(tag.type), static_cast<u8>(tag.kind), kind_name(tag.kind));
- TRY(decoder.enter());
- builder.append('\n');
- TRY(stream.write_until_depleted(builder.string_view().bytes()));
- TRY(pretty_print(decoder, stream, indent + 2));
- TRY(decoder.leave());
- continue;
- } else {
- if (tag.class_ != Class::Universal)
- builder.appendff("[{}] {} {}", type_name(tag.type), static_cast<u8>(tag.kind), kind_name(tag.kind));
- else
- builder.appendff("[{}] {}", type_name(tag.type), kind_name(tag.kind));
- switch (tag.kind) {
- case Kind::Eol: {
- TRY(decoder.read<ReadonlyBytes>());
- break;
- }
- case Kind::Boolean: {
- auto value = TRY(decoder.read<bool>());
- builder.appendff(" {}", value);
- break;
- }
- case Kind::Integer: {
- auto value = TRY(decoder.read<ReadonlyBytes>());
- builder.append(" 0x"sv);
- for (auto ch : value)
- builder.appendff("{:0>2x}", ch);
- break;
- }
- case Kind::BitString: {
- auto value = TRY(decoder.read<BitmapView>());
- builder.append(" 0b"sv);
- for (size_t i = 0; i < value.size(); ++i)
- builder.append(value.get(i) ? '1' : '0');
- break;
- }
- case Kind::OctetString: {
- auto value = TRY(decoder.read<StringView>());
- builder.append(" 0x"sv);
- for (auto ch : value)
- builder.appendff("{:0>2x}", ch);
- break;
- }
- case Kind::Null: {
- TRY(decoder.read<decltype(nullptr)>());
- break;
- }
- case Kind::ObjectIdentifier: {
- auto value = TRY(decoder.read<Vector<int>>());
- for (auto& id : value)
- builder.appendff(" {}", id);
- break;
- }
- case Kind::UTCTime:
- case Kind::GeneralizedTime:
- case Kind::IA5String:
- case Kind::VisibleString:
- case Kind::BMPString:
- case Kind::PrintableString: {
- auto value = TRY(decoder.read<StringView>());
- builder.append(' ');
- builder.append(value);
- break;
- }
- case Kind::Utf8String: {
- auto value = TRY(decoder.read<Utf8View>());
- builder.append(' ');
- for (auto cp : value)
- builder.append_code_point(cp);
- break;
- }
- case Kind::Sequence:
- case Kind::Set:
- return Error::from_string_literal("ASN1::Decoder: Unexpected Primitive");
- default: {
- dbgln("PrettyPrint error: Unhandled kind {}", static_cast<u8>(tag.kind));
- }
- }
- }
- builder.append('\n');
- TRY(stream.write_until_depleted(builder.string_view().bytes()));
- }
- return {};
- }
- }
|