mirror of
https://github.com/EFForg/rayhunter.git
synced 2026-04-27 07:59:59 -07:00
245 lines
7.5 KiB
Rust
245 lines
7.5 KiB
Rust
//! Qualcomm Mobile Diagnostic Log (QMDL) files have a very simple format: just
|
|
//! a series of of concatenated HDLC encapsulated diag::Message structs.
|
|
//! QmdlReader and QmdlWriter can read and write MessagesContainers to and from
|
|
//! QMDL files.
|
|
|
|
use crate::diag::{DataType, HdlcEncapsulatedMessage, MessagesContainer, MESSAGE_TERMINATOR};
|
|
|
|
use futures::TryStream;
|
|
use log::error;
|
|
use tokio::io::{AsyncBufReadExt, AsyncRead, AsyncWrite, AsyncWriteExt, BufReader};
|
|
|
|
pub struct QmdlWriter<T>
|
|
where
|
|
T: AsyncWrite + Unpin,
|
|
{
|
|
writer: T,
|
|
pub total_written: usize,
|
|
}
|
|
|
|
impl<T> QmdlWriter<T>
|
|
where
|
|
T: AsyncWrite + Unpin,
|
|
{
|
|
pub fn new(writer: T) -> Self {
|
|
QmdlWriter::new_with_existing_size(writer, 0)
|
|
}
|
|
|
|
pub fn new_with_existing_size(writer: T, existing_size: usize) -> Self {
|
|
QmdlWriter {
|
|
writer,
|
|
total_written: existing_size,
|
|
}
|
|
}
|
|
|
|
pub async fn write_container(&mut self, container: &MessagesContainer) -> std::io::Result<()> {
|
|
for msg in &container.messages {
|
|
self.writer.write_all(&msg.data).await?;
|
|
self.total_written += msg.data.len();
|
|
}
|
|
Ok(())
|
|
}
|
|
}
|
|
|
|
pub struct QmdlReader<T>
|
|
where
|
|
T: AsyncRead,
|
|
{
|
|
reader: BufReader<T>,
|
|
bytes_read: usize,
|
|
max_bytes: Option<usize>,
|
|
}
|
|
|
|
impl<T> QmdlReader<T>
|
|
where
|
|
T: AsyncRead + Unpin,
|
|
{
|
|
pub fn new(reader: T, max_bytes: Option<usize>) -> Self {
|
|
QmdlReader {
|
|
reader: BufReader::new(reader),
|
|
bytes_read: 0,
|
|
max_bytes,
|
|
}
|
|
}
|
|
|
|
pub fn as_stream(
|
|
&mut self,
|
|
) -> impl TryStream<Ok = MessagesContainer, Error = std::io::Error> + '_ {
|
|
futures::stream::try_unfold(self, |reader| async {
|
|
let maybe_container = reader.get_next_messages_container().await?;
|
|
match maybe_container {
|
|
Some(container) => Ok(Some((container, reader))),
|
|
None => Ok(None),
|
|
}
|
|
})
|
|
}
|
|
|
|
pub async fn get_next_messages_container(
|
|
&mut self,
|
|
) -> Result<Option<MessagesContainer>, std::io::Error> {
|
|
if let Some(max_bytes) = self.max_bytes {
|
|
if self.bytes_read >= max_bytes {
|
|
if self.bytes_read > max_bytes {
|
|
error!(
|
|
"warning: {} bytes read, but max_bytes was {}",
|
|
self.bytes_read, max_bytes
|
|
);
|
|
}
|
|
return Ok(None);
|
|
}
|
|
}
|
|
|
|
let mut buf = Vec::new();
|
|
let bytes_read = self.reader.read_until(MESSAGE_TERMINATOR, &mut buf).await?;
|
|
self.bytes_read += bytes_read;
|
|
|
|
// Since QMDL is just a flat list of messages, we can't actually
|
|
// reproduce the container structure they came from in the original
|
|
// read. So we'll just pretend that all containers had exactly one
|
|
// message. As far as I know, the number of messages per container
|
|
// doesn't actually affect anything, so this should be fine.
|
|
Ok(Some(MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: 1,
|
|
messages: vec![HdlcEncapsulatedMessage {
|
|
len: bytes_read as u32,
|
|
data: buf,
|
|
}],
|
|
}))
|
|
}
|
|
}
|
|
|
|
#[cfg(test)]
|
|
mod test {
|
|
use std::io::Cursor;
|
|
|
|
use crate::diag::CRC_CCITT;
|
|
use crate::hdlc::hdlc_encapsulate;
|
|
|
|
use super::*;
|
|
|
|
fn get_test_messages() -> Vec<HdlcEncapsulatedMessage> {
|
|
let messages: Vec<HdlcEncapsulatedMessage> = (10..20)
|
|
.map(|i| {
|
|
let data = hdlc_encapsulate(&vec![i as u8; i], &CRC_CCITT);
|
|
HdlcEncapsulatedMessage {
|
|
len: data.len() as u32,
|
|
data,
|
|
}
|
|
})
|
|
.collect();
|
|
messages
|
|
}
|
|
|
|
// returns a byte array consisting of concatenated HDLC encapsulated
|
|
// test messages
|
|
fn get_test_message_bytes() -> Vec<u8> {
|
|
get_test_messages()
|
|
.iter()
|
|
.flat_map(|msg| msg.data.clone())
|
|
.collect()
|
|
}
|
|
|
|
fn get_test_containers() -> Vec<MessagesContainer> {
|
|
let messages = get_test_messages();
|
|
let (messages1, messages2) = messages.split_at(5);
|
|
vec![
|
|
MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: messages1.len() as u32,
|
|
messages: messages1.to_vec(),
|
|
},
|
|
MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: messages2.len() as u32,
|
|
messages: messages2.to_vec(),
|
|
},
|
|
]
|
|
}
|
|
|
|
#[tokio::test]
|
|
async fn test_unbounded_qmdl_reader() {
|
|
let mut buf = Cursor::new(get_test_message_bytes());
|
|
let mut reader = QmdlReader::new(&mut buf, None);
|
|
let expected_messages = get_test_messages();
|
|
for message in expected_messages {
|
|
let expected_container = MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: 1,
|
|
messages: vec![message],
|
|
};
|
|
assert_eq!(
|
|
expected_container,
|
|
reader.get_next_messages_container().await.unwrap().unwrap()
|
|
);
|
|
}
|
|
}
|
|
|
|
#[tokio::test]
|
|
async fn test_bounded_qmdl_reader() {
|
|
let mut buf = Cursor::new(get_test_message_bytes());
|
|
|
|
// bound the reader to the first two messages
|
|
let mut expected_messages = get_test_messages();
|
|
let limit = expected_messages[0].len + expected_messages[1].len;
|
|
|
|
let mut reader = QmdlReader::new(&mut buf, Some(limit as usize));
|
|
for message in expected_messages.drain(0..2) {
|
|
let expected_container = MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: 1,
|
|
messages: vec![message],
|
|
};
|
|
assert_eq!(
|
|
expected_container,
|
|
reader.get_next_messages_container().await.unwrap().unwrap()
|
|
);
|
|
}
|
|
assert!(matches!(
|
|
reader.get_next_messages_container().await,
|
|
Ok(None)
|
|
));
|
|
}
|
|
|
|
#[tokio::test]
|
|
async fn test_qmdl_writer() {
|
|
let mut buf = Vec::new();
|
|
let mut writer = QmdlWriter::new(&mut buf);
|
|
let expected_containers = get_test_containers();
|
|
for container in &expected_containers {
|
|
writer.write_container(container).await.unwrap();
|
|
}
|
|
assert_eq!(writer.total_written, buf.len());
|
|
assert_eq!(buf, get_test_message_bytes());
|
|
}
|
|
|
|
#[tokio::test]
|
|
async fn test_writing_and_reading() {
|
|
let mut buf = Vec::new();
|
|
let mut writer = QmdlWriter::new(&mut buf);
|
|
let expected_containers = get_test_containers();
|
|
for container in &expected_containers {
|
|
writer.write_container(container).await.unwrap();
|
|
}
|
|
|
|
let limit = Some(buf.len());
|
|
let mut reader = QmdlReader::new(Cursor::new(&mut buf), limit);
|
|
let expected_messages = get_test_messages();
|
|
for message in expected_messages {
|
|
let expected_container = MessagesContainer {
|
|
data_type: DataType::UserSpace,
|
|
num_messages: 1,
|
|
messages: vec![message],
|
|
};
|
|
assert_eq!(
|
|
expected_container,
|
|
reader.get_next_messages_container().await.unwrap().unwrap()
|
|
);
|
|
}
|
|
assert!(matches!(
|
|
reader.get_next_messages_container().await,
|
|
Ok(None)
|
|
));
|
|
}
|
|
}
|