Re-fix sending unnegotiated payloads during a P2P RTP bridge.
[asterisk/asterisk.git] / res / res_rtp_asterisk.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2008, Digium, Inc.
5  *
6  * Mark Spencer <markster@digium.com>
7  *
8  * See http://www.asterisk.org for more information about
9  * the Asterisk project. Please do not directly contact
10  * any of the maintainers of this project for assistance;
11  * the project provides a web site, mailing lists and IRC
12  * channels for your use.
13  *
14  * This program is free software, distributed under the terms of
15  * the GNU General Public License Version 2. See the LICENSE file
16  * at the top of the source tree.
17  */
18
19 /*!
20  * \file
21  *
22  * \brief Supports RTP and RTCP with Symmetric RTP support for NAT traversal.
23  *
24  * \author Mark Spencer <markster@digium.com>
25  *
26  * \note RTP is defined in RFC 3550.
27  *
28  * \ingroup rtp_engines
29  */
30
31 /*** MODULEINFO
32         <support_level>core</support_level>
33  ***/
34
35 #include "asterisk.h"
36
37 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
38
39 #include <sys/time.h>
40 #include <signal.h>
41 #include <fcntl.h>
42
43 /* Asterisk discourages the use of bzero in favor of memset, in fact if you try to use bzero it will tell you to use memset. As a result bzero has to be undefined
44  * here since it is used internally by pjlib. The only other option would be to modify pjlib... which won't happen. */
45 #undef bzero
46 #define bzero bzero
47 #include "pjlib.h"
48 #include "pjlib-util.h"
49 #include "pjnath.h"
50
51 #include "asterisk/stun.h"
52 #include "asterisk/pbx.h"
53 #include "asterisk/frame.h"
54 #include "asterisk/channel.h"
55 #include "asterisk/acl.h"
56 #include "asterisk/config.h"
57 #include "asterisk/lock.h"
58 #include "asterisk/utils.h"
59 #include "asterisk/cli.h"
60 #include "asterisk/manager.h"
61 #include "asterisk/unaligned.h"
62 #include "asterisk/module.h"
63 #include "asterisk/rtp_engine.h"
64
65 #define MAX_TIMESTAMP_SKEW      640
66
67 #define RTP_SEQ_MOD     (1<<16) /*!< A sequence number can't be more than 16 bits */
68 #define RTCP_DEFAULT_INTERVALMS   5000  /*!< Default milli-seconds between RTCP reports we send */
69 #define RTCP_MIN_INTERVALMS       500   /*!< Min milli-seconds between RTCP reports we send */
70 #define RTCP_MAX_INTERVALMS       60000 /*!< Max milli-seconds between RTCP reports we send */
71
72 #define DEFAULT_RTP_START 5000 /*!< Default port number to start allocating RTP ports from */
73 #define DEFAULT_RTP_END 31000  /*!< Default maximum port number to end allocating RTP ports at */
74
75 #define MINIMUM_RTP_PORT 1024 /*!< Minimum port number to accept */
76 #define MAXIMUM_RTP_PORT 65535 /*!< Maximum port number to accept */
77
78 #define DEFAULT_TURN_PORT 34780
79
80 #define TURN_ALLOCATION_WAIT_TIME 2000
81
82 #define RTCP_PT_FUR     192
83 #define RTCP_PT_SR      200
84 #define RTCP_PT_RR      201
85 #define RTCP_PT_SDES    202
86 #define RTCP_PT_BYE     203
87 #define RTCP_PT_APP     204
88
89 #define RTP_MTU         1200
90
91 #define DEFAULT_DTMF_TIMEOUT (150 * (8000 / 1000))      /*!< samples */
92
93 #define ZFONE_PROFILE_ID 0x505a
94
95 #define DEFAULT_LEARNING_MIN_SEQUENTIAL 4
96
97 enum strict_rtp_state {
98         STRICT_RTP_OPEN = 0, /*! No RTP packets should be dropped, all sources accepted */
99         STRICT_RTP_LEARN,    /*! Accept next packet as source */
100         STRICT_RTP_CLOSED,   /*! Drop all RTP packets not coming from source that was learned */
101 };
102
103 #define DEFAULT_STRICT_RTP STRICT_RTP_CLOSED
104 #define DEFAULT_ICESUPPORT 1
105
106 extern struct ast_srtp_res *res_srtp;
107 static int dtmftimeout = DEFAULT_DTMF_TIMEOUT;
108
109 static int rtpstart = DEFAULT_RTP_START;                        /*!< First port for RTP sessions (set in rtp.conf) */
110 static int rtpend = DEFAULT_RTP_END;                    /*!< Last port for RTP sessions (set in rtp.conf) */
111 static int rtpdebug;                    /*!< Are we debugging? */
112 static int rtcpdebug;                   /*!< Are we debugging RTCP? */
113 static int rtcpstats;                   /*!< Are we debugging RTCP? */
114 static int rtcpinterval = RTCP_DEFAULT_INTERVALMS; /*!< Time between rtcp reports in millisecs */
115 static struct ast_sockaddr rtpdebugaddr;        /*!< Debug packets to/from this host */
116 static struct ast_sockaddr rtcpdebugaddr;       /*!< Debug RTCP packets to/from this host */
117 static int rtpdebugport;                /*< Debug only RTP packets from IP or IP+Port if port is > 0 */
118 static int rtcpdebugport;               /*< Debug only RTCP packets from IP or IP+Port if port is > 0 */
119 #ifdef SO_NO_CHECK
120 static int nochecksums;
121 #endif
122 static int strictrtp = DEFAULT_STRICT_RTP; /*< Only accept RTP frames from a defined source. If we receive an indication of a changing source, enter learning mode. */
123 static int learning_min_sequential = DEFAULT_LEARNING_MIN_SEQUENTIAL; /*< Number of sequential RTP frames needed from a single source during learning mode to accept new source. */
124 static int icesupport = DEFAULT_ICESUPPORT;
125 static struct sockaddr_in stunaddr;
126 static pj_str_t turnaddr;
127 static int turnport = DEFAULT_TURN_PORT;
128 static pj_str_t turnusername;
129 static pj_str_t turnpassword;
130
131 /*! \brief Pool factory used by pjlib to allocate memory. */
132 static pj_caching_pool cachingpool;
133
134 /*! \brief Pool used by pjlib functions which require memory allocation. */
135 static pj_pool_t *pool;
136
137 /*! \brief I/O queue for TURN relay traffic */
138 static pj_ioqueue_t *ioqueue;
139
140 /*! \brief Timer heap for ICE and TURN stuff */
141 static pj_timer_heap_t *timerheap;
142
143 /*! \brief Worker thread for ICE/TURN */
144 static pj_thread_t *thread;
145
146 /*! \brief Notification that the ICE/TURN worker thread should stop */
147 static int worker_terminate;
148
149 #define FLAG_3389_WARNING               (1 << 0)
150 #define FLAG_NAT_ACTIVE                 (3 << 1)
151 #define FLAG_NAT_INACTIVE               (0 << 1)
152 #define FLAG_NAT_INACTIVE_NOWARN        (1 << 1)
153 #define FLAG_NEED_MARKER_BIT            (1 << 3)
154 #define FLAG_DTMF_COMPENSATE            (1 << 4)
155
156 #define TRANSPORT_SOCKET_RTP 1
157 #define TRANSPORT_SOCKET_RTCP 2
158 #define TRANSPORT_TURN_RTP 3
159 #define TRANSPORT_TURN_RTCP 4
160
161 #define COMPONENT_RTP 1
162 #define COMPONENT_RTCP 2
163
164 /*! \brief RTP session description */
165 struct ast_rtp {
166         int s;
167         struct ast_frame f;
168         unsigned char rawdata[8192 + AST_FRIENDLY_OFFSET];
169         unsigned int ssrc;              /*!< Synchronization source, RFC 3550, page 10. */
170         unsigned int themssrc;          /*!< Their SSRC */
171         unsigned int rxssrc;
172         unsigned int lastts;
173         unsigned int lastrxts;
174         unsigned int lastividtimestamp;
175         unsigned int lastovidtimestamp;
176         unsigned int lastitexttimestamp;
177         unsigned int lastotexttimestamp;
178         unsigned int lasteventseqn;
179         int lastrxseqno;                /*!< Last received sequence number */
180         unsigned short seedrxseqno;     /*!< What sequence number did they start with?*/
181         unsigned int seedrxts;          /*!< What RTP timestamp did they start with? */
182         unsigned int rxcount;           /*!< How many packets have we received? */
183         unsigned int rxoctetcount;      /*!< How many octets have we received? should be rxcount *160*/
184         unsigned int txcount;           /*!< How many packets have we sent? */
185         unsigned int txoctetcount;      /*!< How many octets have we sent? (txcount*160)*/
186         unsigned int cycles;            /*!< Shifted count of sequence number cycles */
187         double rxjitter;                /*!< Interarrival jitter at the moment in seconds */
188         double rxtransit;               /*!< Relative transit time for previous packet */
189         struct ast_format lasttxformat;
190         struct ast_format lastrxformat;
191
192         int rtptimeout;                 /*!< RTP timeout time (negative or zero means disabled, negative value means temporarily disabled) */
193         int rtpholdtimeout;             /*!< RTP timeout when on hold (negative or zero means disabled, negative value means temporarily disabled). */
194         int rtpkeepalive;               /*!< Send RTP comfort noice packets for keepalive */
195
196         /* DTMF Reception Variables */
197         char resp;                        /*!< The current digit being processed */
198         unsigned int last_seqno;          /*!< The last known sequence number for any DTMF packet */
199         unsigned int last_end_timestamp;  /*!< The last known timestamp received from an END packet */
200         unsigned int dtmf_duration;       /*!< Total duration in samples since the digit start event */
201         unsigned int dtmf_timeout;        /*!< When this timestamp is reached we consider END frame lost and forcibly abort digit */
202         unsigned int dtmfsamples;
203         enum ast_rtp_dtmf_mode dtmfmode;  /*!< The current DTMF mode of the RTP stream */
204         /* DTMF Transmission Variables */
205         unsigned int lastdigitts;
206         char sending_digit;     /*!< boolean - are we sending digits */
207         char send_digit;        /*!< digit we are sending */
208         int send_payload;
209         int send_duration;
210         unsigned int flags;
211         struct timeval rxcore;
212         struct timeval txcore;
213         double drxcore;                 /*!< The double representation of the first received packet */
214         struct timeval lastrx;          /*!< timeval when we last received a packet */
215         struct timeval dtmfmute;
216         struct ast_smoother *smoother;
217         int *ioid;
218         unsigned short seqno;           /*!< Sequence number, RFC 3550, page 13. */
219         unsigned short rxseqno;
220         struct ast_sched_context *sched;
221         struct io_context *io;
222         void *data;
223         struct ast_rtcp *rtcp;
224         struct ast_rtp *bridged;        /*!< Who we are Packet bridged to */
225
226         enum strict_rtp_state strict_rtp_state; /*!< Current state that strict RTP protection is in */
227         struct ast_sockaddr strict_rtp_address;  /*!< Remote address information for strict RTP purposes */
228         struct ast_sockaddr alt_rtp_address; /*!<Alternate remote address information */
229
230         /*
231          * Learning mode values based on pjmedia's probation mode.  Many of these values are redundant to the above,
232          * but these are in place to keep learning mode sequence values sealed from their normal counterparts.
233          */
234         uint16_t learning_max_seq;              /*!< Highest sequence number heard */
235         int learning_probation;         /*!< Sequential packets untill source is valid */
236
237         struct rtp_red *red;
238
239         pj_ice_sess *ice;           /*!< ICE session */
240         pj_turn_sock *turn_rtp;     /*!< RTP TURN relay */
241         pj_turn_sock *turn_rtcp;    /*!< RTCP TURN relay */
242         ast_mutex_t lock;           /*!< Lock for synchronization purposes */
243         pj_turn_state_t turn_state; /*!< Current state of the TURN relay session */
244         ast_cond_t cond;            /*!< Condition for signaling */
245         unsigned int passthrough:1; /*!< Bit to indicate that the received packet should be passed through */
246         unsigned int ice_started:1; /*!< Bit to indicate ICE connectivity checks have started */
247
248         char remote_ufrag[256];  /*!< The remote ICE username */
249         char remote_passwd[256]; /*!< The remote ICE password */
250
251         char local_ufrag[256];  /*!< The local ICE username */
252         char local_passwd[256]; /*!< The local ICE password */
253
254         struct ao2_container *local_candidates;   /*!< The local ICE candidates */
255         struct ao2_container *remote_candidates;  /*!< The remote ICE candidates */
256 };
257
258 /*!
259  * \brief Structure defining an RTCP session.
260  *
261  * The concept "RTCP session" is not defined in RFC 3550, but since
262  * this structure is analogous to ast_rtp, which tracks a RTP session,
263  * it is logical to think of this as a RTCP session.
264  *
265  * RTCP packet is defined on page 9 of RFC 3550.
266  *
267  */
268 struct ast_rtcp {
269         int rtcp_info;
270         int s;                          /*!< Socket */
271         struct ast_sockaddr us;         /*!< Socket representation of the local endpoint. */
272         struct ast_sockaddr them;       /*!< Socket representation of the remote endpoint. */
273         unsigned int soc;               /*!< What they told us */
274         unsigned int spc;               /*!< What they told us */
275         unsigned int themrxlsr;         /*!< The middle 32 bits of the NTP timestamp in the last received SR*/
276         struct timeval rxlsr;           /*!< Time when we got their last SR */
277         struct timeval txlsr;           /*!< Time when we sent or last SR*/
278         unsigned int expected_prior;    /*!< no. packets in previous interval */
279         unsigned int received_prior;    /*!< no. packets received in previous interval */
280         int schedid;                    /*!< Schedid returned from ast_sched_add() to schedule RTCP-transmissions*/
281         unsigned int rr_count;          /*!< number of RRs we've sent, not including report blocks in SR's */
282         unsigned int sr_count;          /*!< number of SRs we've sent */
283         unsigned int lastsrtxcount;     /*!< Transmit packet count when last SR sent */
284         double accumulated_transit;     /*!< accumulated a-dlsr-lsr */
285         double rtt;                     /*!< Last reported rtt */
286         unsigned int reported_jitter;   /*!< The contents of their last jitter entry in the RR */
287         unsigned int reported_lost;     /*!< Reported lost packets in their RR */
288
289         double reported_maxjitter;
290         double reported_minjitter;
291         double reported_normdev_jitter;
292         double reported_stdev_jitter;
293         unsigned int reported_jitter_count;
294
295         double reported_maxlost;
296         double reported_minlost;
297         double reported_normdev_lost;
298         double reported_stdev_lost;
299
300         double rxlost;
301         double maxrxlost;
302         double minrxlost;
303         double normdev_rxlost;
304         double stdev_rxlost;
305         unsigned int rxlost_count;
306
307         double maxrxjitter;
308         double minrxjitter;
309         double normdev_rxjitter;
310         double stdev_rxjitter;
311         unsigned int rxjitter_count;
312         double maxrtt;
313         double minrtt;
314         double normdevrtt;
315         double stdevrtt;
316         unsigned int rtt_count;
317 };
318
319 struct rtp_red {
320         struct ast_frame t140;  /*!< Primary data  */
321         struct ast_frame t140red;   /*!< Redundant t140*/
322         unsigned char pt[AST_RED_MAX_GENERATION];  /*!< Payload types for redundancy data */
323         unsigned char ts[AST_RED_MAX_GENERATION]; /*!< Time stamps */
324         unsigned char len[AST_RED_MAX_GENERATION]; /*!< length of each generation */
325         int num_gen; /*!< Number of generations */
326         int schedid; /*!< Timer id */
327         int ti; /*!< How long to buffer data before send */
328         unsigned char t140red_data[64000];
329         unsigned char buf_data[64000]; /*!< buffered primary data */
330         int hdrlen;
331         long int prev_ts;
332 };
333
334 AST_LIST_HEAD_NOLOCK(frame_list, ast_frame);
335
336 /* Forward Declarations */
337 static int ast_rtp_new(struct ast_rtp_instance *instance, struct ast_sched_context *sched, struct ast_sockaddr *addr, void *data);
338 static int ast_rtp_destroy(struct ast_rtp_instance *instance);
339 static int ast_rtp_dtmf_begin(struct ast_rtp_instance *instance, char digit);
340 static int ast_rtp_dtmf_end(struct ast_rtp_instance *instance, char digit);
341 static int ast_rtp_dtmf_end_with_duration(struct ast_rtp_instance *instance, char digit, unsigned int duration);
342 static int ast_rtp_dtmf_mode_set(struct ast_rtp_instance *instance, enum ast_rtp_dtmf_mode dtmf_mode);
343 static enum ast_rtp_dtmf_mode ast_rtp_dtmf_mode_get(struct ast_rtp_instance *instance);
344 static void ast_rtp_update_source(struct ast_rtp_instance *instance);
345 static void ast_rtp_change_source(struct ast_rtp_instance *instance);
346 static int ast_rtp_write(struct ast_rtp_instance *instance, struct ast_frame *frame);
347 static struct ast_frame *ast_rtp_read(struct ast_rtp_instance *instance, int rtcp);
348 static void ast_rtp_prop_set(struct ast_rtp_instance *instance, enum ast_rtp_property property, int value);
349 static int ast_rtp_fd(struct ast_rtp_instance *instance, int rtcp);
350 static void ast_rtp_remote_address_set(struct ast_rtp_instance *instance, struct ast_sockaddr *addr);
351 static void ast_rtp_alt_remote_address_set(struct ast_rtp_instance *instance, struct ast_sockaddr *addr);
352 static int rtp_red_init(struct ast_rtp_instance *instance, int buffer_time, int *payloads, int generations);
353 static int rtp_red_buffer(struct ast_rtp_instance *instance, struct ast_frame *frame);
354 static int ast_rtp_local_bridge(struct ast_rtp_instance *instance0, struct ast_rtp_instance *instance1);
355 static int ast_rtp_get_stat(struct ast_rtp_instance *instance, struct ast_rtp_instance_stats *stats, enum ast_rtp_instance_stat stat);
356 static int ast_rtp_dtmf_compatible(struct ast_channel *chan0, struct ast_rtp_instance *instance0, struct ast_channel *chan1, struct ast_rtp_instance *instance1);
357 static void ast_rtp_stun_request(struct ast_rtp_instance *instance, struct ast_sockaddr *suggestion, const char *username);
358 static void ast_rtp_stop(struct ast_rtp_instance *instance);
359 static int ast_rtp_qos_set(struct ast_rtp_instance *instance, int tos, int cos, const char* desc);
360 static int ast_rtp_sendcng(struct ast_rtp_instance *instance, int level);
361
362 /*! \brief Destructor for locally created ICE candidates */
363 static void ast_rtp_ice_candidate_destroy(void *obj)
364 {
365         struct ast_rtp_engine_ice_candidate *candidate = obj;
366
367         if (candidate->foundation) {
368                 ast_free(candidate->foundation);
369         }
370
371         if (candidate->transport) {
372                 ast_free(candidate->transport);
373         }
374 }
375
376 static void ast_rtp_ice_set_authentication(struct ast_rtp_instance *instance, const char *ufrag, const char *password)
377 {
378         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
379
380         if (!ast_strlen_zero(ufrag)) {
381                 ast_copy_string(rtp->remote_ufrag, ufrag, sizeof(rtp->remote_ufrag));
382         }
383
384         if (!ast_strlen_zero(password)) {
385                 ast_copy_string(rtp->remote_passwd, password, sizeof(rtp->remote_passwd));
386         }
387 }
388
389 static void ast_rtp_ice_add_remote_candidate(struct ast_rtp_instance *instance, const struct ast_rtp_engine_ice_candidate *candidate)
390 {
391         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
392         struct ast_rtp_engine_ice_candidate *remote_candidate;
393
394         if (!rtp->remote_candidates && !(rtp->remote_candidates = ao2_container_alloc(1, NULL, NULL))) {
395                 return;
396         }
397
398         /* If this is going to exceed the maximum number of ICE candidates don't even add it */
399         if (ao2_container_count(rtp->remote_candidates) == PJ_ICE_MAX_CAND) {
400                 return;
401         }
402
403         if (!(remote_candidate = ao2_alloc(sizeof(*remote_candidate), ast_rtp_ice_candidate_destroy))) {
404                 return;
405         }
406
407         remote_candidate->foundation = ast_strdup(candidate->foundation);
408         remote_candidate->id = candidate->id;
409         remote_candidate->transport = ast_strdup(candidate->transport);
410         remote_candidate->priority = candidate->priority;
411         ast_sockaddr_copy(&remote_candidate->address, &candidate->address);
412         ast_sockaddr_copy(&remote_candidate->relay_address, &candidate->relay_address);
413         remote_candidate->type = candidate->type;
414
415         ao2_link(rtp->remote_candidates, remote_candidate);
416         ao2_ref(remote_candidate, -1);
417 }
418
419 AST_THREADSTORAGE(pj_thread_storage);
420
421 /*! \brief Function used to check if the calling thread is registered with pjlib. If it is not it will be registered. */
422 static void pj_thread_register_check(void)
423 {
424         pj_thread_desc *desc;
425         pj_thread_t *thread;
426
427         if (pj_thread_is_registered() == PJ_TRUE) {
428                 return;
429         }
430
431         desc = ast_threadstorage_get(&pj_thread_storage, sizeof(pj_thread_desc));
432         if (!desc) {
433                 ast_log(LOG_ERROR, "Could not get thread desc from thread-local storage. Expect awful things to occur\n");
434                 return;
435         }
436         pj_bzero(*desc, sizeof(*desc));
437
438         if (pj_thread_register("Asterisk Thread", *desc, &thread) != PJ_SUCCESS) {
439                 ast_log(LOG_ERROR, "Coudln't register thread with PJLIB.\n");
440         }
441         return;
442 }
443
444 /*! \brief Helper function which updates an ast_sockaddr with the candidate used for the component */
445 static void update_address_with_ice_candidate(struct ast_rtp *rtp, int component, struct ast_sockaddr *cand_address)
446 {
447         char address[PJ_INET6_ADDRSTRLEN];
448
449         if (!rtp->ice || (component < 1) || !rtp->ice->comp[component - 1].valid_check) {
450                 return;
451         }
452
453         ast_sockaddr_parse(cand_address, pj_sockaddr_print(&rtp->ice->comp[component - 1].valid_check->rcand->addr, address, sizeof(address), 0), 0);
454         ast_sockaddr_set_port(cand_address, pj_sockaddr_get_port(&rtp->ice->comp[component - 1].valid_check->rcand->addr));
455 }
456
457 static void ast_rtp_ice_start(struct ast_rtp_instance *instance)
458 {
459         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
460         pj_str_t ufrag = pj_str(rtp->remote_ufrag), passwd = pj_str(rtp->remote_passwd);
461         pj_ice_sess_cand candidates[PJ_ICE_MAX_CAND];
462         struct ao2_iterator i;
463         struct ast_rtp_engine_ice_candidate *candidate;
464         int cand_cnt = 0;
465
466         if (!rtp->ice || !rtp->remote_candidates || rtp->ice_started) {
467                 return;
468         }
469
470         pj_thread_register_check();
471
472         i = ao2_iterator_init(rtp->remote_candidates, 0);
473
474         while ((candidate = ao2_iterator_next(&i)) && (cand_cnt < PJ_ICE_MAX_CAND)) {
475                 pj_str_t address;
476
477                 pj_strdup2(rtp->ice->pool, &candidates[cand_cnt].foundation, candidate->foundation);
478                 candidates[cand_cnt].comp_id = candidate->id;
479                 candidates[cand_cnt].prio = candidate->priority;
480
481                 pj_sockaddr_parse(pj_AF_UNSPEC(), 0, pj_cstr(&address, ast_sockaddr_stringify(&candidate->address)), &candidates[cand_cnt].addr);
482
483                 if (!ast_sockaddr_isnull(&candidate->relay_address)) {
484                         pj_sockaddr_parse(pj_AF_UNSPEC(), 0, pj_cstr(&address, ast_sockaddr_stringify(&candidate->relay_address)), &candidates[cand_cnt].rel_addr);
485                 }
486
487                 if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_HOST) {
488                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_HOST;
489                 } else if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_SRFLX) {
490                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_SRFLX;
491                 } else if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_RELAYED) {
492                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_RELAYED;
493                 }
494
495                 if (candidate->id == COMPONENT_RTP && rtp->turn_rtp) {
496                         pj_turn_sock_set_perm(rtp->turn_rtp, 1, &candidates[cand_cnt].addr, 1);
497                 } else if (candidate->id == COMPONENT_RTCP && rtp->turn_rtcp) {
498                         pj_turn_sock_set_perm(rtp->turn_rtcp, 1, &candidates[cand_cnt].addr, 1);
499                 }
500
501                 cand_cnt++;
502         }
503
504         ao2_iterator_destroy(&i);
505
506         if (pj_ice_sess_create_check_list(rtp->ice, &ufrag, &passwd, ao2_container_count(rtp->remote_candidates), &candidates[0]) == PJ_SUCCESS) {
507                 pj_ice_sess_start_check(rtp->ice);
508                 pj_timer_heap_poll(timerheap, NULL);
509                 rtp->ice_started = 1;
510         }
511 }
512
513 static void ast_rtp_ice_stop(struct ast_rtp_instance *instance)
514 {
515         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
516
517         if (!rtp->ice) {
518                 return;
519         }
520
521         pj_thread_register_check();
522
523         pj_ice_sess_destroy(rtp->ice);
524         rtp->ice = NULL;
525 }
526
527 static const char *ast_rtp_ice_get_ufrag(struct ast_rtp_instance *instance)
528 {
529         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
530
531         return rtp->local_ufrag;
532 }
533
534 static const char *ast_rtp_ice_get_password(struct ast_rtp_instance *instance)
535 {
536         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
537
538         return rtp->local_passwd;
539 }
540
541 static struct ao2_container *ast_rtp_ice_get_local_candidates(struct ast_rtp_instance *instance)
542 {
543         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
544
545         if (rtp->local_candidates) {
546                 ao2_ref(rtp->local_candidates, +1);
547         }
548
549         return rtp->local_candidates;
550 }
551
552 static void ast_rtp_ice_lite(struct ast_rtp_instance *instance)
553 {
554         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
555
556         if (!rtp->ice) {
557                 return;
558         }
559
560         pj_thread_register_check();
561
562         pj_ice_sess_change_role(rtp->ice, PJ_ICE_SESS_ROLE_CONTROLLING);
563 }
564
565 static int ice_candidate_cmp(void *obj, void *arg, int flags)
566 {
567         struct ast_rtp_engine_ice_candidate *candidate1 = obj, *candidate2 = arg;
568
569         if ((strcmp(candidate1->foundation, candidate2->foundation)) ||
570             (candidate1->id != candidate2->id) ||
571             (ast_sockaddr_cmp(&candidate1->address, &candidate2->address)) ||
572             (candidate1->type != candidate1->type)) {
573                 return 0;
574         }
575
576         return CMP_MATCH | CMP_STOP;
577 }
578
579 static void ast_rtp_ice_add_cand(struct ast_rtp *rtp, unsigned comp_id, unsigned transport_id, pj_ice_cand_type type, pj_uint16_t local_pref,
580                                         const pj_sockaddr_t *addr, const pj_sockaddr_t *base_addr, const pj_sockaddr_t *rel_addr, int addr_len)
581 {
582         pj_str_t foundation;
583         struct ast_rtp_engine_ice_candidate *candidate, *existing;
584         char address[PJ_INET6_ADDRSTRLEN];
585
586         pj_thread_register_check();
587
588         pj_ice_calc_foundation(rtp->ice->pool, &foundation, type, addr);
589
590         if (!rtp->local_candidates && !(rtp->local_candidates = ao2_container_alloc(1, NULL, ice_candidate_cmp))) {
591                 return;
592         }
593
594         if (!(candidate = ao2_alloc(sizeof(*candidate), ast_rtp_ice_candidate_destroy))) {
595                 return;
596         }
597
598         candidate->foundation = ast_strndup(pj_strbuf(&foundation), pj_strlen(&foundation));
599         candidate->id = comp_id;
600         candidate->transport = ast_strdup("UDP");
601
602         ast_sockaddr_parse(&candidate->address, pj_sockaddr_print(addr, address, sizeof(address), 0), 0);
603         ast_sockaddr_set_port(&candidate->address, pj_sockaddr_get_port(addr));
604
605         if (rel_addr) {
606                 ast_sockaddr_parse(&candidate->relay_address, pj_sockaddr_print(rel_addr, address, sizeof(address), 0), 0);
607                 ast_sockaddr_set_port(&candidate->relay_address, pj_sockaddr_get_port(rel_addr));
608         }
609
610         if (type == PJ_ICE_CAND_TYPE_HOST) {
611                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_HOST;
612         } else if (type == PJ_ICE_CAND_TYPE_SRFLX) {
613                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_SRFLX;
614         } else if (type == PJ_ICE_CAND_TYPE_RELAYED) {
615                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_RELAYED;
616         }
617
618         if ((existing = ao2_find(rtp->local_candidates, candidate, OBJ_POINTER))) {
619                 ao2_ref(existing, -1);
620                 ao2_ref(candidate, -1);
621                 return;
622         }
623
624         if (pj_ice_sess_add_cand(rtp->ice, comp_id, transport_id, type, local_pref, &foundation, addr, addr, rel_addr, addr_len, NULL) != PJ_SUCCESS) {
625                 ao2_ref(candidate, -1);
626                 return;
627         }
628
629         /* By placing the candidate into the ICE session it will have produced the priority, so update the local candidate with it */
630         candidate->priority = rtp->ice->lcand[rtp->ice->lcand_cnt - 1].prio;
631
632         ao2_link(rtp->local_candidates, candidate);
633         ao2_ref(candidate, -1);
634 }
635
636 static char *generate_random_string(char *buf, size_t size)
637 {
638         long val[4];
639         int x;
640
641         for (x=0; x<4; x++)
642                 val[x] = ast_random();
643         snprintf(buf, size, "%08lx%08lx%08lx%08lx", val[0], val[1], val[2], val[3]);
644
645         return buf;
646 }
647
648 /* ICE RTP Engine interface declaration */
649 static struct ast_rtp_engine_ice ast_rtp_ice = {
650         .set_authentication = ast_rtp_ice_set_authentication,
651         .add_remote_candidate = ast_rtp_ice_add_remote_candidate,
652         .start = ast_rtp_ice_start,
653         .stop = ast_rtp_ice_stop,
654         .get_ufrag = ast_rtp_ice_get_ufrag,
655         .get_password = ast_rtp_ice_get_password,
656         .get_local_candidates = ast_rtp_ice_get_local_candidates,
657         .ice_lite = ast_rtp_ice_lite,
658 };
659
660 /* RTP Engine Declaration */
661 static struct ast_rtp_engine asterisk_rtp_engine = {
662         .name = "asterisk",
663         .new = ast_rtp_new,
664         .destroy = ast_rtp_destroy,
665         .dtmf_begin = ast_rtp_dtmf_begin,
666         .dtmf_end = ast_rtp_dtmf_end,
667         .dtmf_end_with_duration = ast_rtp_dtmf_end_with_duration,
668         .dtmf_mode_set = ast_rtp_dtmf_mode_set,
669         .dtmf_mode_get = ast_rtp_dtmf_mode_get,
670         .update_source = ast_rtp_update_source,
671         .change_source = ast_rtp_change_source,
672         .write = ast_rtp_write,
673         .read = ast_rtp_read,
674         .prop_set = ast_rtp_prop_set,
675         .fd = ast_rtp_fd,
676         .remote_address_set = ast_rtp_remote_address_set,
677         .alt_remote_address_set = ast_rtp_alt_remote_address_set,
678         .red_init = rtp_red_init,
679         .red_buffer = rtp_red_buffer,
680         .local_bridge = ast_rtp_local_bridge,
681         .get_stat = ast_rtp_get_stat,
682         .dtmf_compatible = ast_rtp_dtmf_compatible,
683         .stun_request = ast_rtp_stun_request,
684         .stop = ast_rtp_stop,
685         .qos = ast_rtp_qos_set,
686         .sendcng = ast_rtp_sendcng,
687         .ice = &ast_rtp_ice,
688 };
689
690 static void ast_rtp_on_ice_rx_data(pj_ice_sess *ice, unsigned comp_id, unsigned transport_id, void *pkt, pj_size_t size, const pj_sockaddr_t *src_addr, unsigned src_addr_len)
691 {
692         struct ast_rtp *rtp = ice->user_data;
693
694         /* Instead of handling the packet here (which really doesn't work with our architecture) we set a bit to indicate that it should be handled after pj_ice_sess_on_rx_pkt
695          * returns */
696         rtp->passthrough = 1;
697 }
698
699 static pj_status_t ast_rtp_on_ice_tx_pkt(pj_ice_sess *ice, unsigned comp_id, unsigned transport_id, const void *pkt, pj_size_t size, const pj_sockaddr_t *dst_addr, unsigned dst_addr_len)
700 {
701         struct ast_rtp *rtp = ice->user_data;
702         pj_status_t status = PJ_EINVALIDOP;
703
704         if (transport_id == TRANSPORT_SOCKET_RTP) {
705                 /* Traffic is destined to go right out the RTP socket we already have */
706                 status = pj_sock_sendto(rtp->s, pkt, (pj_ssize_t*)&size, 0, dst_addr, dst_addr_len);
707         } else if (transport_id == TRANSPORT_SOCKET_RTCP) {
708                 /* Traffic is destined to go right out the RTCP socket we already have */
709                 if (rtp->rtcp) {
710                         status = pj_sock_sendto(rtp->rtcp->s, pkt, (pj_ssize_t*)&size, 0, dst_addr, dst_addr_len);
711                 } else {
712                         status = PJ_SUCCESS;
713                 }
714         } else if (transport_id == TRANSPORT_TURN_RTP) {
715                 /* Traffic is going through the RTP TURN relay */
716                 if (rtp->turn_rtp) {
717                         status = pj_turn_sock_sendto(rtp->turn_rtp, pkt, size, dst_addr, dst_addr_len);
718                 }
719         } else if (transport_id == TRANSPORT_TURN_RTCP) {
720                 /* Traffic is going through the RTCP TURN relay */
721                 if (rtp->turn_rtcp) {
722                         status = pj_turn_sock_sendto(rtp->turn_rtcp, pkt, size, dst_addr, dst_addr_len);
723                 }
724         }
725
726         return status;
727 }
728
729 /* ICE Session interface declaration */
730 static pj_ice_sess_cb ast_rtp_ice_sess_cb = {
731         .on_rx_data = ast_rtp_on_ice_rx_data,
732         .on_tx_pkt = ast_rtp_on_ice_tx_pkt,
733 };
734
735 static void ast_rtp_on_turn_rx_rtp_data(pj_turn_sock *turn_sock, void *pkt, unsigned pkt_len, const pj_sockaddr_t *peer_addr, unsigned addr_len)
736 {
737         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
738         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
739         struct ast_sockaddr dest = { { 0, }, };
740
741         ast_rtp_instance_get_local_address(instance, &dest);
742
743         ast_sendto(rtp->s, pkt, pkt_len, 0, &dest);
744 }
745
746 static void ast_rtp_on_turn_rtp_state(pj_turn_sock *turn_sock, pj_turn_state_t old_state, pj_turn_state_t new_state)
747 {
748         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
749         struct ast_rtp *rtp = NULL;
750
751         /* If this is a leftover from an already destroyed RTP instance just ignore the state change */
752         if (!instance) {
753                 return;
754         }
755
756         rtp = ast_rtp_instance_get_data(instance);
757
758         /* If the TURN session is being destroyed we need to remove it from the RTP instance */
759         if (new_state == PJ_TURN_STATE_DESTROYING) {
760                 rtp->turn_rtp = NULL;
761                 return;
762         }
763
764         /* We store the new state so the other thread can actually handle it */
765         ast_mutex_lock(&rtp->lock);
766         rtp->turn_state = new_state;
767
768         /* If this is a state that the main thread should be notified about do so */
769         if (new_state == PJ_TURN_STATE_READY || new_state == PJ_TURN_STATE_DEALLOCATING || new_state == PJ_TURN_STATE_DEALLOCATED) {
770                 ast_cond_signal(&rtp->cond);
771         }
772
773         ast_mutex_unlock(&rtp->lock);
774 }
775
776 /* RTP TURN Socket interface declaration */
777 static pj_turn_sock_cb ast_rtp_turn_rtp_sock_cb = {
778         .on_rx_data = ast_rtp_on_turn_rx_rtp_data,
779         .on_state = ast_rtp_on_turn_rtp_state,
780 };
781
782 static void ast_rtp_on_turn_rx_rtcp_data(pj_turn_sock *turn_sock, void *pkt, unsigned pkt_len, const pj_sockaddr_t *peer_addr, unsigned addr_len)
783 {
784         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
785         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
786
787         ast_sendto(rtp->rtcp->s, pkt, pkt_len, 0, &rtp->rtcp->us);
788 }
789
790 static void ast_rtp_on_turn_rtcp_state(pj_turn_sock *turn_sock, pj_turn_state_t old_state, pj_turn_state_t new_state)
791 {
792         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
793         struct ast_rtp *rtp = NULL;
794
795         /* If this is a leftover from an already destroyed RTP instance just ignore the state change */
796         if (!instance) {
797                 return;
798         }
799
800         rtp = ast_rtp_instance_get_data(instance);
801
802         /* If the TURN session is being destroyed we need to remove it from the RTP instance */
803         if (new_state == PJ_TURN_STATE_DESTROYING) {
804                 rtp->turn_rtcp = NULL;
805                 return;
806         }
807
808         /* We store the new state so the other thread can actually handle it */
809         ast_mutex_lock(&rtp->lock);
810         rtp->turn_state = new_state;
811
812         /* If this is a state that the main thread should be notified about do so */
813         if (new_state == PJ_TURN_STATE_READY || new_state == PJ_TURN_STATE_DEALLOCATING || new_state == PJ_TURN_STATE_DEALLOCATED) {
814                 ast_cond_signal(&rtp->cond);
815         }
816
817        ast_mutex_unlock(&rtp->lock);
818 }
819
820 /* RTCP TURN Socket interface declaration */
821 static pj_turn_sock_cb ast_rtp_turn_rtcp_sock_cb = {
822         .on_rx_data = ast_rtp_on_turn_rx_rtcp_data,
823         .on_state = ast_rtp_on_turn_rtcp_state,
824 };
825
826 /*! \brief Worker thread for I/O queue and timerheap */
827 static int ice_worker_thread(void *data)
828 {
829         while (!worker_terminate) {
830                 const pj_time_val delay = {0, 10};
831
832                 pj_ioqueue_poll(ioqueue, &delay);
833
834                 pj_timer_heap_poll(timerheap, NULL);
835         }
836
837         return 0;
838 }
839
840 static inline int rtp_debug_test_addr(struct ast_sockaddr *addr)
841 {
842         if (!rtpdebug) {
843                 return 0;
844         }
845         if (!ast_sockaddr_isnull(&rtpdebugaddr)) {
846                 if (rtpdebugport) {
847                         return (ast_sockaddr_cmp(&rtpdebugaddr, addr) == 0); /* look for RTP packets from IP+Port */
848                 } else {
849                         return (ast_sockaddr_cmp_addr(&rtpdebugaddr, addr) == 0); /* only look for RTP packets from IP */
850                 }
851         }
852
853         return 1;
854 }
855
856 static inline int rtcp_debug_test_addr(struct ast_sockaddr *addr)
857 {
858         if (!rtcpdebug) {
859                 return 0;
860         }
861         if (!ast_sockaddr_isnull(&rtcpdebugaddr)) {
862                 if (rtcpdebugport) {
863                         return (ast_sockaddr_cmp(&rtcpdebugaddr, addr) == 0); /* look for RTCP packets from IP+Port */
864                 } else {
865                         return (ast_sockaddr_cmp_addr(&rtcpdebugaddr, addr) == 0); /* only look for RTCP packets from IP */
866                 }
867         }
868
869         return 1;
870 }
871
872 static int __rtp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int rtcp)
873 {
874         int len;
875         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
876         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance);
877
878         if ((len = ast_recvfrom(rtcp ? rtp->rtcp->s : rtp->s, buf, size, flags, sa)) < 0) {
879            return len;
880         }
881
882         if (rtp->ice) {
883                 pj_str_t combined = pj_str(ast_sockaddr_stringify(sa));
884                 pj_sockaddr address;
885
886                 pj_thread_register_check();
887
888                 pj_sockaddr_parse(pj_AF_UNSPEC(), 0, &combined, &address);
889
890                 if (pj_ice_sess_on_rx_pkt(rtp->ice, rtcp ? COMPONENT_RTCP : COMPONENT_RTP, rtcp ? TRANSPORT_SOCKET_RTCP : TRANSPORT_SOCKET_RTP,
891                                           buf, len, &address, pj_sockaddr_get_len(&address)) != PJ_SUCCESS) {
892                         return -1;
893                 }
894                 if (!rtp->passthrough) {
895                         return 0;
896                 }
897                 rtp->passthrough = 0;
898         }
899
900         if (res_srtp && srtp && res_srtp->unprotect(srtp, buf, &len, rtcp) < 0) {
901            return -1;
902         }
903
904         return len;
905 }
906
907 static int rtcp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa)
908 {
909         return __rtp_recvfrom(instance, buf, size, flags, sa, 1);
910 }
911
912 static int rtp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa)
913 {
914         return __rtp_recvfrom(instance, buf, size, flags, sa, 0);
915 }
916
917 static int __rtp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int rtcp, int *ice)
918 {
919         int len = size;
920         void *temp = buf;
921         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
922         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance);
923
924         *ice = 0;
925
926         if (res_srtp && srtp && res_srtp->protect(srtp, &temp, &len, rtcp) < 0) {
927                 return -1;
928         }
929
930         if (rtp->ice) {
931                 pj_thread_register_check();
932
933                 if (pj_ice_sess_send_data(rtp->ice, rtcp ? COMPONENT_RTCP : COMPONENT_RTP, temp, len) == PJ_SUCCESS) {
934                         *ice = 1;
935                         return 0;
936                 }
937         }
938
939         return ast_sendto(rtcp ? rtp->rtcp->s : rtp->s, temp, len, flags, sa);
940 }
941
942 static int rtcp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int *ice)
943 {
944         return __rtp_sendto(instance, buf, size, flags, sa, 1, ice);
945 }
946
947 static int rtp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int *ice)
948 {
949         return __rtp_sendto(instance, buf, size, flags, sa, 0, ice);
950 }
951
952 static int rtp_get_rate(struct ast_format *format)
953 {
954         return (format->id == AST_FORMAT_G722) ? 8000 : ast_format_rate(format);
955 }
956
957 static unsigned int ast_rtcp_calc_interval(struct ast_rtp *rtp)
958 {
959         unsigned int interval;
960         /*! \todo XXX Do a more reasonable calculation on this one
961          * Look in RFC 3550 Section A.7 for an example*/
962         interval = rtcpinterval;
963         return interval;
964 }
965
966 /*! \brief Calculate normal deviation */
967 static double normdev_compute(double normdev, double sample, unsigned int sample_count)
968 {
969         normdev = normdev * sample_count + sample;
970         sample_count++;
971
972         return normdev / sample_count;
973 }
974
975 static double stddev_compute(double stddev, double sample, double normdev, double normdev_curent, unsigned int sample_count)
976 {
977 /*
978                 for the formula check http://www.cs.umd.edu/~austinjp/constSD.pdf
979                 return sqrt( (sample_count*pow(stddev,2) + sample_count*pow((sample-normdev)/(sample_count+1),2) + pow(sample-normdev_curent,2)) / (sample_count+1));
980                 we can compute the sigma^2 and that way we would have to do the sqrt only 1 time at the end and would save another pow 2 compute
981                 optimized formula
982 */
983 #define SQUARE(x) ((x) * (x))
984
985         stddev = sample_count * stddev;
986         sample_count++;
987
988         return stddev +
989                 ( sample_count * SQUARE( (sample - normdev) / sample_count ) ) +
990                 ( SQUARE(sample - normdev_curent) / sample_count );
991
992 #undef SQUARE
993 }
994
995 static int create_new_socket(const char *type, int af)
996 {
997         int sock = socket(af, SOCK_DGRAM, 0);
998
999         if (sock < 0) {
1000                 if (!type) {
1001                         type = "RTP/RTCP";
1002                 }
1003                 ast_log(LOG_WARNING, "Unable to allocate %s socket: %s\n", type, strerror(errno));
1004         } else {
1005                 long flags = fcntl(sock, F_GETFL);
1006                 fcntl(sock, F_SETFL, flags | O_NONBLOCK);
1007 #ifdef SO_NO_CHECK
1008                 if (nochecksums) {
1009                         setsockopt(sock, SOL_SOCKET, SO_NO_CHECK, &nochecksums, sizeof(nochecksums));
1010                 }
1011 #endif
1012         }
1013
1014         return sock;
1015 }
1016
1017 /*!
1018  * \internal
1019  * \brief Initializes sequence values and probation for learning mode.
1020  * \note This is an adaptation of pjmedia's pjmedia_rtp_seq_init function.
1021  *
1022  * \param rtp pointer to rtp struct used with the received rtp packet.
1023  * \param seq sequence number read from the rtp header
1024  */
1025 static void rtp_learning_seq_init(struct ast_rtp *rtp, uint16_t seq)
1026 {
1027         rtp->learning_max_seq = seq - 1;
1028         rtp->learning_probation = learning_min_sequential;
1029 }
1030
1031 /*!
1032  * \internal
1033  * \brief Updates sequence information for learning mode and determines if probation/learning mode should remain in effect.
1034  * \note This function was adapted from pjmedia's pjmedia_rtp_seq_update function.
1035  *
1036  * \param rtp pointer to rtp struct used with the received rtp packet.
1037  * \param seq sequence number read from the rtp header
1038  * \return boolean value indicating if probation mode is active at the end of the function
1039  */
1040 static int rtp_learning_rtp_seq_update(struct ast_rtp *rtp, uint16_t seq)
1041 {
1042         int probation = 1;
1043
1044         ast_debug(1, "%p -- probation = %d, seq = %d\n", rtp, rtp->learning_probation, seq);
1045
1046         if (seq == rtp->learning_max_seq + 1) {
1047                 /* packet is in sequence */
1048                 rtp->learning_probation--;
1049                 rtp->learning_max_seq = seq;
1050                 if (rtp->learning_probation == 0) {
1051                         probation = 0;
1052                 }
1053         } else {
1054                 rtp->learning_probation = learning_min_sequential - 1;
1055                 rtp->learning_max_seq = seq;
1056         }
1057
1058         return probation;
1059 }
1060
1061 static void rtp_add_candidates_to_ice(struct ast_rtp_instance *instance, struct ast_rtp *rtp, struct ast_sockaddr *addr, int port, int component,
1062                                       int transport, const pj_turn_sock_cb *turn_cb, pj_turn_sock **turn_sock)
1063 {
1064         pj_sockaddr address[16];
1065         unsigned int count = PJ_ARRAY_SIZE(address), pos = 0;
1066
1067         /* Add all the local interface IP addresses */
1068         pj_enum_ip_interface(ast_sockaddr_is_ipv4(addr) ? pj_AF_INET() : pj_AF_INET6(), &count, address);
1069
1070         for (pos = 0; pos < count; pos++) {
1071                 pj_sockaddr_set_port(&address[pos], port);
1072                 ast_rtp_ice_add_cand(rtp, component, transport, PJ_ICE_CAND_TYPE_HOST, 65535, &address[pos], &address[pos], NULL,
1073                                      pj_sockaddr_get_len(&address[pos]));
1074         }
1075
1076         /* If configured to use a STUN server to get our external mapped address do so */
1077         if (stunaddr.sin_addr.s_addr && ast_sockaddr_is_ipv4(addr)) {
1078                 struct sockaddr_in answer;
1079
1080                 if (!ast_stun_request(rtp->s, &stunaddr, NULL, &answer)) {
1081                         pj_str_t mapped = pj_str(ast_strdupa(ast_inet_ntoa(answer.sin_addr)));
1082
1083                         pj_sockaddr_init(pj_AF_INET(), &address[0], &mapped, ntohs(answer.sin_port));
1084
1085                         ast_rtp_ice_add_cand(rtp, component, transport, PJ_ICE_CAND_TYPE_SRFLX, 65535, &address[0], &address[0],
1086                                              NULL, pj_sockaddr_get_len(&address[0]));
1087                 }
1088         }
1089
1090         /* If configured to use a TURN relay create a session and allocate */
1091         if (pj_strlen(&turnaddr) && pj_turn_sock_create(&rtp->ice->stun_cfg, ast_sockaddr_is_ipv4(addr) ? pj_AF_INET() : pj_AF_INET6(), PJ_TURN_TP_TCP,
1092                                                         turn_cb, NULL, instance, turn_sock) == PJ_SUCCESS) {
1093                 pj_stun_auth_cred cred = { 0, };
1094                 struct timeval wait = ast_tvadd(ast_tvnow(), ast_samp2tv(TURN_ALLOCATION_WAIT_TIME, 1000));
1095                 struct timespec ts = { .tv_sec = wait.tv_sec, .tv_nsec = wait.tv_usec * 1000, };
1096
1097                 cred.type = PJ_STUN_AUTH_CRED_STATIC;
1098                 cred.data.static_cred.username = turnusername;
1099                 cred.data.static_cred.data_type = PJ_STUN_PASSWD_PLAIN;
1100                 cred.data.static_cred.data = turnpassword;
1101
1102                 /* Because the TURN socket is asynchronous but we are synchronous we need to wait until it is done */
1103                 ast_mutex_lock(&rtp->lock);
1104                 pj_turn_sock_alloc(*turn_sock, &turnaddr, turnport, NULL, &cred, NULL);
1105                 ast_cond_timedwait(&rtp->cond, &rtp->lock, &ts);
1106                 ast_mutex_unlock(&rtp->lock);
1107
1108                 /* If a TURN session was allocated add it as a candidate */
1109                 if (rtp->turn_state == PJ_TURN_STATE_READY) {
1110                         pj_turn_session_info info;
1111
1112                         pj_turn_sock_get_info(*turn_sock, &info);
1113
1114                         if (transport == TRANSPORT_SOCKET_RTP) {
1115                                 transport = TRANSPORT_TURN_RTP;
1116                         } else if (transport == TRANSPORT_SOCKET_RTCP) {
1117                                 transport = TRANSPORT_TURN_RTCP;
1118                         }
1119
1120                         ast_rtp_ice_add_cand(rtp, component, transport, PJ_ICE_CAND_TYPE_RELAYED, 65535, &info.relay_addr, &info.relay_addr,
1121                                              NULL, pj_sockaddr_get_len(&info.relay_addr));
1122                 }
1123         }
1124 }
1125
1126 static int ast_rtp_new(struct ast_rtp_instance *instance,
1127                        struct ast_sched_context *sched, struct ast_sockaddr *addr,
1128                        void *data)
1129 {
1130         struct ast_rtp *rtp = NULL;
1131         int x, startplace;
1132         pj_stun_config stun_config;
1133         pj_str_t ufrag, passwd;
1134
1135         /* Create a new RTP structure to hold all of our data */
1136         if (!(rtp = ast_calloc(1, sizeof(*rtp)))) {
1137                 return -1;
1138         }
1139
1140         /* Initialize synchronization aspects */
1141         ast_mutex_init(&rtp->lock);
1142         ast_cond_init(&rtp->cond, NULL);
1143
1144         /* Set default parameters on the newly created RTP structure */
1145         rtp->ssrc = ast_random();
1146         rtp->seqno = ast_random() & 0xffff;
1147         rtp->strict_rtp_state = (strictrtp ? STRICT_RTP_LEARN : STRICT_RTP_OPEN);
1148         if (strictrtp) {
1149                 rtp_learning_seq_init(rtp, (uint16_t)rtp->seqno);
1150         }
1151
1152         /* Create a new socket for us to listen on and use */
1153         if ((rtp->s =
1154              create_new_socket("RTP",
1155                                ast_sockaddr_is_ipv4(addr) ? AF_INET  :
1156                                ast_sockaddr_is_ipv6(addr) ? AF_INET6 : -1)) < 0) {
1157                 ast_debug(1, "Failed to create a new socket for RTP instance '%p'\n", instance);
1158                 ast_free(rtp);
1159                 return -1;
1160         }
1161
1162         /* Now actually find a free RTP port to use */
1163         x = (rtpend == rtpstart) ? rtpstart : (ast_random() % (rtpend - rtpstart)) + rtpstart;
1164         x = x & ~1;
1165         startplace = x;
1166
1167         for (;;) {
1168                 ast_sockaddr_set_port(addr, x);
1169                 /* Try to bind, this will tell us whether the port is available or not */
1170                 if (!ast_bind(rtp->s, addr)) {
1171                         ast_debug(1, "Allocated port %d for RTP instance '%p'\n", x, instance);
1172                         ast_rtp_instance_set_local_address(instance, addr);
1173                         break;
1174                 }
1175
1176                 x += 2;
1177                 if (x > rtpend) {
1178                         x = (rtpstart + 1) & ~1;
1179                 }
1180
1181                 /* See if we ran out of ports or if the bind actually failed because of something other than the address being in use */
1182                 if (x == startplace || errno != EADDRINUSE) {
1183                         ast_log(LOG_ERROR, "Oh dear... we couldn't allocate a port for RTP instance '%p'\n", instance);
1184                         close(rtp->s);
1185                         ast_free(rtp);
1186                         return -1;
1187                 }
1188         }
1189
1190         pj_thread_register_check();
1191
1192         pj_stun_config_init(&stun_config, &cachingpool.factory, 0, ioqueue, timerheap);
1193
1194         generate_random_string(rtp->local_ufrag, sizeof(rtp->local_ufrag));
1195         ufrag = pj_str(rtp->local_ufrag);
1196         generate_random_string(rtp->local_passwd, sizeof(rtp->local_passwd));
1197         passwd = pj_str(rtp->local_passwd);
1198
1199         ast_rtp_instance_set_data(instance, rtp);
1200
1201         /* Create an ICE session for ICE negotiation */
1202         if (icesupport && pj_ice_sess_create(&stun_config, NULL, PJ_ICE_SESS_ROLE_UNKNOWN, 2, &ast_rtp_ice_sess_cb, &ufrag, &passwd, &rtp->ice) == PJ_SUCCESS) {
1203                 /* Make this available for the callbacks */
1204                 rtp->ice->user_data = rtp;
1205
1206                 /* Add all of the available candidates to the ICE session */
1207                 rtp_add_candidates_to_ice(instance, rtp, addr, x, COMPONENT_RTP, TRANSPORT_SOCKET_RTP, &ast_rtp_turn_rtp_sock_cb, &rtp->turn_rtp);
1208         }
1209
1210         /* Record any information we may need */
1211         rtp->sched = sched;
1212
1213         return 0;
1214 }
1215
1216 static int ast_rtp_destroy(struct ast_rtp_instance *instance)
1217 {
1218         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1219
1220         /* Destroy the smoother that was smoothing out audio if present */
1221         if (rtp->smoother) {
1222                 ast_smoother_free(rtp->smoother);
1223         }
1224
1225         /* Close our own socket so we no longer get packets */
1226         if (rtp->s > -1) {
1227                 close(rtp->s);
1228         }
1229
1230         /* Destroy RTCP if it was being used */
1231         if (rtp->rtcp) {
1232                 /*
1233                  * It is not possible for there to be an active RTCP scheduler
1234                  * entry at this point since it holds a reference to the
1235                  * RTP instance while it's active.
1236                  */
1237                 close(rtp->rtcp->s);
1238                 ast_free(rtp->rtcp);
1239         }
1240
1241         /* Destroy RED if it was being used */
1242         if (rtp->red) {
1243                 AST_SCHED_DEL(rtp->sched, rtp->red->schedid);
1244                 ast_free(rtp->red);
1245         }
1246
1247         pj_thread_register_check();
1248
1249         /* Destroy the ICE session if being used */
1250         if (rtp->ice) {
1251                 pj_ice_sess_destroy(rtp->ice);
1252         }
1253
1254         /* Destroy the RTP TURN relay if being used */
1255         if (rtp->turn_rtp) {
1256                 pj_turn_sock_set_user_data(rtp->turn_rtp, NULL);
1257                 pj_turn_sock_destroy(rtp->turn_rtp);
1258         }
1259
1260         /* Destroy the RTCP TURN relay if being used */
1261         if (rtp->turn_rtcp) {
1262                 pj_turn_sock_set_user_data(rtp->turn_rtcp, NULL);
1263                 pj_turn_sock_destroy(rtp->turn_rtcp);
1264         }
1265
1266         /* Destroy any candidates */
1267         if (rtp->local_candidates) {
1268                 ao2_ref(rtp->local_candidates, -1);
1269         }
1270
1271         if (rtp->remote_candidates) {
1272                 ao2_ref(rtp->remote_candidates, -1);
1273         }
1274
1275         /* Destroy synchronization items */
1276         ast_mutex_destroy(&rtp->lock);
1277         ast_cond_destroy(&rtp->cond);
1278
1279         /* Finally destroy ourselves */
1280         ast_free(rtp);
1281
1282         return 0;
1283 }
1284
1285 static int ast_rtp_dtmf_mode_set(struct ast_rtp_instance *instance, enum ast_rtp_dtmf_mode dtmf_mode)
1286 {
1287         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1288         rtp->dtmfmode = dtmf_mode;
1289         return 0;
1290 }
1291
1292 static enum ast_rtp_dtmf_mode ast_rtp_dtmf_mode_get(struct ast_rtp_instance *instance)
1293 {
1294         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1295         return rtp->dtmfmode;
1296 }
1297
1298 static int ast_rtp_dtmf_begin(struct ast_rtp_instance *instance, char digit)
1299 {
1300         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1301         struct ast_sockaddr remote_address = { {0,} };
1302         int hdrlen = 12, res = 0, i = 0, payload = 101;
1303         char data[256];
1304         unsigned int *rtpheader = (unsigned int*)data;
1305
1306         ast_rtp_instance_get_remote_address(instance, &remote_address);
1307
1308         /* If we have no remote address information bail out now */
1309         if (ast_sockaddr_isnull(&remote_address)) {
1310                 return -1;
1311         }
1312
1313         /* Convert given digit into what we want to transmit */
1314         if ((digit <= '9') && (digit >= '0')) {
1315                 digit -= '0';
1316         } else if (digit == '*') {
1317                 digit = 10;
1318         } else if (digit == '#') {
1319                 digit = 11;
1320         } else if ((digit >= 'A') && (digit <= 'D')) {
1321                 digit = digit - 'A' + 12;
1322         } else if ((digit >= 'a') && (digit <= 'd')) {
1323                 digit = digit - 'a' + 12;
1324         } else {
1325                 ast_log(LOG_WARNING, "Don't know how to represent '%c'\n", digit);
1326                 return -1;
1327         }
1328
1329         /* Grab the payload that they expect the RFC2833 packet to be received in */
1330         payload = ast_rtp_codecs_payload_code(ast_rtp_instance_get_codecs(instance), 0, NULL, AST_RTP_DTMF);
1331
1332         rtp->dtmfmute = ast_tvadd(ast_tvnow(), ast_tv(0, 500000));
1333         rtp->send_duration = 160;
1334         rtp->lastdigitts = rtp->lastts + rtp->send_duration;
1335
1336         /* Create the actual packet that we will be sending */
1337         rtpheader[0] = htonl((2 << 30) | (1 << 23) | (payload << 16) | (rtp->seqno));
1338         rtpheader[1] = htonl(rtp->lastdigitts);
1339         rtpheader[2] = htonl(rtp->ssrc);
1340
1341         /* Actually send the packet */
1342         for (i = 0; i < 2; i++) {
1343                 int ice;
1344
1345                 rtpheader[3] = htonl((digit << 24) | (0xa << 16) | (rtp->send_duration));
1346                 res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
1347                 if (res < 0) {
1348                         ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
1349                                 ast_sockaddr_stringify(&remote_address),
1350                                 strerror(errno));
1351                 }
1352                 update_address_with_ice_candidate(rtp, COMPONENT_RTP, &remote_address);
1353                 if (rtp_debug_test_addr(&remote_address)) {
1354                         ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6u, ts %-6.6u, len %-6.6u)\n",
1355                                     ast_sockaddr_stringify(&remote_address),
1356                                     ice ? " (via ICE)" : "",
1357                                     payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
1358                 }
1359                 rtp->seqno++;
1360                 rtp->send_duration += 160;
1361                 rtpheader[0] = htonl((2 << 30) | (payload << 16) | (rtp->seqno));
1362         }
1363
1364         /* Record that we are in the process of sending a digit and information needed to continue doing so */
1365         rtp->sending_digit = 1;
1366         rtp->send_digit = digit;
1367         rtp->send_payload = payload;
1368
1369         return 0;
1370 }
1371
1372 static int ast_rtp_dtmf_continuation(struct ast_rtp_instance *instance)
1373 {
1374         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1375         struct ast_sockaddr remote_address = { {0,} };
1376         int hdrlen = 12, res = 0;
1377         char data[256];
1378         unsigned int *rtpheader = (unsigned int*)data;
1379         int ice;
1380
1381         ast_rtp_instance_get_remote_address(instance, &remote_address);
1382
1383         /* Make sure we know where the other side is so we can send them the packet */
1384         if (ast_sockaddr_isnull(&remote_address)) {
1385                 return -1;
1386         }
1387
1388         /* Actually create the packet we will be sending */
1389         rtpheader[0] = htonl((2 << 30) | (rtp->send_payload << 16) | (rtp->seqno));
1390         rtpheader[1] = htonl(rtp->lastdigitts);
1391         rtpheader[2] = htonl(rtp->ssrc);
1392         rtpheader[3] = htonl((rtp->send_digit << 24) | (0xa << 16) | (rtp->send_duration));
1393
1394         /* Boom, send it on out */
1395         res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
1396         if (res < 0) {
1397                 ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
1398                         ast_sockaddr_stringify(&remote_address),
1399                         strerror(errno));
1400         }
1401
1402         update_address_with_ice_candidate(rtp, COMPONENT_RTP, &remote_address);
1403
1404         if (rtp_debug_test_addr(&remote_address)) {
1405                 ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6u, ts %-6.6u, len %-6.6u)\n",
1406                             ast_sockaddr_stringify(&remote_address),
1407                             ice ? " (via ICE)" : "",
1408                             rtp->send_payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
1409         }
1410
1411         /* And now we increment some values for the next time we swing by */
1412         rtp->seqno++;
1413         rtp->send_duration += 160;
1414
1415         return 0;
1416 }
1417
1418 static int ast_rtp_dtmf_end_with_duration(struct ast_rtp_instance *instance, char digit, unsigned int duration)
1419 {
1420         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1421         struct ast_sockaddr remote_address = { {0,} };
1422         int hdrlen = 12, res = 0, i = 0;
1423         char data[256];
1424         unsigned int *rtpheader = (unsigned int*)data;
1425         unsigned int measured_samples;
1426
1427         ast_rtp_instance_get_remote_address(instance, &remote_address);
1428
1429         /* Make sure we know where the remote side is so we can send them the packet we construct */
1430         if (ast_sockaddr_isnull(&remote_address)) {
1431                 return -1;
1432         }
1433
1434         /* Convert the given digit to the one we are going to send */
1435         if ((digit <= '9') && (digit >= '0')) {
1436                 digit -= '0';
1437         } else if (digit == '*') {
1438                 digit = 10;
1439         } else if (digit == '#') {
1440                 digit = 11;
1441         } else if ((digit >= 'A') && (digit <= 'D')) {
1442                 digit = digit - 'A' + 12;
1443         } else if ((digit >= 'a') && (digit <= 'd')) {
1444                 digit = digit - 'a' + 12;
1445         } else {
1446                 ast_log(LOG_WARNING, "Don't know how to represent '%c'\n", digit);
1447                 return -1;
1448         }
1449
1450         rtp->dtmfmute = ast_tvadd(ast_tvnow(), ast_tv(0, 500000));
1451
1452         if (duration > 0 && (measured_samples = duration * rtp_get_rate(&rtp->f.subclass.format) / 1000) > rtp->send_duration) {
1453                 ast_debug(2, "Adjusting final end duration from %u to %u\n", rtp->send_duration, measured_samples);
1454                 rtp->send_duration = measured_samples;
1455         }
1456
1457         /* Construct the packet we are going to send */
1458         rtpheader[1] = htonl(rtp->lastdigitts);
1459         rtpheader[2] = htonl(rtp->ssrc);
1460         rtpheader[3] = htonl((digit << 24) | (0xa << 16) | (rtp->send_duration));
1461         rtpheader[3] |= htonl((1 << 23));
1462
1463         /* Send it 3 times, that's the magical number */
1464         for (i = 0; i < 3; i++) {
1465                 int ice;
1466
1467                 rtpheader[0] = htonl((2 << 30) | (rtp->send_payload << 16) | (rtp->seqno));
1468
1469                 res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
1470
1471                 if (res < 0) {
1472                         ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
1473                                 ast_sockaddr_stringify(&remote_address),
1474                                 strerror(errno));
1475                 }
1476
1477                 update_address_with_ice_candidate(rtp, COMPONENT_RTP, &remote_address);
1478
1479                 if (rtp_debug_test_addr(&remote_address)) {
1480                         ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6u, ts %-6.6u, len %-6.6u)\n",
1481                                     ast_sockaddr_stringify(&remote_address),
1482                                     ice ? " (via ICE)" : "",
1483                                     rtp->send_payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
1484                 }
1485
1486                 rtp->seqno++;
1487         }
1488
1489         /* Oh and we can't forget to turn off the stuff that says we are sending DTMF */
1490         rtp->lastts += rtp->send_duration;
1491         rtp->sending_digit = 0;
1492         rtp->send_digit = 0;
1493
1494         return 0;
1495 }
1496
1497 static int ast_rtp_dtmf_end(struct ast_rtp_instance *instance, char digit)
1498 {
1499         return ast_rtp_dtmf_end_with_duration(instance, digit, 0);
1500 }
1501
1502 static void ast_rtp_update_source(struct ast_rtp_instance *instance)
1503 {
1504         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1505
1506         /* We simply set this bit so that the next packet sent will have the marker bit turned on */
1507         ast_set_flag(rtp, FLAG_NEED_MARKER_BIT);
1508         ast_debug(3, "Setting the marker bit due to a source update\n");
1509
1510         return;
1511 }
1512
1513 static void ast_rtp_change_source(struct ast_rtp_instance *instance)
1514 {
1515         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1516         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance);
1517         unsigned int ssrc = ast_random();
1518
1519         if (!rtp->lastts) {
1520                 ast_debug(3, "Not changing SSRC since we haven't sent any RTP yet\n");
1521                 return;
1522         }
1523
1524         /* We simply set this bit so that the next packet sent will have the marker bit turned on */
1525         ast_set_flag(rtp, FLAG_NEED_MARKER_BIT);
1526
1527         ast_debug(3, "Changing ssrc from %u to %u due to a source change\n", rtp->ssrc, ssrc);
1528
1529         if (srtp) {
1530                 ast_debug(3, "Changing ssrc for SRTP from %u to %u\n", rtp->ssrc, ssrc);
1531                 res_srtp->change_source(srtp, rtp->ssrc, ssrc);
1532         }
1533
1534         rtp->ssrc = ssrc;
1535
1536         return;
1537 }
1538
1539 static unsigned int calc_txstamp(struct ast_rtp *rtp, struct timeval *delivery)
1540 {
1541         struct timeval t;
1542         long ms;
1543
1544         if (ast_tvzero(rtp->txcore)) {
1545                 rtp->txcore = ast_tvnow();
1546                 rtp->txcore.tv_usec -= rtp->txcore.tv_usec % 20000;
1547         }
1548
1549         t = (delivery && !ast_tvzero(*delivery)) ? *delivery : ast_tvnow();
1550         if ((ms = ast_tvdiff_ms(t, rtp->txcore)) < 0) {
1551                 ms = 0;
1552         }
1553         rtp->txcore = t;
1554
1555         return (unsigned int) ms;
1556 }
1557
1558 static void timeval2ntp(struct timeval tv, unsigned int *msw, unsigned int *lsw)
1559 {
1560         unsigned int sec, usec, frac;
1561         sec = tv.tv_sec + 2208988800u; /* Sec between 1900 and 1970 */
1562         usec = tv.tv_usec;
1563         frac = (usec << 12) + (usec << 8) - ((usec * 3650) >> 6);
1564         *msw = sec;
1565         *lsw = frac;
1566 }
1567
1568 /*! \brief Send RTCP recipient's report */
1569 static int ast_rtcp_write_rr(struct ast_rtp_instance *instance)
1570 {
1571         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1572         int res;
1573         int len = 32;
1574         unsigned int lost;
1575         unsigned int extended;
1576         unsigned int expected;
1577         unsigned int expected_interval;
1578         unsigned int received_interval;
1579         int lost_interval;
1580         struct timeval now;
1581         unsigned int *rtcpheader;
1582         char bdata[1024];
1583         struct timeval dlsr;
1584         int fraction;
1585         int rate = rtp_get_rate(&rtp->f.subclass.format);
1586         int ice;
1587         double rxlost_current;
1588         struct ast_sockaddr remote_address = { {0,} };
1589
1590         if (!rtp || !rtp->rtcp)
1591                 return 0;
1592
1593         if (ast_sockaddr_isnull(&rtp->rtcp->them)) {
1594                 /*
1595                  * RTCP was stopped.
1596                  */
1597                 return 0;
1598         }
1599
1600         extended = rtp->cycles + rtp->lastrxseqno;
1601         expected = extended - rtp->seedrxseqno + 1;
1602         lost = expected - rtp->rxcount;
1603         expected_interval = expected - rtp->rtcp->expected_prior;
1604         rtp->rtcp->expected_prior = expected;
1605         received_interval = rtp->rxcount - rtp->rtcp->received_prior;
1606         rtp->rtcp->received_prior = rtp->rxcount;
1607         lost_interval = expected_interval - received_interval;
1608
1609         if (lost_interval <= 0)
1610                 rtp->rtcp->rxlost = 0;
1611         else rtp->rtcp->rxlost = rtp->rtcp->rxlost;
1612         if (rtp->rtcp->rxlost_count == 0)
1613                 rtp->rtcp->minrxlost = rtp->rtcp->rxlost;
1614         if (lost_interval < rtp->rtcp->minrxlost)
1615                 rtp->rtcp->minrxlost = rtp->rtcp->rxlost;
1616         if (lost_interval > rtp->rtcp->maxrxlost)
1617                 rtp->rtcp->maxrxlost = rtp->rtcp->rxlost;
1618
1619         rxlost_current = normdev_compute(rtp->rtcp->normdev_rxlost, rtp->rtcp->rxlost, rtp->rtcp->rxlost_count);
1620         rtp->rtcp->stdev_rxlost = stddev_compute(rtp->rtcp->stdev_rxlost, rtp->rtcp->rxlost, rtp->rtcp->normdev_rxlost, rxlost_current, rtp->rtcp->rxlost_count);
1621         rtp->rtcp->normdev_rxlost = rxlost_current;
1622         rtp->rtcp->rxlost_count++;
1623
1624         if (expected_interval == 0 || lost_interval <= 0)
1625                 fraction = 0;
1626         else
1627                 fraction = (lost_interval << 8) / expected_interval;
1628         gettimeofday(&now, NULL);
1629         timersub(&now, &rtp->rtcp->rxlsr, &dlsr);
1630         rtcpheader = (unsigned int *)bdata;
1631         rtcpheader[0] = htonl((2 << 30) | (1 << 24) | (RTCP_PT_RR << 16) | ((len/4)-1));
1632         rtcpheader[1] = htonl(rtp->ssrc);
1633         rtcpheader[2] = htonl(rtp->themssrc);
1634         rtcpheader[3] = htonl(((fraction & 0xff) << 24) | (lost & 0xffffff));
1635         rtcpheader[4] = htonl((rtp->cycles) | ((rtp->lastrxseqno & 0xffff)));
1636         rtcpheader[5] = htonl((unsigned int)(rtp->rxjitter * rate));
1637         rtcpheader[6] = htonl(rtp->rtcp->themrxlsr);
1638         rtcpheader[7] = htonl((((dlsr.tv_sec * 1000) + (dlsr.tv_usec / 1000)) * 65536) / 1000);
1639
1640         /*! \note Insert SDES here. Probably should make SDES text equal to mimetypes[code].type (not subtype 'cos
1641           it can change mid call, and SDES can't) */
1642         rtcpheader[len/4]     = htonl((2 << 30) | (1 << 24) | (RTCP_PT_SDES << 16) | 2);
1643         rtcpheader[(len/4)+1] = htonl(rtp->ssrc);               /* Our SSRC */
1644         rtcpheader[(len/4)+2] = htonl(0x01 << 24);              /* Empty for the moment */
1645         len += 12;
1646
1647         ast_sockaddr_copy(&remote_address, &rtp->rtcp->them);
1648
1649         res = rtcp_sendto(instance, (unsigned int *)rtcpheader, len, 0, &remote_address, &ice);
1650
1651         if (res < 0) {
1652                 ast_log(LOG_ERROR, "RTCP RR transmission error, rtcp halted: %s\n",strerror(errno));
1653                 return 0;
1654         }
1655
1656         rtp->rtcp->rr_count++;
1657
1658         update_address_with_ice_candidate(rtp, COMPONENT_RTCP, &remote_address);
1659
1660         if (rtcp_debug_test_addr(&remote_address)) {
1661                 ast_verbose("\n* Sending RTCP RR to %s%s\n"
1662                         "  Our SSRC: %u\nTheir SSRC: %u\niFraction lost: %d\nCumulative loss: %u\n"
1663                         "  IA jitter: %.4f\n"
1664                         "  Their last SR: %u\n"
1665                             "  DLSR: %4.4f (sec)\n\n",
1666                             ast_sockaddr_stringify(&remote_address),
1667                             ice ? " (via ICE)" : "",
1668                             rtp->ssrc, rtp->themssrc, fraction, lost,
1669                             rtp->rxjitter,
1670                             rtp->rtcp->themrxlsr,
1671                             (double)(ntohl(rtcpheader[7])/65536.0));
1672         }
1673
1674         return res;
1675 }
1676
1677 /*! \brief Send RTCP sender's report */
1678 static int ast_rtcp_write_sr(struct ast_rtp_instance *instance)
1679 {
1680         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1681         int res;
1682         int len = 0;
1683         struct timeval now;
1684         unsigned int now_lsw;
1685         unsigned int now_msw;
1686         unsigned int *rtcpheader;
1687         unsigned int lost;
1688         unsigned int extended;
1689         unsigned int expected;
1690         unsigned int expected_interval;
1691         unsigned int received_interval;
1692         int lost_interval;
1693         int fraction;
1694         struct timeval dlsr;
1695         char bdata[512];
1696         int rate = rtp_get_rate(&rtp->f.subclass.format);
1697         int ice;
1698         struct ast_sockaddr remote_address = { {0,} };
1699
1700         if (!rtp || !rtp->rtcp)
1701                 return 0;
1702
1703         if (ast_sockaddr_isnull(&rtp->rtcp->them)) {  /* This'll stop rtcp for this rtp session */
1704                 /*
1705                  * RTCP was stopped.
1706                  */
1707                 return 0;
1708         }
1709
1710         gettimeofday(&now, NULL);
1711         timeval2ntp(now, &now_msw, &now_lsw); /* fill thses ones in from utils.c*/
1712         rtcpheader = (unsigned int *)bdata;
1713         rtcpheader[1] = htonl(rtp->ssrc);               /* Our SSRC */
1714         rtcpheader[2] = htonl(now_msw);                 /* now, MSW. gettimeofday() + SEC_BETWEEN_1900_AND_1970*/
1715         rtcpheader[3] = htonl(now_lsw);                 /* now, LSW */
1716         rtcpheader[4] = htonl(rtp->lastts);             /* FIXME shouldn't be that, it should be now */
1717         rtcpheader[5] = htonl(rtp->txcount);            /* No. packets sent */
1718         rtcpheader[6] = htonl(rtp->txoctetcount);       /* No. bytes sent */
1719         len += 28;
1720
1721         extended = rtp->cycles + rtp->lastrxseqno;
1722         expected = extended - rtp->seedrxseqno + 1;
1723         if (rtp->rxcount > expected)
1724                 expected += rtp->rxcount - expected;
1725         lost = expected - rtp->rxcount;
1726         expected_interval = expected - rtp->rtcp->expected_prior;
1727         rtp->rtcp->expected_prior = expected;
1728         received_interval = rtp->rxcount - rtp->rtcp->received_prior;
1729         rtp->rtcp->received_prior = rtp->rxcount;
1730         lost_interval = expected_interval - received_interval;
1731         if (expected_interval == 0 || lost_interval <= 0)
1732                 fraction = 0;
1733         else
1734                 fraction = (lost_interval << 8) / expected_interval;
1735         timersub(&now, &rtp->rtcp->rxlsr, &dlsr);
1736         rtcpheader[7] = htonl(rtp->themssrc);
1737         rtcpheader[8] = htonl(((fraction & 0xff) << 24) | (lost & 0xffffff));
1738         rtcpheader[9] = htonl((rtp->cycles) | ((rtp->lastrxseqno & 0xffff)));
1739         rtcpheader[10] = htonl((unsigned int)(rtp->rxjitter * rate));
1740         rtcpheader[11] = htonl(rtp->rtcp->themrxlsr);
1741         rtcpheader[12] = htonl((((dlsr.tv_sec * 1000) + (dlsr.tv_usec / 1000)) * 65536) / 1000);
1742         len += 24;
1743
1744         rtcpheader[0] = htonl((2 << 30) | (1 << 24) | (RTCP_PT_SR << 16) | ((len/4)-1));
1745
1746         /* Insert SDES here. Probably should make SDES text equal to mimetypes[code].type (not subtype 'cos */
1747         /* it can change mid call, and SDES can't) */
1748         rtcpheader[len/4]     = htonl((2 << 30) | (1 << 24) | (RTCP_PT_SDES << 16) | 2);
1749         rtcpheader[(len/4)+1] = htonl(rtp->ssrc);               /* Our SSRC */
1750         rtcpheader[(len/4)+2] = htonl(0x01 << 24);                    /* Empty for the moment */
1751         len += 12;
1752
1753         ast_sockaddr_copy(&remote_address, &rtp->rtcp->them);
1754
1755         res = rtcp_sendto(instance, (unsigned int *)rtcpheader, len, 0, &remote_address, &ice);
1756         if (res < 0) {
1757                 ast_log(LOG_ERROR, "RTCP SR transmission error to %s, rtcp halted %s\n",
1758                         ast_sockaddr_stringify(&rtp->rtcp->them),
1759                         strerror(errno));
1760                 return 0;
1761         }
1762
1763         /* FIXME Don't need to get a new one */
1764         gettimeofday(&rtp->rtcp->txlsr, NULL);
1765         rtp->rtcp->sr_count++;
1766
1767         rtp->rtcp->lastsrtxcount = rtp->txcount;
1768
1769         update_address_with_ice_candidate(rtp, COMPONENT_RTCP, &remote_address);
1770
1771         if (rtcp_debug_test_addr(&rtp->rtcp->them)) {
1772                 ast_verbose("* Sent RTCP SR to %s%s\n", ast_sockaddr_stringify(&remote_address), ice ? " (via ICE)" : "");
1773                 ast_verbose("  Our SSRC: %u\n", rtp->ssrc);
1774                 ast_verbose("  Sent(NTP): %u.%010u\n", (unsigned int)now.tv_sec, (unsigned int)now.tv_usec*4096);
1775                 ast_verbose("  Sent(RTP): %u\n", rtp->lastts);
1776                 ast_verbose("  Sent packets: %u\n", rtp->txcount);
1777                 ast_verbose("  Sent octets: %u\n", rtp->txoctetcount);
1778                 ast_verbose("  Report block:\n");
1779                 ast_verbose("  Fraction lost: %u\n", fraction);
1780                 ast_verbose("  Cumulative loss: %u\n", lost);
1781                 ast_verbose("  IA jitter: %.4f\n", rtp->rxjitter);
1782                 ast_verbose("  Their last SR: %u\n", rtp->rtcp->themrxlsr);
1783                 ast_verbose("  DLSR: %4.4f (sec)\n\n", (double)(ntohl(rtcpheader[12])/65536.0));
1784         }
1785         manager_event(EVENT_FLAG_REPORTING, "RTCPSent", "To: %s\r\n"
1786                                             "OurSSRC: %u\r\n"
1787                                             "SentNTP: %u.%010u\r\n"
1788                                             "SentRTP: %u\r\n"
1789                                             "SentPackets: %u\r\n"
1790                                             "SentOctets: %u\r\n"
1791                                             "ReportBlock:\r\n"
1792                                             "FractionLost: %u\r\n"
1793                                             "CumulativeLoss: %u\r\n"
1794                                             "IAJitter: %.4f\r\n"
1795                                             "TheirLastSR: %u\r\n"
1796                       "DLSR: %4.4f (sec)\r\n",
1797                       ast_sockaddr_stringify(&remote_address),
1798                       rtp->ssrc,
1799                       (unsigned int)now.tv_sec, (unsigned int)now.tv_usec*4096,
1800                       rtp->lastts,
1801                       rtp->txcount,
1802                       rtp->txoctetcount,
1803                       fraction,
1804                       lost,
1805                       rtp->rxjitter,
1806                       rtp->rtcp->themrxlsr,
1807                       (double)(ntohl(rtcpheader[12])/65536.0));
1808         return res;
1809 }
1810
1811 /*! \brief Write and RTCP packet to the far end
1812  * \note Decide if we are going to send an SR (with Reception Block) or RR
1813  * RR is sent if we have not sent any rtp packets in the previous interval */
1814 static int ast_rtcp_write(const void *data)
1815 {
1816         struct ast_rtp_instance *instance = (struct ast_rtp_instance *) data;
1817         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1818         int res;
1819
1820         if (!rtp || !rtp->rtcp || rtp->rtcp->schedid == -1) {
1821                 ao2_ref(instance, -1);
1822                 return 0;
1823         }
1824
1825         if (rtp->txcount > rtp->rtcp->lastsrtxcount) {
1826                 res = ast_rtcp_write_sr(instance);
1827         } else {
1828                 res = ast_rtcp_write_rr(instance);
1829         }
1830
1831         if (!res) {
1832                 /* 
1833                  * Not being rescheduled.
1834                  */
1835                 ao2_ref(instance, -1);
1836                 rtp->rtcp->schedid = -1;
1837         }
1838
1839         return res;
1840 }
1841
1842 static int ast_rtp_raw_write(struct ast_rtp_instance *instance, struct ast_frame *frame, int codec)
1843 {
1844         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1845         int pred, mark = 0;
1846         unsigned int ms = calc_txstamp(rtp, &frame->delivery);
1847         struct ast_sockaddr remote_address = { {0,} };
1848         int rate = rtp_get_rate(&frame->subclass.format) / 1000;
1849
1850         if (frame->subclass.format.id == AST_FORMAT_G722) {
1851                 frame->samples /= 2;
1852         }
1853
1854         if (rtp->sending_digit) {
1855                 return 0;
1856         }
1857
1858         if (frame->frametype == AST_FRAME_VOICE) {
1859                 pred = rtp->lastts + frame->samples;
1860
1861                 /* Re-calculate last TS */
1862                 rtp->lastts = rtp->lastts + ms * rate;
1863                 if (ast_tvzero(frame->delivery)) {
1864                         /* If this isn't an absolute delivery time, Check if it is close to our prediction,
1865                            and if so, go with our prediction */
1866                         if (abs(rtp->lastts - pred) < MAX_TIMESTAMP_SKEW) {
1867                                 rtp->lastts = pred;
1868                         } else {
1869                                 ast_debug(3, "Difference is %d, ms is %d\n", abs(rtp->lastts - pred), ms);
1870                                 mark = 1;
1871                         }
1872                 }
1873         } else if (frame->frametype == AST_FRAME_VIDEO) {
1874                 mark = ast_format_get_video_mark(&frame->subclass.format);
1875                 pred = rtp->lastovidtimestamp + frame->samples;
1876                 /* Re-calculate last TS */
1877                 rtp->lastts = rtp->lastts + ms * 90;
1878                 /* If it's close to our prediction, go for it */
1879                 if (ast_tvzero(frame->delivery)) {
1880                         if (abs(rtp->lastts - pred) < 7200) {
1881                                 rtp->lastts = pred;
1882                                 rtp->lastovidtimestamp += frame->samples;
1883                         } else {
1884                                 ast_debug(3, "Difference is %d, ms is %d (%d), pred/ts/samples %d/%d/%d\n", abs(rtp->lastts - pred), ms, ms * 90, rtp->lastts, pred, frame->samples);
1885                                 rtp->lastovidtimestamp = rtp->lastts;
1886                         }
1887                 }
1888         } else {
1889                 pred = rtp->lastotexttimestamp + frame->samples;
1890                 /* Re-calculate last TS */
1891                 rtp->lastts = rtp->lastts + ms;
1892                 /* If it's close to our prediction, go for it */
1893                 if (ast_tvzero(frame->delivery)) {
1894                         if (abs(rtp->lastts - pred) < 7200) {
1895                                 rtp->lastts = pred;
1896                                 rtp->lastotexttimestamp += frame->samples;
1897                         } else {
1898                                 ast_debug(3, "Difference is %d, ms is %d, pred/ts/samples %d/%d/%d\n", abs(rtp->lastts - pred), ms, rtp->lastts, pred, frame->samples);
1899                                 rtp->lastotexttimestamp = rtp->lastts;
1900                         }
1901                 }
1902         }
1903
1904         /* If we have been explicitly told to set the marker bit then do so */
1905         if (ast_test_flag(rtp, FLAG_NEED_MARKER_BIT)) {
1906                 mark = 1;
1907                 ast_clear_flag(rtp, FLAG_NEED_MARKER_BIT);
1908         }
1909
1910         /* If the timestamp for non-digt packets has moved beyond the timestamp for digits, update the digit timestamp */
1911         if (rtp->lastts > rtp->lastdigitts) {
1912                 rtp->lastdigitts = rtp->lastts;
1913         }
1914
1915         if (ast_test_flag(frame, AST_FRFLAG_HAS_TIMING_INFO)) {
1916                 rtp->lastts = frame->ts * rate;
1917         }
1918
1919         ast_rtp_instance_get_remote_address(instance, &remote_address);
1920
1921         /* If we know the remote address construct a packet and send it out */
1922         if (!ast_sockaddr_isnull(&remote_address)) {
1923                 int hdrlen = 12, res, ice;
1924                 unsigned char *rtpheader = (unsigned char *)(frame->data.ptr - hdrlen);
1925
1926                 put_unaligned_uint32(rtpheader, htonl((2 << 30) | (codec << 16) | (rtp->seqno) | (mark << 23)));
1927                 put_unaligned_uint32(rtpheader + 4, htonl(rtp->lastts));
1928                 put_unaligned_uint32(rtpheader + 8, htonl(rtp->ssrc));
1929
1930                 if ((res = rtp_sendto(instance, (void *)rtpheader, frame->datalen + hdrlen, 0, &remote_address, &ice)) < 0) {
1931                         if (!ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_NAT) || (ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_NAT) && (ast_test_flag(rtp, FLAG_NAT_ACTIVE) == FLAG_NAT_ACTIVE))) {
1932                                 ast_debug(1, "RTP Transmission error of packet %d to %s: %s\n",
1933                                           rtp->seqno,
1934                                           ast_sockaddr_stringify(&remote_address),
1935                                           strerror(errno));
1936                         } else if (((ast_test_flag(rtp, FLAG_NAT_ACTIVE) == FLAG_NAT_INACTIVE) || rtpdebug) && !ast_test_flag(rtp, FLAG_NAT_INACTIVE_NOWARN)) {
1937                                 /* Only give this error message once if we are not RTP debugging */
1938                                 if (rtpdebug)
1939                                         ast_debug(0, "RTP NAT: Can't write RTP to private address %s, waiting for other end to send audio...\n",
1940                                                   ast_sockaddr_stringify(&remote_address));
1941                                 ast_set_flag(rtp, FLAG_NAT_INACTIVE_NOWARN);
1942                         }
1943                 } else {
1944                         rtp->txcount++;
1945                         rtp->txoctetcount += (res - hdrlen);
1946
1947                         if (rtp->rtcp && rtp->rtcp->schedid < 1) {
1948                                 ast_debug(1, "Starting RTCP transmission on RTP instance '%p'\n", instance);
1949                                 ao2_ref(instance, +1);
1950                                 rtp->rtcp->schedid = ast_sched_add(rtp->sched, ast_rtcp_calc_interval(rtp), ast_rtcp_write, instance);
1951                                 if (rtp->rtcp->schedid < 0) {
1952                                         ao2_ref(instance, -1);
1953                                         ast_log(LOG_WARNING, "scheduling RTCP transmission failed.\n");
1954                                 }
1955                         }
1956                 }
1957
1958                 update_address_with_ice_candidate(rtp, COMPONENT_RTP, &remote_address);
1959
1960                 if (rtp_debug_test_addr(&remote_address)) {
1961                         ast_verbose("Sent RTP packet to      %s%s (type %-2.2d, seq %-6.6u, ts %-6.6u, len %-6.6u)\n",
1962                                     ast_sockaddr_stringify(&remote_address),
1963                                     ice ? " (via ICE)" : "",
1964                                     codec, rtp->seqno, rtp->lastts, res - hdrlen);
1965                 }
1966         }
1967
1968         rtp->seqno++;
1969
1970         return 0;
1971 }
1972
1973 static struct ast_frame *red_t140_to_red(struct rtp_red *red) {
1974         unsigned char *data = red->t140red.data.ptr;
1975         int len = 0;
1976         int i;
1977
1978         /* replace most aged generation */
1979         if (red->len[0]) {
1980                 for (i = 1; i < red->num_gen+1; i++)
1981                         len += red->len[i];
1982
1983                 memmove(&data[red->hdrlen], &data[red->hdrlen+red->len[0]], len);
1984         }
1985
1986         /* Store length of each generation and primary data length*/
1987         for (i = 0; i < red->num_gen; i++)
1988                 red->len[i] = red->len[i+1];
1989         red->len[i] = red->t140.datalen;
1990
1991         /* write each generation length in red header */
1992         len = red->hdrlen;
1993         for (i = 0; i < red->num_gen; i++)
1994                 len += data[i*4+3] = red->len[i];
1995
1996         /* add primary data to buffer */
1997         memcpy(&data[len], red->t140.data.ptr, red->t140.datalen);
1998         red->t140red.datalen = len + red->t140.datalen;
1999
2000         /* no primary data and no generations to send */
2001         if (len == red->hdrlen && !red->t140.datalen)
2002                 return NULL;
2003
2004         /* reset t.140 buffer */
2005         red->t140.datalen = 0;
2006
2007         return &red->t140red;
2008 }
2009
2010 static int ast_rtp_write(struct ast_rtp_instance *instance, struct ast_frame *frame)
2011 {
2012         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2013         struct ast_sockaddr remote_address = { {0,} };
2014         struct ast_format subclass;
2015         int codec;
2016
2017         ast_rtp_instance_get_remote_address(instance, &remote_address);
2018
2019         /* If we don't actually know the remote address don't even bother doing anything */
2020         if (ast_sockaddr_isnull(&remote_address)) {
2021                 ast_debug(1, "No remote address on RTP instance '%p' so dropping frame\n", instance);
2022                 return 0;
2023         }
2024
2025         /* If there is no data length we can't very well send the packet */
2026         if (!frame->datalen) {
2027                 ast_debug(1, "Received frame with no data for RTP instance '%p' so dropping frame\n", instance);
2028                 return 0;
2029         }
2030
2031         /* If the packet is not one our RTP stack supports bail out */
2032         if (frame->frametype != AST_FRAME_VOICE && frame->frametype != AST_FRAME_VIDEO && frame->frametype != AST_FRAME_TEXT) {
2033                 ast_log(LOG_WARNING, "RTP can only send voice, video, and text\n");
2034                 return -1;
2035         }
2036
2037         if (rtp->red) {
2038                 /* return 0; */
2039                 /* no primary data or generations to send */
2040                 if ((frame = red_t140_to_red(rtp->red)) == NULL)
2041                         return 0;
2042         }
2043
2044         /* Grab the subclass and look up the payload we are going to use */
2045         ast_format_copy(&subclass, &frame->subclass.format);
2046         if ((codec = ast_rtp_codecs_payload_code(ast_rtp_instance_get_codecs(instance), 1, &subclass, 0)) < 0) {
2047                 ast_log(LOG_WARNING, "Don't know how to send format %s packets with RTP\n", ast_getformatname(&frame->subclass.format));
2048                 return -1;
2049         }
2050
2051         /* Oh dear, if the format changed we will have to set up a new smoother */
2052         if (ast_format_cmp(&rtp->lasttxformat, &subclass) == AST_FORMAT_CMP_NOT_EQUAL) {
2053                 ast_debug(1, "Ooh, format changed from %s to %s\n", ast_getformatname(&rtp->lasttxformat), ast_getformatname(&subclass));
2054                 rtp->lasttxformat = subclass;
2055                 ast_format_copy(&rtp->lasttxformat, &subclass);
2056                 if (rtp->smoother) {
2057                         ast_smoother_free(rtp->smoother);
2058                         rtp->smoother = NULL;
2059                 }
2060         }
2061
2062         /* If no smoother is present see if we have to set one up */
2063         if (!rtp->smoother) {
2064                 struct ast_format_list fmt = ast_codec_pref_getsize(&ast_rtp_instance_get_codecs(instance)->pref, &subclass);
2065
2066                 switch (subclass.id) {
2067                 case AST_FORMAT_SPEEX:
2068                 case AST_FORMAT_SPEEX16:
2069                 case AST_FORMAT_SPEEX32:
2070                 case AST_FORMAT_SILK:
2071                 case AST_FORMAT_CELT:
2072                 case AST_FORMAT_G723_1:
2073                 case AST_FORMAT_SIREN7:
2074                 case AST_FORMAT_SIREN14:
2075                 case AST_FORMAT_G719:
2076                         /* these are all frame-based codecs and cannot be safely run through
2077                            a smoother */
2078                         break;
2079                 default:
2080                         if (fmt.inc_ms) {
2081                                 if (!(rtp->smoother = ast_smoother_new((fmt.cur_ms * fmt.fr_len) / fmt.inc_ms))) {
2082                                         ast_log(LOG_WARNING, "Unable to create smoother: format %s ms: %d len: %d\n", ast_getformatname(&subclass), fmt.cur_ms, ((fmt.cur_ms * fmt.fr_len) / fmt.inc_ms));
2083                                         return -1;
2084                                 }
2085                                 if (fmt.flags) {
2086                                         ast_smoother_set_flags(rtp->smoother, fmt.flags);
2087                                 }
2088                                 ast_debug(1, "Created smoother: format: %s ms: %d len: %d\n", ast_getformatname(&subclass), fmt.cur_ms, ((fmt.cur_ms * fmt.fr_len) / fmt.inc_ms));
2089                         }
2090                 }
2091         }
2092
2093         /* Feed audio frames into the actual function that will create a frame and send it */
2094         if (rtp->smoother) {
2095                 struct ast_frame *f;
2096
2097                 if (ast_smoother_test_flag(rtp->smoother, AST_SMOOTHER_FLAG_BE)) {
2098                         ast_smoother_feed_be(rtp->smoother, frame);
2099                 } else {
2100                         ast_smoother_feed(rtp->smoother, frame);
2101                 }
2102
2103                 while ((f = ast_smoother_read(rtp->smoother)) && (f->data.ptr)) {
2104                                 ast_rtp_raw_write(instance, f, codec);
2105                 }
2106         } else {
2107                 int hdrlen = 12;
2108                 struct ast_frame *f = NULL;
2109
2110                 if (frame->offset < hdrlen) {
2111                         f = ast_frdup(frame);
2112                 } else {
2113                         f = frame;
2114                 }
2115                 if (f->data.ptr) {
2116                         ast_rtp_raw_write(instance, f, codec);
2117                 }
2118                 if (f != frame) {
2119                         ast_frfree(f);
2120                 }
2121
2122         }
2123
2124         return 0;
2125 }
2126
2127 static void calc_rxstamp(struct timeval *tv, struct ast_rtp *rtp, unsigned int timestamp, int mark)
2128 {
2129         struct timeval now;
2130         struct timeval tmp;
2131         double transit;
2132         double current_time;
2133         double d;
2134         double dtv;
2135         double prog;
2136         int rate = rtp_get_rate(&rtp->f.subclass.format);
2137
2138         double normdev_rxjitter_current;
2139         if ((!rtp->rxcore.tv_sec && !rtp->rxcore.tv_usec) || mark) {
2140                 gettimeofday(&rtp->rxcore, NULL);
2141                 rtp->drxcore = (double) rtp->rxcore.tv_sec + (double) rtp->rxcore.tv_usec / 1000000;
2142                 /* map timestamp to a real time */
2143                 rtp->seedrxts = timestamp; /* Their RTP timestamp started with this */
2144                 tmp = ast_samp2tv(timestamp, rate);
2145                 rtp->rxcore = ast_tvsub(rtp->rxcore, tmp);
2146                 /* Round to 0.1ms for nice, pretty timestamps */
2147                 rtp->rxcore.tv_usec -= rtp->rxcore.tv_usec % 100;
2148         }
2149
2150         gettimeofday(&now,NULL);
2151         /* rxcore is the mapping between the RTP timestamp and _our_ real time from gettimeofday() */
2152         tmp = ast_samp2tv(timestamp, rate);
2153         *tv = ast_tvadd(rtp->rxcore, tmp);
2154
2155         prog = (double)((timestamp-rtp->seedrxts)/(float)(rate));
2156         dtv = (double)rtp->drxcore + (double)(prog);
2157         current_time = (double)now.tv_sec + (double)now.tv_usec/1000000;
2158         transit = current_time - dtv;
2159         d = transit - rtp->rxtransit;
2160         rtp->rxtransit = transit;
2161         if (d<0)
2162                 d=-d;
2163         rtp->rxjitter += (1./16.) * (d - rtp->rxjitter);
2164
2165         if (rtp->rtcp) {
2166                 if (rtp->rxjitter > rtp->rtcp->maxrxjitter)
2167                         rtp->rtcp->maxrxjitter = rtp->rxjitter;
2168                 if (rtp->rtcp->rxjitter_count == 1)
2169                         rtp->rtcp->minrxjitter = rtp->rxjitter;
2170                 if (rtp->rtcp && rtp->rxjitter < rtp->rtcp->minrxjitter)
2171                         rtp->rtcp->minrxjitter = rtp->rxjitter;
2172
2173                 normdev_rxjitter_current = normdev_compute(rtp->rtcp->normdev_rxjitter,rtp->rxjitter,rtp->rtcp->rxjitter_count);
2174                 rtp->rtcp->stdev_rxjitter = stddev_compute(rtp->rtcp->stdev_rxjitter,rtp->rxjitter,rtp->rtcp->normdev_rxjitter,normdev_rxjitter_current,rtp->rtcp->rxjitter_count);
2175
2176                 rtp->rtcp->normdev_rxjitter = normdev_rxjitter_current;
2177                 rtp->rtcp->rxjitter_count++;
2178         }
2179 }
2180
2181 static struct ast_frame *create_dtmf_frame(struct ast_rtp_instance *instance, enum ast_frame_type type, int compensate)
2182 {
2183         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2184         struct ast_sockaddr remote_address = { {0,} };
2185
2186         ast_rtp_instance_get_remote_address(instance, &remote_address);
2187
2188         if (((compensate && type == AST_FRAME_DTMF_END) || (type == AST_FRAME_DTMF_BEGIN)) && ast_tvcmp(ast_tvnow(), rtp->dtmfmute) < 0) {
2189                 ast_debug(1, "Ignore potential DTMF echo from '%s'\n",
2190                           ast_sockaddr_stringify(&remote_address));
2191                 rtp->resp = 0;
2192                 rtp->dtmfsamples = 0;
2193                 return &ast_null_frame;
2194         }
2195         ast_debug(1, "Creating %s DTMF Frame: %d (%c), at %s\n",
2196                 type == AST_FRAME_DTMF_END ? "END" : "BEGIN",
2197                 rtp->resp, rtp->resp,
2198                 ast_sockaddr_stringify(&remote_address));
2199         if (rtp->resp == 'X') {
2200                 rtp->f.frametype = AST_FRAME_CONTROL;
2201                 rtp->f.subclass.integer = AST_CONTROL_FLASH;
2202         } else {
2203                 rtp->f.frametype = type;
2204                 rtp->f.subclass.integer = rtp->resp;
2205         }
2206         rtp->f.datalen = 0;
2207         rtp->f.samples = 0;
2208         rtp->f.mallocd = 0;
2209         rtp->f.src = "RTP";
2210         AST_LIST_NEXT(&rtp->f, frame_list) = NULL;
2211
2212         return &rtp->f;
2213 }
2214
2215 static void process_dtmf_rfc2833(struct ast_rtp_instance *instance, unsigned char *data, int len, unsigned int seqno, unsigned int timestamp, struct ast_sockaddr *addr, int payloadtype, int mark, struct frame_list *frames)
2216 {
2217         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2218         struct ast_sockaddr remote_address = { {0,} };
2219         unsigned int event, event_end, samples;
2220         char resp = 0;
2221         struct ast_frame *f = NULL;
2222
2223         ast_rtp_instance_get_remote_address(instance, &remote_address);
2224
2225         /* Figure out event, event end, and samples */
2226         event = ntohl(*((unsigned int *)(data)));
2227         event >>= 24;
2228         event_end = ntohl(*((unsigned int *)(data)));
2229         event_end <<= 8;
2230         event_end >>= 24;
2231         samples = ntohl(*((unsigned int *)(data)));
2232         samples &= 0xFFFF;
2233
2234         if (rtp_debug_test_addr(&remote_address)) {
2235                 ast_verbose("Got  RTP RFC2833 from   %s (type %-2.2d, seq %-6.6u, ts %-6.6u, len %-6.6u, mark %d, event %08x, end %d, duration %-5.5d) \n",
2236                             ast_sockaddr_stringify(&remote_address),
2237                             payloadtype, seqno, timestamp, len, (mark?1:0), event, ((event_end & 0x80)?1:0), samples);
2238         }
2239
2240         /* Print out debug if turned on */
2241         if (rtpdebug)
2242                 ast_debug(0, "- RTP 2833 Event: %08x (len = %d)\n", event, len);
2243
2244         /* Figure out what digit was pressed */
2245         if (event < 10) {
2246                 resp = '0' + event;
2247         } else if (event < 11) {
2248                 resp = '*';
2249         } else if (event < 12) {
2250                 resp = '#';
2251         } else if (event < 16) {
2252                 resp = 'A' + (event - 12);
2253         } else if (event < 17) {        /* Event 16: Hook flash */
2254                 resp = 'X';
2255         } else {
2256                 /* Not a supported event */
2257                 ast_debug(1, "Ignoring RTP 2833 Event: %08x. Not a DTMF Digit.\n", event);
2258                 return;
2259         }
2260
2261         if (ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_DTMF_COMPENSATE)) {
2262                 if ((rtp->last_end_timestamp != timestamp) || (rtp->resp && rtp->resp != resp)) {
2263                         rtp->resp = resp;
2264                         rtp->dtmf_timeout = 0;
2265                         f = ast_frdup(create_dtmf_frame(instance, AST_FRAME_DTMF_END, ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_DTMF_COMPENSATE)));
2266                         f->len = 0;
2267                         rtp->last_end_timestamp = timestamp;
2268                         AST_LIST_INSERT_TAIL(frames, f, frame_list);
2269                 }
2270         } else {
2271                 /*  The duration parameter measures the complete
2272                     duration of the event (from the beginning) - RFC2833.
2273                     Account for the fact that duration is only 16 bits long
2274                     (about 8 seconds at 8000 Hz) and can wrap is digit
2275                     is hold for too long. */
2276                 unsigned int new_duration = rtp->dtmf_duration;
2277                 unsigned int last_duration = new_duration & 0xFFFF;
2278
2279                 if (last_duration > 64000 && samples < last_duration) {
2280                         new_duration += 0xFFFF + 1;
2281                 }
2282                 new_duration = (new_duration & ~0xFFFF) | samples;
2283
2284                 if (event_end & 0x80) {
2285                         /* End event */
2286                         if ((rtp->last_seqno != seqno) && (timestamp > rtp->last_end_timestamp)) {
2287                                 rtp->last_end_timestamp = timestamp;
2288                                 rtp->dtmf_duration = new_duration;
2289                                 rtp->resp = resp;
2290                                 f = ast_frdup(create_dtmf_frame(instance, AST_FRAME_DTMF_END, 0));
2291                                 f->len = ast_tvdiff_ms(ast_samp2tv(rtp->dtmf_duration, rtp_get_rate(&f->subclass.format)), ast_tv(0, 0));
2292                                 rtp->resp = 0;
2293                                 rtp->dtmf_duration = rtp->dtmf_timeout = 0;
2294                                 AST_LIST_INSERT_TAIL(frames, f, frame_list);
2295                         } else if (rtpdebug) {
2296                                 ast_debug(1, "Dropping duplicate or out of order DTMF END frame (seqno: %d, ts %d, digit %c)\n",
2297                                         seqno, timestamp, resp);
2298                         }
2299                 } else {
2300                         /* Begin/continuation */
2301
2302                         /* The second portion of the seqno check is to not mistakenly
2303                          * stop accepting DTMF if the seqno rolls over beyond
2304                          * 65535.
2305                          */
2306                         if ((rtp->last_seqno > seqno && rtp->last_seqno - seqno < 50)
2307                                 || timestamp <= rtp->last_end_timestamp) {
2308                                 /* Out of order frame. Processing this can cause us to
2309                                  * improperly duplicate incoming DTMF, so just drop
2310                                  * this.
2311                                  */
2312                                 if (rtpdebug) {
2313                                         ast_debug(1, "Dropping out of order DTMF frame (seqno %d, ts %d, digit %c)\n",
2314                                                 seqno, timestamp, resp);
2315                                 }
2316                                 return;
2317                         }
2318
2319                         if (rtp->resp && rtp->resp != resp) {
2320                                 /* Another digit already began. End it */
2321                                 f = ast_frdup(create_dtmf_frame(instance, AST_FRAME_DTMF_END, 0));
2322                                 f->len = ast_tvdiff_ms(ast_samp2tv(rtp->dtmf_duration, rtp_get_rate(&f->subclass.format)), ast_tv(0, 0));
2323                                 rtp->resp = 0;
2324                                 rtp->dtmf_duration = rtp->dtmf_timeout = 0;
2325                                 AST_LIST_INSERT_TAIL(frames, f, frame_list);
2326                         }
2327
2328                         if (rtp->resp) {
2329                                 /* Digit continues */
2330                                 rtp->dtmf_duration = new_duration;
2331                         } else {
2332                                 /* New digit began */
2333                                 rtp->resp = resp;
2334                                 f = ast_frdup(create_dtmf_frame(instance, AST_FRAME_DTMF_BEGIN, 0));
2335                                 rtp->dtmf_duration = samples;
2336                                 AST_LIST_INSERT_TAIL(frames, f, frame_list);
2337                         }
2338
2339                         rtp->dtmf_timeout = timestamp + rtp->dtmf_duration + dtmftimeout;
2340                 }
2341
2342                 rtp->last_seqno = seqno;
2343         }
2344
2345         rtp->dtmfsamples = samples;
2346
2347         return;
2348 }
2349
2350 static struct ast_frame *process_dtmf_cisco(struct ast_rtp_instance *instance, unsigned char *data, int len, unsigned int seqno, unsigned int timestamp, struct ast_sockaddr *addr, int payloadtype, int mark)
2351 {
2352         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2353         unsigned int event, flags, power;
2354         char resp = 0;
2355         unsigned char seq;
2356         struct ast_frame *f = NULL;
2357
2358         if (len < 4) {
2359                 return NULL;
2360         }
2361
2362         /*      The format of Cisco RTP DTMF packet looks like next:
2363                 +0                              - sequence number of DTMF RTP packet (begins from 1,
2364                                                   wrapped to 0)
2365                 +1                              - set of flags
2366                 +1 (bit 0)              - flaps by different DTMF digits delimited by audio
2367                                                   or repeated digit without audio???
2368                 +2 (+4,+6,...)  - power level? (rises from 0 to 32 at begin of tone
2369                                                   then falls to 0 at its end)
2370                 +3 (+5,+7,...)  - detected DTMF digit (0..9,*,#,A-D,...)
2371                 Repeated DTMF information (bytes 4/5, 6/7) is history shifted right
2372                 by each new packet and thus provides some redudancy.
2373
2374                 Sample of Cisco RTP DTMF packet is (all data in hex):
2375                         19 07 00 02 12 02 20 02
2376                 showing end of DTMF digit '2'.
2377
2378                 The packets
2379                         27 07 00 02 0A 02 20 02
2380                         28 06 20 02 00 02 0A 02
2381                 shows begin of new digit '2' with very short pause (20 ms) after
2382                 previous digit '2'. Bit +1.0 flips at begin of new digit.
2383
2384                 Cisco RTP DTMF packets comes as replacement of audio RTP packets
2385                 so its uses the same sequencing and timestamping rules as replaced
2386                 audio packets. Repeat interval of DTMF packets is 20 ms and not rely
2387                 on audio framing parameters. Marker bit isn't used within stream of
2388                 DTMFs nor audio stream coming immediately after DTMF stream. Timestamps
2389                 are not sequential at borders between DTMF and audio streams,
2390         */
2391
2392         seq = data[0];
2393         flags = data[1];
2394         power = data[2];
2395         event = data[3] & 0x1f;
2396
2397         if (rtpdebug)
2398                 ast_debug(0, "Cisco DTMF Digit: %02x (len=%d, seq=%d, flags=%02x, power=%d, history count=%d)\n", event, len, seq, flags, power, (len - 4) / 2);
2399         if (event < 10) {
2400                 resp = '0' + event;
2401         } else if (event < 11) {
2402                 resp = '*';
2403         } else if (event < 12) {
2404                 resp = '#';
2405         } else if (event < 16) {
2406                 resp = 'A' + (event - 12);
2407         } else if (event < 17) {
2408                 resp = 'X';
2409         }
2410         if ((!rtp->resp && power) || (rtp->resp && (rtp->resp != resp))) {
2411                 rtp->resp = resp;
2412                 /* Why we should care on DTMF compensation at reception? */
2413                 if (ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_DTMF_COMPENSATE)) {
2414                         f = create_dtmf_frame(instance, AST_FRAME_DTMF_BEGIN, 0);
2415                         rtp->dtmfsamples = 0;
2416                 }
2417         } else if ((rtp->resp == resp) && !power) {
2418                 f = create_dtmf_frame(instance, AST_FRAME_DTMF_END, ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_DTMF_COMPENSATE));
2419                 f->samples = rtp->dtmfsamples * (rtp->lastrxformat.id ? (rtp_get_rate(&rtp->lastrxformat) / 1000) : 8);
2420                 rtp->resp = 0;
2421         } else if (rtp->resp == resp)
2422                 rtp->dtmfsamples += 20 * (rtp->lastrxformat.id ? (rtp_get_rate(&rtp->lastrxformat) / 1000) : 8);
2423
2424         rtp->dtmf_timeout = 0;
2425
2426         return f;
2427 }
2428
2429 static struct ast_frame *process_cn_rfc3389(struct ast_rtp_instance *instance, unsigned char *data, int len, unsigned int seqno, unsigned int timestamp, struct ast_sockaddr *addr, int payloadtype, int mark)
2430 {
2431         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2432
2433         /* Convert comfort noise into audio with various codecs.  Unfortunately this doesn't
2434            totally help us out becuase we don't have an engine to keep it going and we are not
2435            guaranteed to have it every 20ms or anything */
2436         if (rtpdebug)
2437                 ast_debug(0, "- RTP 3389 Comfort noise event: Level %d (len = %d)\n", (int) rtp->lastrxformat.id, len);
2438
2439         if (ast_test_flag(rtp, FLAG_3389_WARNING)) {
2440                 struct ast_sockaddr remote_address = { {0,} };
2441
2442                 ast_rtp_instance_get_remote_address(instance, &remote_address);
2443
2444                 ast_log(LOG_NOTICE, "Comfort noise support incomplete in Asterisk (RFC 3389). Please turn off on client if possible. Client address: %s\n",
2445                         ast_sockaddr_stringify(&remote_address));
2446                 ast_set_flag(rtp, FLAG_3389_WARNING);
2447         }
2448
2449         /* Must have at least one byte */
2450         if (!len)
2451                 return NULL;
2452         if (len < 24) {
2453                 rtp->f.data.ptr = rtp->rawdata + AST_FRIENDLY_OFFSET;
2454                 rtp->f.datalen = len - 1;
2455                 rtp->f.offset = AST_FRIENDLY_OFFSET;
2456                 memcpy(rtp->f.data.ptr, data + 1, len - 1);
2457         } else {
2458                 rtp->f.data.ptr = NULL;
2459                 rtp->f.offset = 0;
2460                 rtp->f.datalen = 0;
2461         }
2462         rtp->f.frametype = AST_FRAME_CNG;
2463         rtp->f.subclass.integer = data[0] & 0x7f;
2464         rtp->f.samples = 0;
2465         rtp->f.delivery.tv_usec = rtp->f.delivery.tv_sec = 0;
2466
2467         return &rtp->f;
2468 }
2469
2470 static struct ast_frame *ast_rtcp_read(struct ast_rtp_instance *instance)
2471 {
2472         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2473         struct ast_sockaddr addr;
2474         unsigned char rtcpdata[8192 + AST_FRIENDLY_OFFSET];
2475         unsigned int *rtcpheader = (unsigned int *)(rtcpdata + AST_FRIENDLY_OFFSET);
2476         int res, packetwords, position = 0;
2477         struct ast_frame *f = &ast_null_frame;
2478
2479         /* Read in RTCP data from the socket */
2480         if ((res = rtcp_recvfrom(instance, rtcpdata + AST_FRIENDLY_OFFSET,
2481                                 sizeof(rtcpdata) - AST_FRIENDLY_OFFSET,
2482                                 0, &addr)) < 0) {
2483                 ast_assert(errno != EBADF);
2484                 if (errno != EAGAIN) {
2485                         ast_log(LOG_WARNING, "RTCP Read error: %s.  Hanging up.\n", strerror(errno));
2486                         return NULL;
2487                 }
2488                 return &ast_null_frame;
2489         }
2490
2491         /* If this was handled by the ICE session don't do anything further */
2492         if (!res) {
2493                 return &ast_null_frame;
2494         }
2495
2496         if (!*(rtcpdata + AST_FRIENDLY_OFFSET)) {
2497                 struct sockaddr_in addr_tmp;
2498                 struct ast_sockaddr addr_v4;
2499
2500                 if (ast_sockaddr_is_ipv4(&addr)) {
2501                         ast_sockaddr_to_sin(&addr, &addr_tmp);
2502                 } else if (ast_sockaddr_ipv4_mapped(&addr, &addr_v4)) {
2503                         ast_debug(1, "Using IPv6 mapped address %s for STUN\n",
2504                                   ast_sockaddr_stringify(&addr));
2505                         ast_sockaddr_to_sin(&addr_v4, &addr_tmp);
2506                 } else {
2507                         ast_debug(1, "Cannot do STUN for non IPv4 address %s\n",
2508                                   ast_sockaddr_stringify(&addr));
2509                         return &ast_null_frame;
2510                 }
2511                 if ((ast_stun_handle_packet(rtp->rtcp->s, &addr_tmp, rtcpdata + AST_FRIENDLY_OFFSET, res, NULL, NULL) == AST_STUN_ACCEPT)) {
2512                         ast_sockaddr_from_sin(&addr, &addr_tmp);
2513                         ast_sockaddr_copy(&rtp->rtcp->them, &addr);
2514                 }
2515                 return &ast_null_frame;
2516         }
2517
2518         packetwords = res / 4;
2519
2520         if (ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_NAT)) {
2521                 /* Send to whoever sent to us */
2522                 if (ast_sockaddr_cmp(&rtp->rtcp->them, &addr)) {
2523                         ast_sockaddr_copy(&rtp->rtcp->them, &addr);
2524                         if (rtpdebug)
2525                                 ast_debug(0, "RTCP NAT: Got RTCP from other end. Now sending to address %s\n",
2526                                           ast_sockaddr_stringify(&rtp->rtcp->them));
2527                 }
2528         }
2529
2530         ast_debug(1, "Got RTCP report of %d bytes\n", res);
2531
2532         while (position < packetwords) {
2533                 int i, pt, rc;
2534                 unsigned int length, dlsr, lsr, msw, lsw, comp;
2535                 struct timeval now;
2536                 double rttsec, reported_jitter, reported_normdev_jitter_current, normdevrtt_current, reported_lost, reported_normdev_lost_current;
2537                 uint64_t rtt = 0;
2538
2539                 i = position;
2540                 length = ntohl(rtcpheader[i]);
2541                 pt = (length & 0xff0000) >> 16;
2542                 rc = (length & 0x1f000000) >> 24;
2543                 length &= 0xffff;
2544
2545                 if ((i + length) > packetwords) {
2546                         if (rtpdebug)
2547                                 ast_debug(1, "RTCP Read too short\n");
2548                         return &ast_null_frame;
2549                 }
2550
2551                 if (rtcp_debug_test_addr(&addr)) {
2552                         ast_verbose("\n\nGot RTCP from %s\n",
2553                                     ast_sockaddr_stringify(&addr));
2554                         ast_verbose("PT: %d(%s)\n", pt, (pt == 200) ? "Sender Report" : (pt == 201) ? "Receiver Report" : (pt == 192) ? "H.261 FUR" : "Unknown");
2555                         ast_verbose("Reception reports: %d\n", rc);
2556                         ast_verbose("SSRC of sender: %u\n", rtcpheader[i + 1]);
2557                 }
2558
2559                 i += 2; /* Advance past header and ssrc */
2560                 if (rc == 0 && pt == RTCP_PT_RR) {      /* We're receiving a receiver report with no reports, which is ok */
2561                         position += (length + 1);
2562                         continue;
2563                 }
2564
2565                 switch (pt) {
2566                 case RTCP_PT_SR:
2567                         gettimeofday(&rtp->rtcp->rxlsr,NULL); /* To be able to populate the dlsr */
2568                         rtp->rtcp->spc = ntohl(rtcpheader[i+3]);
2569                         rtp->rtcp->soc = ntohl(rtcpheader[i + 4]);
2570                         rtp->rtcp->themrxlsr = ((ntohl(rtcpheader[i]) & 0x0000ffff) << 16) | ((ntohl(rtcpheader[i + 1]) & 0xffff0000) >> 16); /* Going to LSR in RR*/
2571
2572                         if (rtcp_debug_test_addr(&addr)) {
2573                                 ast_verbose("NTP timestamp: %lu.%010lu\n", (unsigned long) ntohl(rtcpheader[i]), (unsigned long) ntohl(rtcpheader[i + 1]) * 4096);
2574                                 ast_verbose("RTP timestamp: %lu\n", (unsigned long) ntohl(rtcpheader[i + 2]));
2575                                 ast_verbose("SPC: %lu\tSOC: %lu\n", (unsigned long) ntohl(rtcpheader[i + 3]), (unsigned long) ntohl(rtcpheader[i + 4]));
2576                         }
2577                         i += 5;
2578                         if (rc < 1)
2579                                 break;
2580                         /* Intentional fall through */
2581                 case RTCP_PT_RR:
2582                         /* Don't handle multiple reception reports (rc > 1) yet */
2583                         /* Calculate RTT per RFC */
2584                         gettimeofday(&now, NULL);
2585                         timeval2ntp(now, &msw, &lsw);
2586                         if (ntohl(rtcpheader[i + 4]) && ntohl(rtcpheader[i + 5])) { /* We must have the LSR && DLSR */
2587                                 comp = ((msw & 0xffff) << 16) | ((lsw & 0xffff0000) >> 16);
2588                                 lsr = ntohl(rtcpheader[i + 4]);
2589                                 dlsr = ntohl(rtcpheader[i + 5]);
2590                                 rtt = comp - lsr - dlsr;
2591
2592                                 /* Convert end to end delay to usec (keeping the calculation in 64bit space)
2593                                    sess->ee_delay = (eedelay * 1000) / 65536; */
2594                                 if (rtt < 4294) {
2595                                         rtt = (rtt * 1000000) >> 16;
2596                                 } else {
2597                                         rtt = (rtt * 1000) >> 16;
2598                                         rtt *= 1000;
2599                                 }
2600                                 rtt = rtt / 1000.;
2601                                 rttsec = rtt / 1000.;
2602                                 rtp->rtcp->rtt = rttsec;
2603
2604                                 if (comp - dlsr >= lsr) {
2605                                         rtp->rtcp->accumulated_transit += rttsec;
2606
2607                                         if (rtp->rtcp->rtt_count == 0)
2608                                                 rtp->rtcp->minrtt = rttsec;
2609
2610                                         if (rtp->rtcp->maxrtt<rttsec)
2611                                                 rtp->rtcp->maxrtt = rttsec;
2612                                         if (rtp->rtcp->minrtt>rttsec)
2613                                                 rtp->rtcp->minrtt = rttsec;
2614
2615                                         normdevrtt_current = normdev_compute(rtp->rtcp->normdevrtt, rttsec, rtp->rtcp->rtt_count);
2616
2617                                         rtp->rtcp->stdevrtt = stddev_compute(rtp->rtcp->stdevrtt, rttsec, rtp->rtcp->normdevrtt, normdevrtt_current, rtp->rtcp->rtt_count);
2618
2619                                         rtp->rtcp->normdevrtt = normdevrtt_current;
2620
2621                                         rtp->rtcp->rtt_count++;
2622                                 } else if (rtcp_debug_test_addr(&addr)) {
2623                                         ast_verbose("Internal RTCP NTP clock skew detected: "
2624                                                            "lsr=%u, now=%u, dlsr=%u (%d:%03dms), "
2625                                                     "diff=%d\n",
2626                                                     lsr, comp, dlsr, dlsr / 65536,
2627                                                     (dlsr % 65536) * 1000 / 65536,
2628                                                     dlsr - (comp - lsr));
2629                                 }
2630                         }
2631
2632                         rtp->rtcp->reported_jitter = ntohl(rtcpheader[i + 3]);
2633                         reported_jitter = (double) rtp->rtcp->reported_jitter;
2634
2635                         if (rtp->rtcp->reported_jitter_count == 0)
2636                                 rtp->rtcp->reported_minjitter = reported_jitter;
2637
2638                         if (reported_jitter < rtp->rtcp->reported_minjitter)
2639                                 rtp->rtcp->reported_minjitter = reported_jitter;
2640
2641                         if (reported_jitter > rtp->rtcp->reported_maxjitter)
2642                                 rtp->rtcp->reported_maxjitter = reported_jitter;
2643
2644                         reported_normdev_jitter_current = normdev_compute(rtp->rtcp->reported_normdev_jitter, reported_jitter, rtp->rtcp->reported_jitter_count);
2645
2646                         rtp->rtcp->reported_stdev_jitter = stddev_compute(rtp->rtcp->reported_stdev_jitter, reported_jitter, rtp->rtcp->reported_normdev_jitter, reported_normdev_jitter_current, rtp->rtcp->reported_jitter_count);
2647
2648                         rtp->rtcp->reported_normdev_jitter = reported_normdev_jitter_current;
2649
2650                         rtp->rtcp->reported_lost = ntohl(rtcpheader[i + 1]) & 0xffffff;
2651
2652                         reported_lost = (double) rtp->rtcp->reported_lost;
2653
2654                         /* using same counter as for jitter */
2655                         if (rtp->rtcp->reported_jitter_count == 0)
2656                                 rtp->rtcp->reported_minlost = reported_lost;
2657
2658                         if (reported_lost < rtp->rtcp->reported_minlost)
2659                                 rtp->rtcp->reported_minlost = reported_lost;
2660
2661                         if (reported_lost > rtp->rtcp->reported_maxlost)
2662                                 rtp->rtcp->reported_maxlost = reported_lost;
2663                         reported_normdev_lost_current = normdev_compute(rtp->rtcp->reported_normdev_lost, reported_lost, rtp->rtcp->reported_jitter_count);
2664
2665                         rtp->rtcp->reported_stdev_lost = stddev_compute(rtp->rtcp->reported_stdev_lost, reported_lost, rtp->rtcp->reported_normdev_lost, reported_normdev_lost_current, rtp->rtcp->reported_jitter_count);
2666
2667                         rtp->rtcp->reported_normdev_lost = reported_normdev_lost_current;
2668
2669                         rtp->rtcp->reported_jitter_count++;
2670
2671                         if (rtcp_debug_test_addr(&addr)) {
2672                                 ast_verbose("  Fraction lost: %ld\n", (((long) ntohl(rtcpheader[i + 1]) & 0xff000000) >> 24));
2673                                 ast_verbose("  Packets lost so far: %d\n", rtp->rtcp->reported_lost);
2674                                 ast_verbose("  Highest sequence number: %ld\n", (long) (ntohl(rtcpheader[i + 2]) & 0xffff));
2675                                 ast_verbose("  Sequence number cycles: %ld\n", (long) (ntohl(rtcpheader[i + 2])) >> 16);
2676                                 ast_verbose("  Interarrival jitter: %u\n", rtp->rtcp->reported_jitter);
2677                                 ast_verbose("  Last SR(our NTP): %lu.%010lu\n",(unsigned long) ntohl(rtcpheader[i + 4]) >> 16,((unsigned long) ntohl(rtcpheader[i + 4]) << 16) * 4096);
2678                                 ast_verbose("  DLSR: %4.4f (sec)\n",ntohl(rtcpheader[i + 5])/65536.0);
2679                                 if (rtt)
2680                                         ast_verbose("  RTT: %lu(sec)\n", (unsigned long) rtt);
2681                         }
2682                         if (rtt) {
2683                                 manager_event(EVENT_FLAG_REPORTING, "RTCPReceived", "From: %s\r\n"
2684                                                                     "PT: %d(%s)\r\n"
2685                                                                     "ReceptionReports: %d\r\n"
2686                                                                     "SenderSSRC: %u\r\n"
2687                                                                     "FractionLost: %ld\r\n"
2688                                                                     "PacketsLost: %d\r\n"
2689                                                                     "HighestSequence: %ld\r\n"
2690                                                                     "SequenceNumberCycles: %ld\r\n"
2691                                                                     "IAJitter: %u\r\n"
2692                                                                     "LastSR: %lu.%010lu\r\n"
2693                                                                     "DLSR: %4.4f(sec)\r\n"
2694                                               "RTT: %llu(sec)\r\n",
2695                                               ast_sockaddr_stringify(&addr),
2696                                               pt, (pt == 200) ? "Sender Report" : (pt == 201) ? "Receiver Report" : (pt == 192) ? "H.261 FUR" : "Unknown",
2697                                               rc,
2698                                               rtcpheader[i + 1],
2699                                               (((long) ntohl(rtcpheader[i + 1]) & 0xff000000) >> 24),
2700                                               rtp->rtcp->reported_lost,
2701                                               (long) (ntohl(rtcpheader[i + 2]) & 0xffff),
2702                                               (long) (ntohl(rtcpheader[i + 2])) >> 16,
2703                                               rtp->rtcp->reported_jitter,
2704                                               (unsigned long) ntohl(rtcpheader[i + 4]) >> 16, ((unsigned long) ntohl(rtcpheader[i + 4]) << 16) * 4096,
2705                                               ntohl(rtcpheader[i + 5])/65536.0,
2706                                               (unsigned long long)rtt);
2707                         } else {
2708                                 manager_event(EVENT_FLAG_REPORTING, "RTCPReceived", "From: %s\r\n"
2709                                                                     "PT: %d(%s)\r\n"
2710                                                                     "ReceptionReports: %d\r\n"
2711                                                                     "SenderSSRC: %u\r\n"
2712                                                                     "FractionLost: %ld\r\n"
2713                                                                     "PacketsLost: %d\r\n"
2714                                                                     "HighestSequence: %ld\r\n"
2715                                                                     "SequenceNumberCycles: %ld\r\n"
2716                                                                     "IAJitter: %u\r\n"
2717                                                                     "LastSR: %lu.%010lu\r\n"
2718                                               "DLSR: %4.4f(sec)\r\n",
2719                                               ast_sockaddr_stringify(&addr),
2720                                               pt, (pt == 200) ? "Sender Report" : (pt == 201) ? "Receiver Report" : (pt == 192) ? "H.261 FUR" : "Unknown",
2721                                               rc,
2722                                               rtcpheader[i + 1],
2723                                               (((long) ntohl(rtcpheader[i + 1]) & 0xff000000) >> 24),
2724                                               rtp->rtcp->reported_lost,
2725                                               (long) (ntohl(rtcpheader[i + 2]) & 0xffff),
2726                                               (long) (ntohl(rtcpheader[i + 2])) >> 16,
2727                                               rtp->rtcp->reported_jitter,
2728                                               (unsigned long) ntohl(rtcpheader[i + 4]) >> 16,
2729                                               ((unsigned long) ntohl(rtcpheader[i + 4]) << 16) * 4096,
2730                                               ntohl(rtcpheader[i + 5])/65536.0);
2731                         }
2732                         break;
2733                 case RTCP_PT_FUR:
2734                         if (rtcp_debug_test_addr(&addr))
2735                                 ast_verbose("Received an RTCP Fast Update Request\n");
2736                         rtp->f.frametype = AST_FRAME_CONTROL;
2737                         rtp->f.subclass.integer = AST_CONTROL_VIDUPDATE;
2738                         rtp->f.datalen = 0;
2739                         rtp->f.samples = 0;
2740                         rtp->f.mallocd = 0;
2741                         rtp->f.src = "RTP";
2742                         f = &rtp->f;
2743                         break;
2744                 case RTCP_PT_SDES:
2745                         if (rtcp_debug_test_addr(&addr))
2746                                 ast_verbose("Received an SDES from %s\n",
2747                                             ast_sockaddr_stringify(&rtp->rtcp->them));
2748                         break;
2749                 case RTCP_PT_BYE:
2750                         if (rtcp_debug_test_addr(&addr))
2751                                 ast_verbose("Received a BYE from %s\n",
2752                                             ast_sockaddr_stringify(&rtp->rtcp->them));
2753                         break;
2754                 default:
2755                         ast_debug(1, "Unknown RTCP packet (pt=%d) received from %s\n",
2756                                   pt, ast_sockaddr_stringify(&rtp->rtcp->them));
2757                         break;
2758                 }
2759                 position += (length + 1);
2760         }
2761
2762         rtp->rtcp->rtcp_info = 1;
2763
2764         return f;
2765 }
2766
2767 static int bridge_p2p_rtp_write(struct ast_rtp_instance *instance, unsigned int *rtpheader, int len, int hdrlen)
2768 {
2769         struct ast_rtp_instance *instance1 = ast_rtp_instance_get_bridged(instance);
2770         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance), *bridged = ast_rtp_instance_get_data(instance1);
2771         int res = 0, payload = 0, bridged_payload = 0, mark;
2772         struct ast_rtp_payload_type payload_type;
2773         int reconstruct = ntohl(rtpheader[0]);
2774         struct ast_sockaddr remote_address = { {0,} };
2775         int ice;
2776
2777         /* Get fields from packet */
2778         payload = (reconstruct & 0x7f0000) >> 16;
2779         mark = (((reconstruct & 0x800000) >> 23) != 0);
2780
2781         /* Check what the payload value should be */
2782         payload_type = ast_rtp_codecs_payload_lookup(ast_rtp_instance_get_codecs(instance), payload);
2783
2784         /* Otherwise adjust bridged payload to match */
2785         bridged_payload = ast_rtp_codecs_payload_code(ast_rtp_instance_get_codecs(instance1), payload_type.asterisk_format, &payload_type.format, payload_type.rtp_code);
2786
2787         /* If no codec could be matched between instance and instance1, then somehow things were made incompatible while we were still bridged.  Bail. */
2788         if (bridged_payload < 0) {
2789                 return -1;
2790         }
2791
2792         /* If the payload coming in is not one of the negotiated ones then send it to the core, this will cause formats to change and the bridge to break */
2793         if (ast_rtp_codecs_find_payload_code(ast_rtp_instance_get_codecs(instance1),bridged_payload) == -1)
2794         {
2795                 ast_debug(1, "Unsupported payload type received \n");
2796                 return -1;
2797         }
2798
2799         /* If the marker bit has been explicitly set turn it on */
2800         if (ast_test_flag(rtp, FLAG_NEED_MARKER_BIT)) {
2801                 mark = 1;
2802                 ast_clear_flag(rtp, FLAG_NEED_MARKER_BIT);
2803         }
2804
2805         /* Reconstruct part of the packet */
2806         reconstruct &= 0xFF80FFFF;
2807         reconstruct |= (bridged_payload << 16);
2808         reconstruct |= (mark << 23);
2809         rtpheader[0] = htonl(reconstruct);
2810
2811         ast_rtp_instance_get_remote_address(instance1, &remote_address);
2812
2813         if (ast_sockaddr_isnull(&remote_address)) {
2814                 ast_debug(1, "Remote address is null, most likely RTP has been stopped\n");
2815                 return 0;
2816         }
2817
2818         /* Send the packet back out */
2819         res = rtp_sendto(instance1, (void *)rtpheader, len, 0, &remote_address, &ice);
2820         if (res < 0) {
2821                 if (!ast_rtp_instance_get_prop(instance1, AST_RTP_PROPERTY_NAT) || (ast_rtp_instance_get_prop(instance1, AST_RTP_PROPERTY_NAT) && (ast_test_flag(bridged, FLAG_NAT_ACTIVE) == FLAG_NAT_ACTIVE))) {
2822                         ast_log(LOG_WARNING,
2823                                 "RTP Transmission error of packet to %s: %s\n",
2824                                 ast_sockaddr_stringify(&remote_address),
2825                                 strerror(errno));
2826                 } else if (((ast_test_flag(bridged, FLAG_NAT_ACTIVE) == FLAG_NAT_INACTIVE) || rtpdebug) && !ast_test_flag(bridged, FLAG_NAT_INACTIVE_NOWARN)) {
2827                         if (option_debug || rtpdebug)
2828                                 ast_log(LOG_WARNING,
2829                                         "RTP NAT: Can't write RTP to private "
2830                                         "address %s, waiting for other end to "
2831                                         "send audio...\n",
2832                                         ast_sockaddr_stringify(&remote_address));
2833                         ast_set_flag(bridged, FLAG_NAT_INACTIVE_NOWARN);
2834                 }
2835                 return 0;
2836         }
2837
2838         update_address_with_ice_candidate(rtp, COMPONENT_RTP, &remote_address);
2839
2840         if (rtp_debug_test_addr(&remote_address)) {
2841                 ast_verbose("Sent RTP P2P packet to %s%s (type %-2.2d, len %-6.6u)\n",
2842                             ast_sockaddr_stringify(&remote_address),
2843                             ice ? " (via ICE)" : "",
2844                             bridged_payload, len - hdrlen);
2845         }
2846
2847         return 0;
2848 }
2849
2850 static struct ast_frame *ast_rtp_read(struct ast_rtp_instance *instance, int rtcp)
2851 {
2852         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2853         struct ast_sockaddr addr;
2854         int res, hdrlen = 12, version, payloadtype, padding, mark, ext, cc, prev_seqno;
2855         unsigned int *rtpheader = (unsigned int*)(rtp->rawdata + AST_FRIENDLY_OFFSET), seqno, ssrc, timestamp;
2856         struct ast_rtp_payload_type payload;
2857         struct ast_sockaddr remote_address = { {0,} };
2858         struct frame_list frames;
2859
2860         /* If this is actually RTCP let's hop on over and handle it */
2861         if (rtcp) {
2862                 if (rtp->rtcp) {
2863                         return ast_rtcp_read(instance);
2864                 }
2865                 return &ast_null_frame;
2866         }
2867
2868         /* If we are currently sending DTMF to the remote party send a continuation packet */
2869         if (rtp->sending_digit) {
2870                 ast_rtp_dtmf_continuation(instance);
2871         }
2872
2873         /* Actually read in the data from the socket */
2874         if ((res = rtp_recvfrom(instance, rtp->rawdata + AST_FRIENDLY_OFFSET,
2875                                 sizeof(rtp->rawdata) - AST_FRIENDLY_OFFSET, 0,
2876                                 &addr)) < 0) {
2877                 ast_assert(errno != EBADF);
2878                 if (errno != EAGAIN) {
2879                         ast_log(LOG_WARNING, "RTP Read error: %s. Hanging up.\n", strerror(errno));
2880                         return NULL;
2881                 }
2882                 return &ast_null_frame;
2883         }
2884
2885         /* If this was handled by the ICE session don't do anything */
2886         if (!res) {
2887                 return &ast_null_frame;
2888         }
2889
2890         /* Make sure the data that was read in is actually enough to make up an RTP packet */
2891         if (res < hdrlen) {
2892                 ast_log(LOG_WARNING, "RTP Read too short\n");
2893                 return &ast_null_frame;
2894         }
2895
2896         /* Get fields and verify this is an RTP packet */
2897         seqno = ntohl(rtpheader[0]);
2898
2899         ast_rtp_instance_get_remote_address(instance, &remote_address);
2900
2901         if (!(version = (seqno & 0xC0000000) >> 30)) {
2902                 struct sockaddr_in addr_tmp;
2903                 struct ast_sockaddr addr_v4;
2904                 if (ast_sockaddr_is_ipv4(&addr)) {
2905                         ast_sockaddr_to_sin(&addr, &addr_tmp);
2906                 } else if (ast_sockaddr_ipv4_mapped(&addr, &addr_v4)) {
2907                         ast_debug(1, "Using IPv6 mapped address %s for STUN\n",
2908                                   ast_sockaddr_stringify(&addr));
2909                         ast_sockaddr_to_sin(&addr_v4, &addr_tmp);
2910                 } else {
2911                         ast_debug(1, "Cannot do STUN for non IPv4 address %s\n",
2912                                   ast_sockaddr_stringify(&addr));
2913                         return &ast_null_frame;
2914                 }
2915                 if ((ast_stun_handle_packet(rtp->s, &addr_tmp, rtp->rawdata + AST_FRIENDLY_OFFSET, res, NULL, NULL) == AST_STUN_ACCEPT) &&
2916                     ast_sockaddr_isnull(&remote_address)) {
2917                         ast_sockaddr_from_sin(&addr, &addr_tmp);
2918                         ast_rtp_instance_set_remote_address(instance, &addr);
2919                 }
2920                 return &ast_null_frame;
2921         }
2922
2923         /* If strict RTP protection is enabled see if we need to learn the remote address or if we need to drop the packet */
2924         if (rtp->strict_rtp_state == STRICT_RTP_LEARN) {
2925                 ast_debug(1, "%p -- start learning mode pass with addr = %s\n", rtp, ast_sockaddr_stringify(&addr));
2926                 /* For now, we always copy the address. */
2927                 ast_sockaddr_copy(&rtp->strict_rtp_address, &addr);
2928
2929                 /* Send the rtp and the seqno from header to rtp_learning_rtp_seq_update to see whether we can exit or not*/
2930                 if (rtp_learning_rtp_seq_update(rtp, ntohl(rtpheader[0]))) {
2931                         ast_debug(1, "%p -- Condition for learning hasn't exited, so reject the frame.\n", rtp);
2932                         return &ast_null_frame;
2933                 }
2934
2935                 ast_debug(1, "%p -- Probation Ended. Set strict_rtp_state to STRICT_RTP_CLOSED with address %s\n", rtp, ast_sockaddr_stringify(&addr));
2936                 rtp->strict_rtp_state = STRICT_RTP_CLOSED;
2937         } else if (rtp->strict_rtp_state == STRICT_RTP_CLOSED) {
2938                 if (ast_sockaddr_cmp(&rtp->strict_rtp_address, &addr)) {
2939                         /* Hmm, not the strict addres. Perhaps we're getting audio from the alternate? */
2940                         if (!ast_sockaddr_cmp(&rtp->alt_rtp_address, &addr)) {
2941                                 /* ooh, we did! You're now the new expected address, son! */
2942                                 ast_sockaddr_copy(&rtp->strict_rtp_address,
2943                                                   &addr);
2944                         } else  {
2945                                 const char *real_addr = ast_strdupa(ast_sockaddr_stringify(&addr));
2946                                 const char *expected_addr = ast_strdupa(ast_sockaddr_stringify(&rtp->strict_rtp_address));
2947
2948                                 ast_debug(1, "Received RTP packet from %s, dropping due to strict RTP protection. Expected it to be from %s\n",
2949                                                 real_addr, expected_addr);
2950
2951                                 return &ast_null_frame;
2952                         }
2953                 }
2954         }
2955
2956         /* If symmetric RTP is enabled see if the remote side is not what we expected and change where we are sending audio */
2957         if (ast_rtp_instance_get_prop(instance, AST_RTP_PROPERTY_NAT)) {
2958                 if (ast_sockaddr_cmp(&remote_address, &addr)) {
2959                         ast_rtp_instance_set_remote_address(instance, &addr);
2960                         ast_sockaddr_copy(&remote_address, &addr);
2961                         if (rtp->rtcp) {
2962                                 ast_sockaddr_copy(&rtp->rtcp->them, &addr);
2963                                 ast_sockaddr_set_port(&rtp->rtcp->them, ast_sockaddr_port(&addr) + 1);
2964                         }
2965                         rtp->rxseqno = 0;
2966                         ast_set_flag(rtp, FLAG_NAT_ACTIVE);
2967                         if (rtpdebug)
2968                                 ast_debug(0, "RTP NAT: Got audio from other end. Now sending to address %s\n",
2969                                           ast_sockaddr_stringify(&remote_address));
2970                 }
2971         }
2972
2973         /* If we are directly bridged to another instance send the audio directly out */
2974         if (ast_rtp_instance_get_bridged(instance) && !bridge_p2p_rtp_write(instance, rtpheader, res, hdrlen)) {
2975                 return &ast_null_frame;
2976         }
2977
2978         /* If the version is not what we expected by this point then just drop the packet */
2979         if (version != 2) {
2980                 return &ast_null_frame;
2981         }
2982
2983         /* Pull out the various other fields we will need */
2984         payloadtype = (seqno & 0x7f0000) >> 16;
2985         padding = seqno & (1 << 29);
2986         mark = seqno & (1 << 23);
2987         ext = seqno & (1 << 28);
2988         cc = (seqno & 0xF000000) >> 24;
2989         seqno &= 0xffff;
2990         timestamp = ntohl(rtpheader[1]);
2991         ssrc = ntohl(rtpheader[2]);
2992
2993         AST_LIST_HEAD_INIT_NOLOCK(&frames);
2994         /* Force a marker bit and change SSRC if the SSRC changes */
2995         if (rtp->rxssrc && rtp->rxssrc != ssrc) {
2996                 struct ast_frame *f, srcupdate = {
2997                         AST_FRAME_CONTROL,
2998                         .subclass.integer = AST_CONTROL_SRCCHANGE,
2999                 };
3000
3001                 if (!mark) {
3002                         if (rtpdebug) {
3003                                 ast_debug(1, "Forcing Marker bit, because SSRC has changed\n");
3004                         }
3005                         mark = 1;
3006                 }
3007
3008                 f = ast_frisolate(&srcupdate);
3009                 AST_LIST_INSERT_TAIL(&frames, f, frame_list);
3010         }
3011
3012         rtp->rxssrc = ssrc;
3013
3014         /* Remove any padding bytes that may be present */
3015         if (padding) {
3016                 res -= rtp->rawdata[AST_FRIENDLY_OFFSET + res - 1];
3017         }
3018
3019       &