/* * Copyright (c) 2021, the SerenityOS developers. * * SPDX-License-Identifier: BSD-2-Clause */ #include #include #include #include namespace Crypto::ASN1 { ErrorOr 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 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 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 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 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 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 Decoder::decode_octet_string(ReadonlyBytes bytes) { return StringView { bytes.data(), bytes.size() }; } ErrorOr 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> Decoder::decode_object_identifier(ReadonlyBytes data) { Vector 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 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 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 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 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 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 pretty_print(Decoder& decoder, DeprecatedOutputStream& 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(tag.kind), kind_name(tag.kind)); TRY(decoder.enter()); builder.append('\n'); stream.write(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(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()); break; } case Kind::Boolean: { auto value = TRY(decoder.read()); builder.appendff(" {}", value); break; } case Kind::Integer: { auto value = TRY(decoder.read()); builder.append(" 0x"sv); for (auto ch : value) builder.appendff("{:0>2x}", ch); break; } case Kind::BitString: { auto value = TRY(decoder.read()); 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()); builder.append(" 0x"sv); for (auto ch : value) builder.appendff("{:0>2x}", ch); break; } case Kind::Null: { TRY(decoder.read()); break; } case Kind::ObjectIdentifier: { auto value = TRY(decoder.read>()); for (auto& id : value) builder.appendff(" {}", id); break; } case Kind::UTCTime: case Kind::GeneralizedTime: case Kind::IA5String: case Kind::PrintableString: { auto value = TRY(decoder.read()); builder.append(' '); builder.append(value); break; } case Kind::Utf8String: { auto value = TRY(decoder.read()); 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"); } } builder.append('\n'); stream.write(builder.string_view().bytes()); } return {}; } }