use crate::error::{Error, Result};
pub(crate) fn tlv_split(bytes: &[u8]) -> Result<(&[u8], &[u8])> {
if bytes.is_empty() {
return Err(Error::AsRepParse("TLV: empty input".into()));
}
let mut idx = 1;
if bytes[0] & 0x1F == 0x1F {
while idx < bytes.len() && bytes[idx] & 0x80 != 0 {
idx += 1;
}
if idx >= bytes.len() {
return Err(Error::AsRepParse("TLV: truncated tag".into()));
}
idx += 1;
}
if idx >= bytes.len() {
return Err(Error::AsRepParse("TLV: no length byte".into()));
}
let (len, len_consumed) = read_der_length(&bytes[idx..])?;
let value_start = idx + len_consumed;
let value_end = value_start
.checked_add(len)
.ok_or_else(|| Error::AsRepParse("TLV: length overflow".into()))?;
if value_end > bytes.len() {
return Err(Error::AsRepParse(format!(
"TLV: value truncated (need {value_end}, have {})",
bytes.len()
)));
}
Ok((&bytes[value_start..value_end], &bytes[value_end..]))
}
pub(crate) fn tlv_expect_tag(bytes: &[u8], expected_tag: u8) -> Result<(&[u8], &[u8])> {
let first = bytes
.first()
.copied()
.ok_or_else(|| Error::AsRepParse("TLV: empty".into()))?;
if first != expected_tag {
return Err(Error::AsRepParse(format!(
"TLV: expected tag 0x{expected_tag:02X}, got 0x{first:02X}"
)));
}
tlv_split(bytes)
}
pub(crate) fn read_der_length(bytes: &[u8]) -> Result<(usize, usize)> {
let first = *bytes
.first()
.ok_or_else(|| Error::AsRepParse("length: empty".into()))?;
if first & 0x80 == 0 {
return Ok((first as usize, 1));
}
let n = (first & 0x7F) as usize;
if n == 0 || n > 4 {
return Err(Error::AsRepParse(format!("length: bad long-form n={n}")));
}
if bytes.len() < 1 + n {
return Err(Error::AsRepParse("length: truncated long-form".into()));
}
let mut v: usize = 0;
for &b in &bytes[1..1 + n] {
v = (v << 8) | b as usize;
}
Ok((v, 1 + n))
}
pub(crate) fn extract_signed_data_econtent(content_info: &[u8]) -> Result<Vec<u8>> {
let (seq_body, _) = tlv_expect_tag(content_info, 0x30)?;
let (_oid, after_oid) = tlv_split(seq_body)?;
let (ctx0_body, _) = tlv_expect_tag(after_oid, 0xA0)?;
let (sd_body, _) = tlv_expect_tag(ctx0_body, 0x30)?;
let (_ver, after_ver) = tlv_split(sd_body)?;
let (_da, after_da) = tlv_split(after_ver)?;
let (encap_body, _) = tlv_expect_tag(after_da, 0x30)?;
let (_ecid, after_ecid) = tlv_split(encap_body)?;
let (ctx0_econtent, _) = tlv_expect_tag(after_ecid, 0xA0)?;
let (econtent_body, _) = tlv_expect_tag(ctx0_econtent, 0x04)?;
Ok(econtent_body.to_vec())
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn tlv_split_short_form() {
let seq = [0x30u8, 0x05, 0x04, 0x03, b'a', b'b', b'c'];
let (body, rest) = tlv_split(&seq).unwrap();
assert_eq!(body, &[0x04, 0x03, b'a', b'b', b'c']);
assert!(rest.is_empty());
}
#[test]
fn tlv_split_long_form_length() {
let mut blob = vec![0x04, 0x81, 0x80];
blob.extend(std::iter::repeat(0x41).take(128));
let (body, rest) = tlv_split(&blob).unwrap();
assert_eq!(body.len(), 128);
assert!(rest.is_empty());
}
#[test]
fn tlv_expect_tag_rejects_mismatch() {
let seq = [0x30u8, 0x00];
let err = tlv_expect_tag(&seq, 0x04).unwrap_err();
assert!(matches!(err, Error::AsRepParse(_)));
}
}