mpegtslivesrc: Refactor section parser

Part-of: <https://gitlab.freedesktop.org/gstreamer/gst-plugins-rs/-/merge_requests/1977>
This commit is contained in:
Sebastian Dröge 2024-12-06 14:34:02 +02:00 committed by GStreamer Marge Bot
parent a2279bc253
commit 44978159a3
5 changed files with 577 additions and 399 deletions

1
Cargo.lock generated
View file

@ -2824,6 +2824,7 @@ dependencies = [
"bitstream-io",
"gst-plugin-version-helper",
"gstreamer",
"smallvec",
]
[[package]]

View file

@ -12,6 +12,7 @@ rust-version.workspace = true
gst.workspace = true
bitstream-io = "2.3"
anyhow = "1"
smallvec = "1"
[dev-dependencies]

View file

@ -21,18 +21,20 @@
*
* Since: plugins-rs-0.13.0
*/
use anyhow::Context;
use anyhow::{bail, Result};
use bitstream_io::{BigEndian, BitRead, BitReader, FromBitStream};
use gst::glib;
use gst::prelude::*;
use gst::subclass::prelude::*;
use std::mem;
use std::ops::Add;
use std::ops::ControlFlow;
use std::sync::Mutex;
use anyhow::{bail, Context, Result};
use std::sync::LazyLock;
use bitstream_io::{BigEndian, BitRead, BitReader};
use gst::{glib, prelude::*, subclass::prelude::*};
use std::{
mem,
ops::{Add, ControlFlow},
sync::LazyLock,
sync::Mutex,
};
use super::parser::*;
static CAT: LazyLock<gst::DebugCategory> = LazyLock::new(|| {
gst::DebugCategory::new(
@ -174,206 +176,15 @@ struct State {
// If the next outgoing packet should have the discont flag set
discont_pending: bool,
// Continuity counter for PAT PID
pat_cc: Option<u8>,
// Pending PAT payload data from last PAT packet
pat_pending: Vec<u8>,
// Pending data starts on pointer field, otherwise on table header
pat_pending_pusi: bool,
// PID used for the PMT of the selected program
pmt_pid: Option<u16>,
// Program number of the selected program
pmt_program_num: Option<u16>,
// Continuity counter for PMT PID
pmt_cc: Option<u8>,
// Pending PMT payload data from last PMT packet
pmt_pending: Vec<u8>,
// Pending data starts on pointer fiel, otherwise on table header
pmt_pending_pusi: bool,
// PID used for the PCR of the selected program
pcr_pid: Option<u16>,
}
// Section parser for PAT
pat_parser: SectionParser,
// Current PAT, first program is the selected one
pat: Option<ProgramAccessTable>,
#[derive(Debug)]
#[allow(unused)]
struct PacketHeader {
tei: bool,
pusi: bool,
tp: bool,
pid: u16,
tsc: u8,
afc: u8,
cc: u8,
}
impl FromBitStream for PacketHeader {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
if r.read_to::<u8>().context("sync_byte")? != 0x47 {
bail!("Lost sync");
}
let tei = r.read_bit().context("tei")?;
let pusi = r.read_bit().context("pusi")?;
let tp = r.read_bit().context("tp")?;
let pid = r.read::<u16>(13).context("pid")?;
let tsc = r.read::<u8>(2).context("tsc")?;
let afc = r.read::<u8>(2).context("afc")?;
let cc = r.read::<u8>(4).context("cc")?;
Ok(PacketHeader {
tei,
pusi,
tp,
pid,
tsc,
afc,
cc,
})
}
}
#[derive(Debug)]
struct AdaptionField {
pcr: Option<u64>,
// Add other fields as needed
}
impl FromBitStream for AdaptionField {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
r.skip(3).context("flags")?;
let pcr_present = r.read_bit().context("pcr_present")?;
r.skip(4).context("flags")?;
// PCR present
let pcr = if pcr_present {
let pcr = r.read::<u64>(33).context("pcr_base")? * 300;
r.skip(6).context("pcr_reserved")?;
let pcr = pcr + r.read::<u64>(9).context("pcr_extension")? % 300;
Some(pcr)
} else {
None
};
// Skip all other parts of the adaptation field for now
Ok(AdaptionField { pcr })
}
}
#[derive(Debug)]
struct TableHeader {
table_id: u8,
section_syntax_indicator: bool,
section_length: u16,
}
impl FromBitStream for TableHeader {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let table_id = r.read_to::<u8>().context("table_id")?;
let section_syntax_indicator = r.read_bit().context("table_syntax_indicator")?;
r.skip(5).context("reserved")?;
let section_length = r.read::<u16>(10).context("section_length")?;
Ok(TableHeader {
table_id,
section_syntax_indicator,
section_length,
})
}
}
#[derive(Debug)]
#[allow(unused)]
struct TableSyntaxSection {
table_id_extension: u16,
version_number: u8,
current_next_indicator: bool,
section_number: u8,
last_section_number: u8,
}
impl FromBitStream for TableSyntaxSection {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let table_id_extension = r.read_to::<u16>().context("table_id_extension")?;
r.skip(2).context("reserved")?;
let version_number = r.read::<u8>(5).context("version_number")?;
let current_next_indicator = r.read_bit().context("current_next_indicator")?;
let section_number = r.read_to::<u8>().context("section_number")?;
let last_section_number = r.read_to::<u8>().context("last_section_number")?;
Ok(TableSyntaxSection {
table_id_extension,
version_number,
current_next_indicator,
section_number,
last_section_number,
})
}
}
#[derive(Debug)]
struct ProgramAccessTable {
program_num: u16,
program_map_pid: u16,
}
impl FromBitStream for ProgramAccessTable {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let program_num = r.read_to::<u16>().context("program_num")?;
r.skip(3).context("reserved")?;
let program_map_pid = r.read::<u16>(13).context("program_map_pid")?;
Ok(ProgramAccessTable {
program_num,
program_map_pid,
})
}
}
#[derive(Debug)]
struct ProgramMappingTable {
pcr_pid: u16,
// Add other fields as needed
}
impl FromBitStream for ProgramMappingTable {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
r.skip(3).context("reserved")?;
let pcr_pid = r.read::<u16>(13).context("pcr_pid")?;
Ok(ProgramMappingTable { pcr_pid })
}
// Section parser for PMT
pmt_parser: SectionParser,
// Currently selected PMT
pmt: Option<ProgramMappingTable>,
}
impl State {
@ -483,111 +294,106 @@ impl State {
self.last_seen_pcr = Some(new_pcr);
}
/// Parses an MPEG-TS section and updates the internal state
/// Parses and handles a section
fn handle_section(
&mut self,
imp: &MpegTsLiveSource,
header: &PacketHeader,
table_header: &TableHeader,
slice: &[u8],
payload: &[u8],
) -> Result<()> {
gst::trace!(
CAT,
imp = imp,
"Parsing section with header {table_header:?}"
);
// Read PAT or our selected program's PMT
if header.pid == 0x00_00 {
self.pat_parser.push(header, payload);
// Skip non-PAT/PMT
if table_header.table_id != 0x00 && table_header.table_id != 0x02
|| !table_header.section_syntax_indicator
{
return Ok(());
}
let mut section_reader = BitReader::endian(slice, BigEndian);
let table_syntax_section = section_reader
.parse::<TableSyntaxSection>()
.context("section")?;
gst::trace!(
CAT,
imp = imp,
"Parsing section with table syntax section {table_syntax_section:?}"
);
if header.pid == 0x00_00 && table_header.table_id == 0x00 {
// PAT
let remaining_length = section_reader.reader().unwrap().len();
if remaining_length < 4 {
bail!("too short PAT");
}
let n_pats = (remaining_length - 4) / 4;
if n_pats == 0 {
gst::warning!(CAT, imp = imp, "No programs in PAT");
return Ok(());
}
let mut first = true;
let mut warned = false;
for idx in 0..n_pats {
let pat = section_reader
.parse::<ProgramAccessTable>()
.context("pat")?;
gst::trace!(CAT, imp = imp, "Parsed PAT {idx}: {pat:?}");
if pat.program_map_pid == 0 {
// Skip NIT
} else if first {
first = false;
// Our program we select
if Option::zip(self.pmt_pid, self.pmt_program_num)
.map_or(true, |(pid, prog_num)| {
pid != pat.program_map_pid || prog_num != pat.program_num
})
{
loop {
match self.pat_parser.parse() {
Ok(Some(Section::ProgramAccessTable {
table_header,
table_syntax_section,
pat,
})) => {
gst::trace!(
CAT,
imp = imp,
"Selecting program with PID {} and program number {}",
pat.program_map_pid,
pat.program_num,
"Parsed PAT: {table_header:?} {table_syntax_section:?} {pat:?}"
);
self.pmt_pid = Some(pat.program_map_pid);
self.pmt_program_num = Some(pat.program_num);
self.pmt_pending.clear();
self.pmt_cc = None;
self.pcr_pid = None;
self.last_seen_pcr = None;
if pat.is_empty() {
gst::warning!(CAT, imp = imp, "No programs in PAT");
continue;
} else if pat.len() > 1 {
gst::warning!(
CAT,
imp = imp,
"MPEG-TS stream with multiple programs - timing will be wrong for all but first program",
);
}
let selected_pat = &pat[0];
if header.pid == 0x00_00 && Some(selected_pat) != self.pat.as_ref() {
gst::trace!(
CAT,
imp = imp,
"Selecting program with PID {} and program number {}",
selected_pat.program_map_pid,
selected_pat.program_num,
);
self.pat = Some(selected_pat.clone());
self.pmt_parser.clear();
self.pmt = None;
self.last_seen_pcr = None;
}
}
} else {
// Other programs we ignore
if !warned {
gst::warning!(
Ok(Some(section)) => {
gst::trace!(
CAT,
imp = imp,
"MPEG-TS stream with multiple programs - timing will be wrong for all but first program",
"Parsed unhandled section {section:?} on PAT PID"
);
warned = true;
}
Ok(None) => break,
Err(err) => {
gst::warning!(CAT, imp = imp, "Failed parsing section: {err:?}");
}
}
}
} else if Some(header.pid) == self.pmt_pid
&& Some(table_syntax_section.table_id_extension) == self.pmt_program_num
&& table_header.table_id == 0x02
{
// PMT
let pmt = section_reader
.parse::<ProgramMappingTable>()
.context("pmt")?;
gst::trace!(
CAT,
imp = imp,
"Parsed PMT for selected program number {}: {pmt:?}",
table_syntax_section.table_id_extension
);
if self.pcr_pid.map_or(true, |pcr_pid| pcr_pid != pmt.pcr_pid) {
self.pcr_pid = Some(pmt.pcr_pid);
self.last_seen_pcr = None;
} else if self.pat.as_ref().map(|pat| pat.program_map_pid) == Some(header.pid) {
self.pmt_parser.push(header, payload);
loop {
match self.pmt_parser.parse() {
Ok(Some(Section::ProgramMappingTable {
table_header,
table_syntax_section,
pmt,
})) => {
gst::trace!(
CAT,
imp = imp,
"Parsed PMT: {table_header:?} {table_syntax_section:?} {pmt:?}"
);
if self.pat.as_ref().map(|pat| pat.program_num)
== Some(table_syntax_section.table_id_extension)
&& self.pmt.as_ref() != Some(&pmt)
{
gst::trace!(CAT, imp = imp, "Selecting PCR PID {}", pmt.pcr_pid);
self.pmt = Some(pmt);
self.last_seen_pcr = None;
}
}
Ok(Some(section)) => {
gst::trace!(
CAT,
imp = imp,
"Parsed unhandled section {section:?} on PMT PID"
);
}
Ok(None) => break,
Err(err) => {
gst::warning!(CAT, imp = imp, "Failed parsing section: {err:?}");
}
}
}
}
@ -626,7 +432,7 @@ impl State {
reader.skip(8 * length as u32).context("af")?;
// Parse adaption field and update PCR if it's the PID of our selected program
if self.pcr_pid == Some(header.pid) {
if self.pmt.as_ref().map(|pmt| pmt.pcr_pid) == Some(header.pid) {
let mut af_reader = BitReader::endian(af, BigEndian);
let adaptation_field = af_reader.parse::<AdaptionField>().context("af")?;
@ -649,106 +455,10 @@ impl State {
if header.afc & 0x1 != 0 {
let new_payload = *reader.reader().unwrap();
// Read PAT or our selected program's PMT
if header.pid == 0x00_00 || self.pmt_pid == Some(header.pid) {
let (cc, mut pending, pending_pusi) = if header.pid == 0x00_00 {
(
&mut self.pat_cc,
mem::take(&mut self.pat_pending),
self.pat_pending_pusi,
)
} else {
(
&mut self.pmt_cc,
mem::take(&mut self.pmt_pending),
self.pmt_pending_pusi,
)
};
// Clear any pending data if necessary
if header.pusi || cc.map_or(true, |cc| (cc + 1) & 0xf != header.cc) {
pending.clear();
}
*cc = Some(header.cc);
// Skip packet if this is not the start of a section
if !header.pusi && pending.is_empty() {
return Ok(());
}
// Store payload for parsing, in case it's split over multiple packets
pending.extend_from_slice(new_payload);
// No payload
if pending.is_empty() {
return Ok(());
}
let payload = pending.as_slice();
let mut pusi = header.pusi || pending_pusi;
let mut payload_reader = BitReader::endian(payload, BigEndian);
loop {
let remaining_payload = payload_reader.reader().unwrap();
let table_header;
if pusi {
assert!(!remaining_payload.is_empty());
let pointer_field = remaining_payload[0] as usize;
// Need more data
if payload_reader.reader().unwrap().len() < 1 + pointer_field + 3 {
break;
}
// Skip padding
payload_reader.skip(8 + 8 * pointer_field as u32).unwrap();
pusi = false;
// Peek table header, payload_reader stays at beginning of section header
table_header = payload_reader.clone().parse::<TableHeader>().unwrap();
} else if remaining_payload.len() < 3 {
// Need more data for table header
break;
} else {
// Peek table header, payload_reader stays at beginning of section header
table_header = payload_reader.clone().parse::<TableHeader>().unwrap();
}
// Need more data for this section. payload_reader is still at beginning of
// section header so require 3 extra bytes
let remaining_length = payload_reader.reader().unwrap().len();
if remaining_length < 3 + table_header.section_length as usize {
break;
}
// Skip table header
payload_reader.skip(8 * 3).unwrap();
let section =
&payload_reader.reader().unwrap()[..table_header.section_length as usize];
// Skip whole section so the reader is at the beginning of the next section header
payload_reader
.skip(8 * table_header.section_length as u32)
.unwrap();
if let Err(err) = self.handle_section(imp, &header, &table_header, section) {
gst::warning!(
CAT,
imp = imp,
"Failed parsing section {table_header:?}: {err:?}"
);
}
}
// Skip all already parsed sections
let remaining_length = payload_reader.reader().unwrap().len();
let new_pending_range = (pending.len() - remaining_length)..pending.len();
pending.copy_within(new_pending_range, 0);
pending.resize(remaining_length, 0u8);
if header.pid == 0x00_00 {
self.pat_pending = pending;
self.pat_pending_pusi = pusi;
} else {
self.pmt_pending = pending;
self.pmt_pending_pusi = pusi;
}
if header.pid == 0x00_00
|| self.pat.as_ref().map(|pat| pat.program_map_pid) == Some(header.pid)
{
self.handle_section(imp, &header, new_payload)?;
}
// Skip everything else

View file

@ -10,6 +10,7 @@ use gst::glib;
use gst::prelude::*;
mod imp;
mod parser;
glib::wrapper! {
pub struct MpegTsLiveSource(ObjectSubclass<imp::MpegTsLiveSource>) @extends gst::Bin, gst::Element, gst::Object;

View file

@ -0,0 +1,465 @@
// Copyright (C) 2024 Sebastian Dröge <sebastian@centricular.com>
//
// This Source Code Form is subject to the terms of the Mozilla Public License, v2.0.
// If a copy of the MPL was not distributed with this file, You can obtain one at
// <https://mozilla.org/MPL/2.0/>.
//
// SPDX-License-Identifier: MPL-2.0
#![allow(unused)]
use anyhow::{bail, Context, Result};
use bitstream_io::{BigEndian, BitRead, BitReader, FromBitStream};
use smallvec::SmallVec;
pub struct SectionParser {
/// Current value of the continuity counter
cc: Option<u8>,
/// Pending PSI data
pending: Vec<u8>,
/// If we skip data until the next PUSI
waiting_for_pusi: bool,
/// If pending starts on PUSI, i.e. still contains potential padding
pending_starts_on_pusi: bool,
}
impl Default for SectionParser {
fn default() -> Self {
Self {
cc: None,
pending: Vec::new(),
waiting_for_pusi: true,
pending_starts_on_pusi: false,
}
}
}
impl SectionParser {
/// Push PSI `payload`.
///
/// After this call `parse()` until `None` is returned.
pub fn push(&mut self, header: &PacketHeader, payload: &[u8]) {
if header.pusi {
self.clear();
} else if self.cc.map_or(true, |cc| (cc + 1) & 0xf != header.cc) {
self.clear();
self.waiting_for_pusi = true;
// Not start of a payload and we didn't see the start, just return
return;
} else if self.waiting_for_pusi {
// Not start of a payload and we didn't see the start, just return
return;
}
self.cc = Some(header.cc);
// Store payload for parsing, in case it's split over multiple packets
if header.pusi {
self.waiting_for_pusi = false;
self.pending_starts_on_pusi = true;
}
self.pending.extend_from_slice(payload);
}
/// Parse PSI payload that is currently queued up.
///
/// Call until `None` is returned, which means that more data is required to continue parsing.
///
/// It's safe to call this again after errors.
pub fn parse(&mut self) -> Result<Option<Section>> {
// No payload to handle right now
if self.pending.is_empty() {
return Ok(None);
}
let payload = self.pending.as_slice();
// Skip padding first
if self.pending_starts_on_pusi {
let pointer_field = payload[0] as usize;
// Need more data
if payload.len() < 1 + pointer_field {
return Ok(None);
}
// Skip padding
self.pending.copy_within(1 + pointer_field.., 0);
let new_length = self.pending.len() - 1 - pointer_field;
self.pending.resize(new_length, 0u8);
self.pending_starts_on_pusi = false;
}
let payload = self.pending.as_slice();
if payload.len() < 3 {
// Need more data for table header
return Ok(None);
}
// Parse table header, payload_reader stays at beginning of section header
let mut payload_reader = BitReader::endian(payload, BigEndian);
let table_header = match payload_reader
.parse::<TableHeader>()
.context("table_header")
{
Ok(table_header) => table_header,
Err(err) => {
self.clear();
return Err(err);
}
};
// Need more data for this section, don't update pending
let remaining_length = payload_reader.reader().unwrap().len();
if remaining_length < table_header.section_length as usize {
return Ok(None);
}
let section = &payload_reader.reader().unwrap()[..table_header.section_length as usize];
// Skip whole section so the reader is at the beginning of the next section header
payload_reader
.skip(8 * table_header.section_length as u32)
.unwrap();
let section = Self::parse_section(&table_header, section);
// Skip parsed section, even in case of parsing error
let remaining_length = payload_reader.reader().unwrap().len();
let new_pending_range = (self.pending.len() - remaining_length)..;
self.pending.copy_within(new_pending_range, 0);
self.pending.resize(remaining_length, 0u8);
section
.map(Some)
.map_err(|err| err.context(format!("section with table header {table_header:?}")))
}
fn parse_section(table_header: &TableHeader, section: &[u8]) -> Result<Section> {
let mut section_reader = BitReader::endian(section, BigEndian);
// TODO: If TSS is available one could check the CRC32 at the end of the section
let table_syntax_section = if table_header.section_syntax_indicator {
Some(
section_reader
.parse::<TableSyntaxSection>()
.context("section")?,
)
} else {
None
};
let section = match table_header.table_id {
// PAT
0x00 => {
let Some(table_syntax_section) = table_syntax_section else {
bail!("PAT without TSS");
};
let remaining_length = section_reader.reader().unwrap().len();
if remaining_length < 4 {
bail!("too short PAT");
}
let n_pats = (remaining_length - 4) / 4;
let mut pat = SmallVec::with_capacity(n_pats);
for _ in 0..n_pats {
pat.push(
section_reader
.parse::<ProgramAccessTable>()
.context("pat_entry")?,
);
}
Section::ProgramAccessTable {
table_header: table_header.clone(),
table_syntax_section,
pat,
}
}
// PAT
0x02 => {
let Some(table_syntax_section) = table_syntax_section else {
bail!("PMT without TSS");
};
let pmt = section_reader
.parse::<ProgramMappingTable>()
.context("pmt")?;
Section::ProgramMappingTable {
table_header: table_header.clone(),
table_syntax_section,
pmt,
}
}
// Unknown
_ => Section::Unknown {
table_header: table_header.clone(),
table_syntax_section,
},
};
Ok(section)
}
pub fn clear(&mut self) {
self.cc = None;
self.pending.clear();
self.pending_starts_on_pusi = false;
self.waiting_for_pusi = true;
}
}
#[derive(Debug, Clone)]
pub enum Section {
ProgramAccessTable {
table_header: TableHeader,
table_syntax_section: TableSyntaxSection,
pat: SmallVec<[ProgramAccessTable; 4]>,
},
ProgramMappingTable {
table_header: TableHeader,
table_syntax_section: TableSyntaxSection,
pmt: ProgramMappingTable,
},
Unknown {
table_header: TableHeader,
table_syntax_section: Option<TableSyntaxSection>,
},
}
#[derive(Debug, Clone)]
pub struct TableHeader {
pub table_id: u8,
pub section_syntax_indicator: bool,
pub section_length: u16,
}
impl FromBitStream for TableHeader {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let table_id = r.read_to::<u8>().context("table_id")?;
let section_syntax_indicator = r.read_bit().context("table_syntax_indicator")?;
r.skip(5).context("reserved")?;
let section_length = r.read::<u16>(10).context("section_length")?;
Ok(TableHeader {
table_id,
section_syntax_indicator,
section_length,
})
}
}
#[derive(Debug, Clone)]
pub struct TableSyntaxSection {
pub table_id_extension: u16,
pub version_number: u8,
pub current_next_indicator: bool,
pub section_number: u8,
pub last_section_number: u8,
}
impl FromBitStream for TableSyntaxSection {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let table_id_extension = r.read_to::<u16>().context("table_id_extension")?;
r.skip(2).context("reserved")?;
let version_number = r.read::<u8>(5).context("version_number")?;
let current_next_indicator = r.read_bit().context("current_next_indicator")?;
let section_number = r.read_to::<u8>().context("section_number")?;
let last_section_number = r.read_to::<u8>().context("last_section_number")?;
Ok(TableSyntaxSection {
table_id_extension,
version_number,
current_next_indicator,
section_number,
last_section_number,
})
}
}
#[derive(Debug, Clone, PartialEq)]
pub struct ProgramAccessTable {
pub program_num: u16,
pub program_map_pid: u16,
}
impl FromBitStream for ProgramAccessTable {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
let program_num = r.read_to::<u16>().context("program_num")?;
r.skip(3).context("reserved")?;
let program_map_pid = r.read::<u16>(13).context("program_map_pid")?;
Ok(ProgramAccessTable {
program_num,
program_map_pid,
})
}
}
#[derive(Debug, Clone, PartialEq)]
pub struct ProgramMappingTable {
pub pcr_pid: u16,
pub elementary_pids: SmallVec<[u16; 16]>,
// Add other fields as needed
}
impl FromBitStream for ProgramMappingTable {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
r.skip(3).context("reserved")?;
let pcr_pid = r.read::<u16>(13).context("pcr_pid")?;
r.skip(4).context("reserved")?;
r.skip(2).context("program_info_length_unused")?;
let program_info_length = r.read::<u16>(10).context("program_info_length")?;
r.skip(8 * program_info_length as u32)
.context("program_descriptors")?;
fn try_read<R: BitRead + ?Sized, F: Fn(&mut R) -> Result<T, std::io::Error>, T>(
r: &mut R,
op: F,
) -> Result<Option<T>, std::io::Error> {
match op(r) {
Ok(v) => Ok(Some(v)),
Err(err) if err.kind() == std::io::ErrorKind::UnexpectedEof => Ok(None),
Err(err) => Err(err),
}
}
let mut elementary_pids = SmallVec::new();
loop {
let Some(_stream_type) = try_read(r, |r| r.read_to::<u8>()).context("stream_type")?
else {
break;
};
let Some(_) = try_read(r, |r| r.skip(3)).context("reserved_bits")? else {
break;
};
let Some(elementary_pid) =
try_read(r, |r| r.read::<u16>(13)).context("elementary_pid")?
else {
break;
};
let Some(_) = try_read(r, |r| r.skip(4)).context("reserved_bits")? else {
break;
};
let Some(_) = try_read(r, |r| r.skip(2)).context("es_info_length_unused_bits")? else {
break;
};
let Some(es_info_length) =
try_read(r, |r| r.read::<u16>(10)).context("es_info_length")?
else {
break;
};
let Some(_) =
try_read(r, |r| r.skip(8 * es_info_length as u32)).context("es_descriptors")?
else {
break;
};
elementary_pids.push(elementary_pid);
}
Ok(ProgramMappingTable {
pcr_pid,
elementary_pids,
})
}
}
#[derive(Debug, Clone)]
pub struct PacketHeader {
pub tei: bool,
pub pusi: bool,
pub tp: bool,
pub pid: u16,
pub tsc: u8,
pub afc: u8,
pub cc: u8,
}
impl FromBitStream for PacketHeader {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
if r.read_to::<u8>().context("sync_byte")? != 0x47 {
bail!("Lost sync");
}
let tei = r.read_bit().context("tei")?;
let pusi = r.read_bit().context("pusi")?;
let tp = r.read_bit().context("tp")?;
let pid = r.read::<u16>(13).context("pid")?;
let tsc = r.read::<u8>(2).context("tsc")?;
let afc = r.read::<u8>(2).context("afc")?;
let cc = r.read::<u8>(4).context("cc")?;
Ok(PacketHeader {
tei,
pusi,
tp,
pid,
tsc,
afc,
cc,
})
}
}
#[derive(Debug, Clone)]
pub struct AdaptionField {
pub pcr: Option<u64>,
// Add other fields as needed
}
impl FromBitStream for AdaptionField {
type Error = anyhow::Error;
fn from_reader<R: BitRead + ?Sized>(r: &mut R) -> std::result::Result<Self, Self::Error>
where
Self: Sized,
{
r.skip(3).context("flags")?;
let pcr_present = r.read_bit().context("pcr_present")?;
r.skip(4).context("flags")?;
// PCR present
let pcr = if pcr_present {
let pcr = r.read::<u64>(33).context("pcr_base")? * 300;
r.skip(6).context("pcr_reserved")?;
let pcr = pcr + r.read::<u64>(9).context("pcr_extension")? % 300;
Some(pcr)
} else {
None
};
// Skip all other parts of the adaptation field for now
Ok(AdaptionField { pcr })
}
}