FreeCalypso > hg > themwi-rtp-lib

annotate src/rtp_tx.c @ 29:3e01a71b7c7c

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
implement RTCP Rx
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 08 Jul 2024 02:55:32 +0000
parents defe58aa537c
children e70e7b266f89
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * Here we implement RTP Tx functionality.
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 */
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 #include <stdint.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6 #include <stdbool.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7 #include <string.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8 #include <errno.h>
25
e67b3bb87d1b RTP Tx: network byte order
Mychaela Falconia <falcon@freecalypso.org>
parents: 24
diff changeset
9 #include <arpa/inet.h> /* for network byte order functions */
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 #include <osmocom/core/msgb.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 #include <osmocom/core/osmo_io.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 #include <osmocom/core/timer.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15 #include <themwi/rtp/endp.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
16 #include <themwi/rtp/rtp_basic_hdr.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
17 #include <themwi/rtp/twjit.h>
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
18
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
19 static uint32_t gen_timestamp(struct timespec *now,
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
20 struct twrtp_jibuf_inst *twjit)
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
21 {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
22 uint32_t ts;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
23
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
24 ts = now->tv_sec * twjit->ts_units_per_sec +
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
25 now->tv_nsec / twjit->ns_to_ts_units;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
26 return ts;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
27 }
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
28
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
29 int twrtp_endp_tx_quantum(struct twrtp_endp *endp, const uint8_t *payload,
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
30 unsigned payload_len, uint8_t payload_type,
26
f71efdd08c33 RTP Tx: add auto_marker mode of operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 25
diff changeset
31 bool marker, bool auto_marker, bool send_rtcp)
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
32 {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
33 uint32_t ts_quantum = endp->twjit->ts_quantum;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
34 struct msgb *msg;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
35 struct timespec now;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
36 uint32_t restart_ts;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
37 int32_t ts_delta;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
38 struct rtp_basic_hdr *rtph;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
39 uint8_t *pl_out;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
40 int rc;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 if (!endp->register_done || !endp->remote_set)
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 return -EINVAL;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44 msg = msgb_alloc_c(endp, sizeof(struct rtp_basic_hdr) + payload_len,
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 "ThemWi-RTP-Tx");
27
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
46 if (!msg) {
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
47 twrtp_endp_tx_skip(endp);
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 return -ENOMEM;
27
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
49 }
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 /* timestamp generation is where we do some trickery */
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
52 osmo_clock_gettime(CLOCK_REALTIME, &now);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53 if (!endp->tx.started) {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54 endp->tx.ts = gen_timestamp(&now, endp->twjit);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 endp->tx.started = true;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
56 endp->tx.restart = false;
26
f71efdd08c33 RTP Tx: add auto_marker mode of operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 25
diff changeset
57 if (auto_marker)
f71efdd08c33 RTP Tx: add auto_marker mode of operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 25
diff changeset
58 marker = true;
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 } else if (endp->tx.restart) {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 restart_ts = gen_timestamp(&now, endp->twjit);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61 ts_delta = (int32_t)(restart_ts - endp->tx.ts);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62 if (ts_delta <= 0) {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
63 /* shouldn't happen, unless something funky w/clock */
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 endp->tx.ts++;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 } else {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66 if (ts_delta % ts_quantum == 0)
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 restart_ts++;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
68 endp->tx.ts = restart_ts;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
69 }
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 endp->tx.restart = false;
26
f71efdd08c33 RTP Tx: add auto_marker mode of operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 25
diff changeset
71 if (auto_marker)
f71efdd08c33 RTP Tx: add auto_marker mode of operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 25
diff changeset
72 marker = true;
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 }
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 rtph = (struct rtp_basic_hdr *)
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 msgb_put(msg, sizeof(struct rtp_basic_hdr));
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 rtph->v_p_x_cc = 0x80;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 rtph->m_pt = payload_type;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 if (marker)
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 rtph->m_pt |= 0x80;
25
e67b3bb87d1b RTP Tx: network byte order
Mychaela Falconia <falcon@freecalypso.org>
parents: 24
diff changeset
81 rtph->ssrc = htonl(endp->tx.ssrc);
e67b3bb87d1b RTP Tx: network byte order
Mychaela Falconia <falcon@freecalypso.org>
parents: 24
diff changeset
82 rtph->seq = htons(endp->tx.seq);
e67b3bb87d1b RTP Tx: network byte order
Mychaela Falconia <falcon@freecalypso.org>
parents: 24
diff changeset
83 rtph->tstamp = htonl(endp->tx.ts);
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 pl_out = msgb_put(msg, payload_len);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
85 memcpy(pl_out, payload, payload_len);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 endp->tx.seq++;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87 endp->tx.ts += ts_quantum;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
89 rc = osmo_iofd_sendto_msgb(endp->iofd_rtp, msg, 0, &endp->rtp_remote);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
90 if (rc < 0) {
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
91 msgb_free(msg);
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
92 return rc;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
93 }
28
defe58aa537c RTP Tx: count stats for RTCP SR
Mychaela Falconia <falcon@freecalypso.org>
parents: 27
diff changeset
94 endp->stats.tx_rtp_pkt++;
defe58aa537c RTP Tx: count stats for RTCP SR
Mychaela Falconia <falcon@freecalypso.org>
parents: 27
diff changeset
95 endp->stats.tx_rtp_bytes += payload_len;
24
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
96
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
97 /* TODO: send RTCP if requested */
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
98
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
99 return 0;
84d427017d2f endp: implement RTP Tx
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
100 }
27
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
101
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
102 void twrtp_endp_tx_skip(struct twrtp_endp *endp)
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
103 {
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
104 if (!endp->tx.started || endp->tx.restart)
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
105 return;
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
106 endp->tx.ts += endp->twjit->ts_quantum;
a0b89c028053 RTP Tx: implement skip operation
Mychaela Falconia <falcon@freecalypso.org>
parents: 26
diff changeset
107 }