1#[cfg(test)]
2mod packet_test;
3
4use crate::header::*;
5use shared::{
6 error::{Error, Result},
7 marshal::{Marshal, MarshalSize, Unmarshal},
8};
9
10use bytes::{Buf, BufMut, Bytes};
11use std::fmt;
12
13#[derive(Debug, Eq, PartialEq, Default, Clone)]
16pub struct Packet {
17 pub header: Header,
18 pub payload: Bytes,
19}
20
21impl fmt::Display for Packet {
22 fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
23 let mut out = "RTP PACKET:\n".to_string();
24
25 out += format!("\tVersion: {}\n", self.header.version).as_str();
26 out += format!("\tMarker: {}\n", self.header.marker).as_str();
27 out += format!("\tPayload Type: {}\n", self.header.payload_type).as_str();
28 out += format!("\tSequence Number: {}\n", self.header.sequence_number).as_str();
29 out += format!("\tTimestamp: {}\n", self.header.timestamp).as_str();
30 out += format!("\tSSRC: {} ({:x})\n", self.header.ssrc, self.header.ssrc).as_str();
31 out += format!("\tPayload Length: {}\n", self.payload.len()).as_str();
32
33 write!(f, "{out}")
34 }
35}
36
37impl Unmarshal for Packet {
38 fn unmarshal<B>(raw_packet: &mut B) -> Result<Self>
40 where
41 Self: Sized,
42 B: Buf,
43 {
44 let header = Header::unmarshal(raw_packet)?;
45 let payload_len = raw_packet.remaining();
46 let payload = raw_packet.copy_to_bytes(payload_len);
47 if header.padding {
48 if payload_len > 0 {
49 let padding_len = payload[payload_len - 1] as usize;
50 if padding_len <= payload_len {
51 Ok(Packet {
52 header,
53 payload: payload.slice(..payload_len - padding_len),
54 })
55 } else {
56 Err(Error::ErrShortPacket)
57 }
58 } else {
59 Err(Error::ErrShortPacket)
60 }
61 } else {
62 Ok(Packet { header, payload })
63 }
64 }
65}
66
67impl MarshalSize for Packet {
68 fn marshal_size(&self) -> usize {
70 let payload_len = self.payload.len();
71 let padding_len = if self.header.padding {
72 let padding_len = get_padding(payload_len);
73 if padding_len == 0 { 4 } else { padding_len }
74 } else {
75 0
76 };
77 self.header.marshal_size() + payload_len + padding_len
78 }
79}
80
81impl Marshal for Packet {
82 fn marshal_to(&self, mut buf: &mut [u8]) -> Result<usize> {
84 if buf.remaining_mut() < self.marshal_size() {
85 return Err(Error::ErrBufferTooSmall);
86 }
87
88 let n = self.header.marshal_to(buf)?;
89 buf = &mut buf[n..];
90 buf.put(&*self.payload);
91 let padding_len = if self.header.padding {
92 let mut padding_len = get_padding(self.payload.len());
93 if padding_len == 0 {
94 padding_len = 4;
95 }
96 for i in 0..padding_len {
97 if i != padding_len - 1 {
98 buf.put_u8(0);
99 } else {
100 buf.put_u8(padding_len as u8);
101 }
102 }
103 padding_len
104 } else {
105 0
106 };
107
108 Ok(n + self.payload.len() + padding_len)
109 }
110}
111
112fn get_padding(len: usize) -> usize {
114 if len.is_multiple_of(4) {
115 0
116 } else {
117 4 - (len % 4)
118 }
119}