res_rtp_asterisk: Fix infinite DTMF issue when switching to P2P 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         <use type="external">pjproject</use>
33         <support_level>core</support_level>
34  ***/
35
36 #include "asterisk.h"
37
38 ASTERISK_REGISTER_FILE()
39
40 #include <sys/time.h>
41 #include <signal.h>
42 #include <fcntl.h>
43
44 #ifdef HAVE_OPENSSL_SRTP
45 #include <openssl/ssl.h>
46 #include <openssl/err.h>
47 #include <openssl/bio.h>
48 #endif
49
50 #ifdef HAVE_PJPROJECT
51 #include <pjlib.h>
52 #include <pjlib-util.h>
53 #include <pjnath.h>
54 #endif
55
56 #include "asterisk/stun.h"
57 #include "asterisk/pbx.h"
58 #include "asterisk/frame.h"
59 #include "asterisk/format_cache.h"
60 #include "asterisk/channel.h"
61 #include "asterisk/acl.h"
62 #include "asterisk/config.h"
63 #include "asterisk/lock.h"
64 #include "asterisk/utils.h"
65 #include "asterisk/cli.h"
66 #include "asterisk/manager.h"
67 #include "asterisk/unaligned.h"
68 #include "asterisk/module.h"
69 #include "asterisk/rtp_engine.h"
70 #include "asterisk/smoother.h"
71 #include "asterisk/test.h"
72
73 #define MAX_TIMESTAMP_SKEW      640
74
75 #define RTP_SEQ_MOD     (1<<16) /*!< A sequence number can't be more than 16 bits */
76 #define RTCP_DEFAULT_INTERVALMS   5000  /*!< Default milli-seconds between RTCP reports we send */
77 #define RTCP_MIN_INTERVALMS       500   /*!< Min milli-seconds between RTCP reports we send */
78 #define RTCP_MAX_INTERVALMS       60000 /*!< Max milli-seconds between RTCP reports we send */
79
80 #define DEFAULT_RTP_START 5000 /*!< Default port number to start allocating RTP ports from */
81 #define DEFAULT_RTP_END 31000  /*!< Default maximum port number to end allocating RTP ports at */
82
83 #define MINIMUM_RTP_PORT 1024 /*!< Minimum port number to accept */
84 #define MAXIMUM_RTP_PORT 65535 /*!< Maximum port number to accept */
85
86 #define DEFAULT_TURN_PORT 3478
87
88 #define TURN_STATE_WAIT_TIME 2000
89
90 #define RTCP_PT_FUR     192
91 #define RTCP_PT_SR      AST_RTP_RTCP_SR
92 #define RTCP_PT_RR      AST_RTP_RTCP_RR
93 #define RTCP_PT_SDES    202
94 #define RTCP_PT_BYE     203
95 #define RTCP_PT_APP     204
96 /* VP8: RTCP Feedback */
97 #define RTCP_PT_PSFB    206
98
99 #define RTP_MTU         1200
100 #define DTMF_SAMPLE_RATE_MS    8 /*!< DTMF samples per millisecond */
101
102 #define DEFAULT_DTMF_TIMEOUT (150 * (8000 / 1000))      /*!< samples */
103
104 #define ZFONE_PROFILE_ID 0x505a
105
106 #define DEFAULT_LEARNING_MIN_SEQUENTIAL 4
107
108 #define SRTP_MASTER_KEY_LEN 16
109 #define SRTP_MASTER_SALT_LEN 14
110 #define SRTP_MASTER_LEN (SRTP_MASTER_KEY_LEN + SRTP_MASTER_SALT_LEN)
111
112 enum strict_rtp_state {
113         STRICT_RTP_OPEN = 0, /*! No RTP packets should be dropped, all sources accepted */
114         STRICT_RTP_LEARN,    /*! Accept next packet as source */
115         STRICT_RTP_CLOSED,   /*! Drop all RTP packets not coming from source that was learned */
116 };
117
118 #define DEFAULT_STRICT_RTP STRICT_RTP_CLOSED
119 #define DEFAULT_ICESUPPORT 1
120
121 extern struct ast_srtp_res *res_srtp;
122 extern struct ast_srtp_policy_res *res_srtp_policy;
123
124 static int dtmftimeout = DEFAULT_DTMF_TIMEOUT;
125
126 static int rtpstart = DEFAULT_RTP_START;                        /*!< First port for RTP sessions (set in rtp.conf) */
127 static int rtpend = DEFAULT_RTP_END;                    /*!< Last port for RTP sessions (set in rtp.conf) */
128 static int rtpdebug;                    /*!< Are we debugging? */
129 static int rtcpdebug;                   /*!< Are we debugging RTCP? */
130 static int rtcpstats;                   /*!< Are we debugging RTCP? */
131 static int rtcpinterval = RTCP_DEFAULT_INTERVALMS; /*!< Time between rtcp reports in millisecs */
132 static struct ast_sockaddr rtpdebugaddr;        /*!< Debug packets to/from this host */
133 static struct ast_sockaddr rtcpdebugaddr;       /*!< Debug RTCP packets to/from this host */
134 static int rtpdebugport;                /*< Debug only RTP packets from IP or IP+Port if port is > 0 */
135 static int rtcpdebugport;               /*< Debug only RTCP packets from IP or IP+Port if port is > 0 */
136 #ifdef SO_NO_CHECK
137 static int nochecksums;
138 #endif
139 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. */
140 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. */
141 #ifdef HAVE_PJPROJECT
142 static int icesupport = DEFAULT_ICESUPPORT;
143 static struct sockaddr_in stunaddr;
144 static pj_str_t turnaddr;
145 static int turnport = DEFAULT_TURN_PORT;
146 static pj_str_t turnusername;
147 static pj_str_t turnpassword;
148
149 /*! \brief Pool factory used by pjlib to allocate memory. */
150 static pj_caching_pool cachingpool;
151
152 /*! \brief Global memory pool for configuration and timers */
153 static pj_pool_t *pool;
154
155 /*! \brief Global timer heap */
156 static pj_timer_heap_t *timer_heap;
157
158 /*! \brief Thread executing the timer heap */
159 static pj_thread_t *timer_thread;
160
161 /*! \brief Used to tell the timer thread to terminate */
162 static int timer_terminate;
163
164 /*! \brief Structure which contains ioqueue thread information */
165 struct ast_rtp_ioqueue_thread {
166         /*! \brief Pool used by the thread */
167         pj_pool_t *pool;
168         /*! \brief The thread handling the queue and timer heap */
169         pj_thread_t *thread;
170         /*! \brief Ioqueue which polls on sockets */
171         pj_ioqueue_t *ioqueue;
172         /*! \brief Timer heap for scheduled items */
173         pj_timer_heap_t *timerheap;
174         /*! \brief Termination request */
175         int terminate;
176         /*! \brief Current number of descriptors being waited on */
177         unsigned int count;
178         /*! \brief Linked list information */
179         AST_LIST_ENTRY(ast_rtp_ioqueue_thread) next;
180 };
181
182 /*! \brief List of ioqueue threads */
183 static AST_LIST_HEAD_STATIC(ioqueues, ast_rtp_ioqueue_thread);
184
185 /*! \brief Structure which contains ICE host candidate mapping information */
186 struct ast_ice_host_candidate {
187         pj_sockaddr local;
188         pj_sockaddr advertised;
189         AST_RWLIST_ENTRY(ast_ice_host_candidate) next;
190 };
191
192 /*! \brief List of ICE host candidate mappings */
193 static AST_RWLIST_HEAD_STATIC(host_candidates, ast_ice_host_candidate);
194
195 #endif
196
197 #define FLAG_3389_WARNING               (1 << 0)
198 #define FLAG_NAT_ACTIVE                 (3 << 1)
199 #define FLAG_NAT_INACTIVE               (0 << 1)
200 #define FLAG_NAT_INACTIVE_NOWARN        (1 << 1)
201 #define FLAG_NEED_MARKER_BIT            (1 << 3)
202 #define FLAG_DTMF_COMPENSATE            (1 << 4)
203
204 #define TRANSPORT_SOCKET_RTP 0
205 #define TRANSPORT_SOCKET_RTCP 1
206 #define TRANSPORT_TURN_RTP 2
207 #define TRANSPORT_TURN_RTCP 3
208
209 /*! \brief RTP learning mode tracking information */
210 struct rtp_learning_info {
211         int max_seq;    /*!< The highest sequence number received */
212         int packets;    /*!< The number of remaining packets before the source is accepted */
213 };
214
215 #ifdef HAVE_OPENSSL_SRTP
216 struct dtls_details {
217         ast_mutex_t lock; /*!< Lock for timeout timer synchronization */
218         SSL *ssl;         /*!< SSL session */
219         BIO *read_bio;    /*!< Memory buffer for reading */
220         BIO *write_bio;   /*!< Memory buffer for writing */
221         enum ast_rtp_dtls_setup dtls_setup; /*!< Current setup state */
222         enum ast_rtp_dtls_connection connection; /*!< Whether this is a new or existing connection */
223         int timeout_timer; /*!< Scheduler id for timeout timer */
224 };
225 #endif
226
227 /*! \brief RTP session description */
228 struct ast_rtp {
229         int s;
230         struct ast_frame f;
231         unsigned char rawdata[8192 + AST_FRIENDLY_OFFSET];
232         unsigned int ssrc;              /*!< Synchronization source, RFC 3550, page 10. */
233         unsigned int themssrc;          /*!< Their SSRC */
234         unsigned int rxssrc;
235         unsigned int lastts;
236         unsigned int lastrxts;
237         unsigned int lastividtimestamp;
238         unsigned int lastovidtimestamp;
239         unsigned int lastitexttimestamp;
240         unsigned int lastotexttimestamp;
241         unsigned int lasteventseqn;
242         int lastrxseqno;                /*!< Last received sequence number */
243         unsigned short seedrxseqno;     /*!< What sequence number did they start with?*/
244         unsigned int seedrxts;          /*!< What RTP timestamp did they start with? */
245         unsigned int rxcount;           /*!< How many packets have we received? */
246         unsigned int rxoctetcount;      /*!< How many octets have we received? should be rxcount *160*/
247         unsigned int txcount;           /*!< How many packets have we sent? */
248         unsigned int txoctetcount;      /*!< How many octets have we sent? (txcount*160)*/
249         unsigned int cycles;            /*!< Shifted count of sequence number cycles */
250         double rxjitter;                /*!< Interarrival jitter at the moment in seconds */
251         double rxtransit;               /*!< Relative transit time for previous packet */
252         struct ast_format *lasttxformat;
253         struct ast_format *lastrxformat;
254
255         int rtptimeout;                 /*!< RTP timeout time (negative or zero means disabled, negative value means temporarily disabled) */
256         int rtpholdtimeout;             /*!< RTP timeout when on hold (negative or zero means disabled, negative value means temporarily disabled). */
257         int rtpkeepalive;               /*!< Send RTP comfort noice packets for keepalive */
258
259         /* DTMF Reception Variables */
260         char resp;                        /*!< The current digit being processed */
261         unsigned int last_seqno;          /*!< The last known sequence number for any DTMF packet */
262         unsigned int last_end_timestamp;  /*!< The last known timestamp received from an END packet */
263         unsigned int dtmf_duration;       /*!< Total duration in samples since the digit start event */
264         unsigned int dtmf_timeout;        /*!< When this timestamp is reached we consider END frame lost and forcibly abort digit */
265         unsigned int dtmfsamples;
266         enum ast_rtp_dtmf_mode dtmfmode;  /*!< The current DTMF mode of the RTP stream */
267         /* DTMF Transmission Variables */
268         unsigned int lastdigitts;
269         char sending_digit;     /*!< boolean - are we sending digits */
270         char send_digit;        /*!< digit we are sending */
271         int send_payload;
272         int send_duration;
273         unsigned int flags;
274         struct timeval rxcore;
275         struct timeval txcore;
276         double drxcore;                 /*!< The double representation of the first received packet */
277         struct timeval lastrx;          /*!< timeval when we last received a packet */
278         struct timeval dtmfmute;
279         struct ast_smoother *smoother;
280         int *ioid;
281         unsigned short seqno;           /*!< Sequence number, RFC 3550, page 13. */
282         unsigned short rxseqno;
283         struct ast_sched_context *sched;
284         struct io_context *io;
285         void *data;
286         struct ast_rtcp *rtcp;
287         struct ast_rtp *bridged;        /*!< Who we are Packet bridged to */
288
289         enum strict_rtp_state strict_rtp_state; /*!< Current state that strict RTP protection is in */
290         struct ast_sockaddr strict_rtp_address;  /*!< Remote address information for strict RTP purposes */
291
292         /*
293          * Learning mode values based on pjmedia's probation mode.  Many of these values are redundant to the above,
294          * but these are in place to keep learning mode sequence values sealed from their normal counterparts.
295          */
296         struct rtp_learning_info rtp_source_learn;      /* Learning mode track for the expected RTP source */
297         struct rtp_learning_info alt_source_learn;      /* Learning mode tracking for a new RTP source after one has been chosen */
298
299         struct rtp_red *red;
300
301         ast_mutex_t lock;           /*!< Lock for synchronization purposes */
302         ast_cond_t cond;            /*!< Condition for signaling */
303
304 #ifdef HAVE_PJPROJECT
305         pj_ice_sess *ice;           /*!< ICE session */
306         pj_turn_sock *turn_rtp;     /*!< RTP TURN relay */
307         pj_turn_sock *turn_rtcp;    /*!< RTCP TURN relay */
308         pj_turn_state_t turn_state; /*!< Current state of the TURN relay session */
309         unsigned int passthrough:1; /*!< Bit to indicate that the received packet should be passed through */
310         unsigned int rtp_passthrough:1; /*!< Bit to indicate that TURN RTP should be passed through */
311         unsigned int rtcp_passthrough:1; /*!< Bit to indicate that TURN RTCP should be passed through */
312         unsigned int ice_port;      /*!< Port that ICE was started with if it was previously started */
313         struct ast_sockaddr rtp_loop; /*!< Loopback address for forwarding RTP from TURN */
314         struct ast_sockaddr rtcp_loop; /*!< Loopback address for forwarding RTCP from TURN */
315
316         struct ast_rtp_ioqueue_thread *ioqueue; /*!< The ioqueue thread handling us */
317
318         char remote_ufrag[256];  /*!< The remote ICE username */
319         char remote_passwd[256]; /*!< The remote ICE password */
320
321         char local_ufrag[256];  /*!< The local ICE username */
322         char local_passwd[256]; /*!< The local ICE password */
323
324         struct ao2_container *ice_local_candidates;           /*!< The local ICE candidates */
325         struct ao2_container *ice_active_remote_candidates;   /*!< The remote ICE candidates */
326         struct ao2_container *ice_proposed_remote_candidates; /*!< Incoming remote ICE candidates for new session */
327         struct ast_sockaddr ice_original_rtp_addr;            /*!< rtp address that ICE started on first session */
328 #endif
329
330 #ifdef HAVE_OPENSSL_SRTP
331         SSL_CTX *ssl_ctx; /*!< SSL context */
332         enum ast_rtp_dtls_verify dtls_verify; /*!< What to verify */
333         enum ast_srtp_suite suite;   /*!< SRTP crypto suite */
334         enum ast_rtp_dtls_hash local_hash; /*!< Local hash used for the fingerprint */
335         char local_fingerprint[160]; /*!< Fingerprint of our certificate */
336         enum ast_rtp_dtls_hash remote_hash; /*!< Remote hash used for the fingerprint */
337         unsigned char remote_fingerprint[EVP_MAX_MD_SIZE]; /*!< Fingerprint of the peer certificate */
338         unsigned int rekey; /*!< Interval at which to renegotiate and rekey */
339         int rekeyid; /*!< Scheduled item id for rekeying */
340         struct dtls_details dtls; /*!< DTLS state information */
341 #endif
342 };
343
344 /*!
345  * \brief Structure defining an RTCP session.
346  *
347  * The concept "RTCP session" is not defined in RFC 3550, but since
348  * this structure is analogous to ast_rtp, which tracks a RTP session,
349  * it is logical to think of this as a RTCP session.
350  *
351  * RTCP packet is defined on page 9 of RFC 3550.
352  *
353  */
354 struct ast_rtcp {
355         int rtcp_info;
356         int s;                          /*!< Socket */
357         struct ast_sockaddr us;         /*!< Socket representation of the local endpoint. */
358         struct ast_sockaddr them;       /*!< Socket representation of the remote endpoint. */
359         unsigned int soc;               /*!< What they told us */
360         unsigned int spc;               /*!< What they told us */
361         unsigned int themrxlsr;         /*!< The middle 32 bits of the NTP timestamp in the last received SR*/
362         struct timeval rxlsr;           /*!< Time when we got their last SR */
363         struct timeval txlsr;           /*!< Time when we sent or last SR*/
364         unsigned int expected_prior;    /*!< no. packets in previous interval */
365         unsigned int received_prior;    /*!< no. packets received in previous interval */
366         int schedid;                    /*!< Schedid returned from ast_sched_add() to schedule RTCP-transmissions*/
367         unsigned int rr_count;          /*!< number of RRs we've sent, not including report blocks in SR's */
368         unsigned int sr_count;          /*!< number of SRs we've sent */
369         unsigned int lastsrtxcount;     /*!< Transmit packet count when last SR sent */
370         double accumulated_transit;     /*!< accumulated a-dlsr-lsr */
371         double rtt;                     /*!< Last reported rtt */
372         unsigned int reported_jitter;   /*!< The contents of their last jitter entry in the RR */
373         unsigned int reported_lost;     /*!< Reported lost packets in their RR */
374
375         double reported_maxjitter;
376         double reported_minjitter;
377         double reported_normdev_jitter;
378         double reported_stdev_jitter;
379         unsigned int reported_jitter_count;
380
381         double reported_maxlost;
382         double reported_minlost;
383         double reported_normdev_lost;
384         double reported_stdev_lost;
385
386         double rxlost;
387         double maxrxlost;
388         double minrxlost;
389         double normdev_rxlost;
390         double stdev_rxlost;
391         unsigned int rxlost_count;
392
393         double maxrxjitter;
394         double minrxjitter;
395         double normdev_rxjitter;
396         double stdev_rxjitter;
397         unsigned int rxjitter_count;
398         double maxrtt;
399         double minrtt;
400         double normdevrtt;
401         double stdevrtt;
402         unsigned int rtt_count;
403
404         /* VP8: sequence number for the RTCP FIR FCI */
405         int firseq;
406
407 #ifdef HAVE_OPENSSL_SRTP
408         struct dtls_details dtls; /*!< DTLS state information */
409 #endif
410
411         /* Cached local address string allows us to generate
412          * RTCP stasis messages without having to look up our
413          * own address every time
414          */
415         char *local_addr_str;
416 };
417
418 struct rtp_red {
419         struct ast_frame t140;  /*!< Primary data  */
420         struct ast_frame t140red;   /*!< Redundant t140*/
421         unsigned char pt[AST_RED_MAX_GENERATION];  /*!< Payload types for redundancy data */
422         unsigned char ts[AST_RED_MAX_GENERATION]; /*!< Time stamps */
423         unsigned char len[AST_RED_MAX_GENERATION]; /*!< length of each generation */
424         int num_gen; /*!< Number of generations */
425         int schedid; /*!< Timer id */
426         int ti; /*!< How long to buffer data before send */
427         unsigned char t140red_data[64000];
428         unsigned char buf_data[64000]; /*!< buffered primary data */
429         int hdrlen;
430         long int prev_ts;
431 };
432
433 AST_LIST_HEAD_NOLOCK(frame_list, ast_frame);
434
435 /* Forward Declarations */
436 static int ast_rtp_new(struct ast_rtp_instance *instance, struct ast_sched_context *sched, struct ast_sockaddr *addr, void *data);
437 static int ast_rtp_destroy(struct ast_rtp_instance *instance);
438 static int ast_rtp_dtmf_begin(struct ast_rtp_instance *instance, char digit);
439 static int ast_rtp_dtmf_end(struct ast_rtp_instance *instance, char digit);
440 static int ast_rtp_dtmf_end_with_duration(struct ast_rtp_instance *instance, char digit, unsigned int duration);
441 static int ast_rtp_dtmf_mode_set(struct ast_rtp_instance *instance, enum ast_rtp_dtmf_mode dtmf_mode);
442 static enum ast_rtp_dtmf_mode ast_rtp_dtmf_mode_get(struct ast_rtp_instance *instance);
443 static void ast_rtp_update_source(struct ast_rtp_instance *instance);
444 static void ast_rtp_change_source(struct ast_rtp_instance *instance);
445 static int ast_rtp_write(struct ast_rtp_instance *instance, struct ast_frame *frame);
446 static struct ast_frame *ast_rtp_read(struct ast_rtp_instance *instance, int rtcp);
447 static void ast_rtp_prop_set(struct ast_rtp_instance *instance, enum ast_rtp_property property, int value);
448 static int ast_rtp_fd(struct ast_rtp_instance *instance, int rtcp);
449 static void ast_rtp_remote_address_set(struct ast_rtp_instance *instance, struct ast_sockaddr *addr);
450 static int rtp_red_init(struct ast_rtp_instance *instance, int buffer_time, int *payloads, int generations);
451 static int rtp_red_buffer(struct ast_rtp_instance *instance, struct ast_frame *frame);
452 static int ast_rtp_local_bridge(struct ast_rtp_instance *instance0, struct ast_rtp_instance *instance1);
453 static int ast_rtp_get_stat(struct ast_rtp_instance *instance, struct ast_rtp_instance_stats *stats, enum ast_rtp_instance_stat stat);
454 static int ast_rtp_dtmf_compatible(struct ast_channel *chan0, struct ast_rtp_instance *instance0, struct ast_channel *chan1, struct ast_rtp_instance *instance1);
455 static void ast_rtp_stun_request(struct ast_rtp_instance *instance, struct ast_sockaddr *suggestion, const char *username);
456 static void ast_rtp_stop(struct ast_rtp_instance *instance);
457 static int ast_rtp_qos_set(struct ast_rtp_instance *instance, int tos, int cos, const char* desc);
458 static int ast_rtp_sendcng(struct ast_rtp_instance *instance, int level);
459
460 #ifdef HAVE_OPENSSL_SRTP
461 static int ast_rtp_activate(struct ast_rtp_instance *instance);
462 static void dtls_srtp_check_pending(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp);
463 static void dtls_srtp_start_timeout_timer(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp);
464 static void dtls_srtp_stop_timeout_timer(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp);
465 #endif
466
467 static int __rtp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int rtcp, int *ice, int use_srtp);
468
469 #ifdef HAVE_PJPROJECT
470 /*! \brief Helper function which clears the ICE host candidate mapping */
471 static void host_candidate_overrides_clear(void)
472 {
473         struct ast_ice_host_candidate *candidate;
474
475         AST_RWLIST_WRLOCK(&host_candidates);
476         AST_RWLIST_TRAVERSE_SAFE_BEGIN(&host_candidates, candidate, next) {
477                 AST_RWLIST_REMOVE_CURRENT(next);
478                 ast_free(candidate);
479         }
480         AST_RWLIST_TRAVERSE_SAFE_END;
481         AST_RWLIST_UNLOCK(&host_candidates);
482 }
483
484 /*! \brief Applies the ICE host candidate mapping */
485 static void host_candidate_overrides_apply(unsigned int count, pj_sockaddr addrs[])
486 {
487         int pos;
488         struct ast_ice_host_candidate *candidate;
489
490         AST_RWLIST_RDLOCK(&host_candidates);
491         for (pos = 0; pos < count; pos++) {
492                 AST_LIST_TRAVERSE(&host_candidates, candidate, next) {
493                         if (!pj_sockaddr_cmp(&candidate->local, &addrs[pos])) {
494                                 pj_sockaddr_copy_addr(&addrs[pos], &candidate->advertised);
495                                 break;
496                         }
497                 }
498         }
499         AST_RWLIST_UNLOCK(&host_candidates);
500 }
501
502 /*! \brief Helper function which updates an ast_sockaddr with the candidate used for the component */
503 static void update_address_with_ice_candidate(struct ast_rtp *rtp, enum ast_rtp_ice_component_type component,
504         struct ast_sockaddr *cand_address)
505 {
506         char address[PJ_INET6_ADDRSTRLEN];
507
508         if (!rtp->ice || (component < 1) || !rtp->ice->comp[component - 1].valid_check) {
509                 return;
510         }
511
512         ast_sockaddr_parse(cand_address, pj_sockaddr_print(&rtp->ice->comp[component - 1].valid_check->rcand->addr, address, sizeof(address), 0), 0);
513         ast_sockaddr_set_port(cand_address, pj_sockaddr_get_port(&rtp->ice->comp[component - 1].valid_check->rcand->addr));
514 }
515
516 /*! \brief Destructor for locally created ICE candidates */
517 static void ast_rtp_ice_candidate_destroy(void *obj)
518 {
519         struct ast_rtp_engine_ice_candidate *candidate = obj;
520
521         if (candidate->foundation) {
522                 ast_free(candidate->foundation);
523         }
524
525         if (candidate->transport) {
526                 ast_free(candidate->transport);
527         }
528 }
529
530 static void ast_rtp_ice_set_authentication(struct ast_rtp_instance *instance, const char *ufrag, const char *password)
531 {
532         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
533
534         if (!ast_strlen_zero(ufrag)) {
535                 ast_copy_string(rtp->remote_ufrag, ufrag, sizeof(rtp->remote_ufrag));
536         }
537
538         if (!ast_strlen_zero(password)) {
539                 ast_copy_string(rtp->remote_passwd, password, sizeof(rtp->remote_passwd));
540         }
541 }
542
543 static int ice_candidate_cmp(void *obj, void *arg, int flags)
544 {
545         struct ast_rtp_engine_ice_candidate *candidate1 = obj, *candidate2 = arg;
546
547         if (strcmp(candidate1->foundation, candidate2->foundation) ||
548                         candidate1->id != candidate2->id ||
549                         candidate1->type != candidate2->type ||
550                         ast_sockaddr_cmp(&candidate1->address, &candidate2->address)) {
551                 return 0;
552         }
553
554         return CMP_MATCH | CMP_STOP;
555 }
556
557 static void ast_rtp_ice_add_remote_candidate(struct ast_rtp_instance *instance, const struct ast_rtp_engine_ice_candidate *candidate)
558 {
559         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
560         struct ast_rtp_engine_ice_candidate *remote_candidate;
561
562         /* ICE sessions only support UDP candidates */
563         if (strcasecmp(candidate->transport, "udp")) {
564                 return;
565         }
566
567         if (!rtp->ice_proposed_remote_candidates &&
568                         !(rtp->ice_proposed_remote_candidates = ao2_container_alloc(1, NULL, ice_candidate_cmp))) {
569                 return;
570         }
571
572         /* If this is going to exceed the maximum number of ICE candidates don't even add it */
573         if (ao2_container_count(rtp->ice_proposed_remote_candidates) == PJ_ICE_MAX_CAND) {
574                 return;
575         }
576
577         if (!(remote_candidate = ao2_alloc(sizeof(*remote_candidate), ast_rtp_ice_candidate_destroy))) {
578                 return;
579         }
580
581         remote_candidate->foundation = ast_strdup(candidate->foundation);
582         remote_candidate->id = candidate->id;
583         remote_candidate->transport = ast_strdup(candidate->transport);
584         remote_candidate->priority = candidate->priority;
585         ast_sockaddr_copy(&remote_candidate->address, &candidate->address);
586         ast_sockaddr_copy(&remote_candidate->relay_address, &candidate->relay_address);
587         remote_candidate->type = candidate->type;
588
589         ao2_link(rtp->ice_proposed_remote_candidates, remote_candidate);
590         ao2_ref(remote_candidate, -1);
591 }
592
593 AST_THREADSTORAGE(pj_thread_storage);
594
595 /*! \brief Function used to check if the calling thread is registered with pjlib. If it is not it will be registered. */
596 static void pj_thread_register_check(void)
597 {
598         pj_thread_desc *desc;
599         pj_thread_t *thread;
600
601         if (pj_thread_is_registered() == PJ_TRUE) {
602                 return;
603         }
604
605         desc = ast_threadstorage_get(&pj_thread_storage, sizeof(pj_thread_desc));
606         if (!desc) {
607                 ast_log(LOG_ERROR, "Could not get thread desc from thread-local storage. Expect awful things to occur\n");
608                 return;
609         }
610         pj_bzero(*desc, sizeof(*desc));
611
612         if (pj_thread_register("Asterisk Thread", *desc, &thread) != PJ_SUCCESS) {
613                 ast_log(LOG_ERROR, "Coudln't register thread with PJLIB.\n");
614         }
615         return;
616 }
617
618 static int ice_create(struct ast_rtp_instance *instance, struct ast_sockaddr *addr,
619         int port, int replace);
620
621 static void ast_rtp_ice_stop(struct ast_rtp_instance *instance)
622 {
623         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
624
625         if (!rtp->ice) {
626                 return;
627         }
628
629         pj_thread_register_check();
630
631         pj_ice_sess_destroy(rtp->ice);
632         rtp->ice = NULL;
633 }
634
635 static int ice_reset_session(struct ast_rtp_instance *instance)
636 {
637         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
638         pj_ice_sess_role role = rtp->ice->role;
639         int res;
640
641         ast_debug(3, "Resetting ICE for RTP instance '%p'\n", instance);
642         if (!rtp->ice->is_nominating && !rtp->ice->is_complete) {
643                 ast_debug(3, "Nevermind. ICE isn't ready for a reset\n");
644                 return 0;
645         }
646
647         ast_debug(3, "Stopping ICE for RTP instance '%p'\n", instance);
648         ast_rtp_ice_stop(instance);
649
650         ast_debug(3, "Recreating ICE session %s (%d) for RTP instance '%p'\n", ast_sockaddr_stringify(&rtp->ice_original_rtp_addr), rtp->ice_port, instance);
651         res = ice_create(instance, &rtp->ice_original_rtp_addr, rtp->ice_port, 1);
652         if (!res) {
653                 /* Preserve the role that the old ICE session used */
654                 pj_ice_sess_change_role(rtp->ice, role);
655         }
656
657         return res;
658 }
659
660 static int ice_candidates_compare(struct ao2_container *left, struct ao2_container *right)
661 {
662         struct ao2_iterator i;
663         struct ast_rtp_engine_ice_candidate *right_candidate;
664
665         if (ao2_container_count(left) != ao2_container_count(right)) {
666                 return -1;
667         }
668
669         i = ao2_iterator_init(right, 0);
670         while ((right_candidate = ao2_iterator_next(&i))) {
671                 struct ast_rtp_engine_ice_candidate *left_candidate = ao2_find(left, right_candidate, OBJ_POINTER);
672
673                 if (!left_candidate) {
674                         ao2_ref(right_candidate, -1);
675                         ao2_iterator_destroy(&i);
676                         return -1;
677                 }
678
679                 ao2_ref(left_candidate, -1);
680                 ao2_ref(right_candidate, -1);
681         }
682         ao2_iterator_destroy(&i);
683
684         return 0;
685 }
686
687 static void ast_rtp_ice_start(struct ast_rtp_instance *instance)
688 {
689         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
690         pj_str_t ufrag = pj_str(rtp->remote_ufrag), passwd = pj_str(rtp->remote_passwd);
691         pj_ice_sess_cand candidates[PJ_ICE_MAX_CAND];
692         struct ao2_iterator i;
693         struct ast_rtp_engine_ice_candidate *candidate;
694         int cand_cnt = 0, has_rtp = 0, has_rtcp = 0;
695
696         if (!rtp->ice || !rtp->ice_proposed_remote_candidates) {
697                 return;
698         }
699
700         /* Check for equivalence in the lists */
701         if (rtp->ice_active_remote_candidates &&
702                         !ice_candidates_compare(rtp->ice_proposed_remote_candidates, rtp->ice_active_remote_candidates)) {
703                 ast_debug(3, "Proposed == active candidates for RTP instance '%p'\n", instance);
704                 ao2_cleanup(rtp->ice_proposed_remote_candidates);
705                 rtp->ice_proposed_remote_candidates = NULL;
706                 return;
707         }
708
709         /* Out with the old, in with the new */
710         ao2_cleanup(rtp->ice_active_remote_candidates);
711         rtp->ice_active_remote_candidates = rtp->ice_proposed_remote_candidates;
712         rtp->ice_proposed_remote_candidates = NULL;
713
714         /* Reset the ICE session. Is this going to work? */
715         if (ice_reset_session(instance)) {
716                 ast_log(LOG_NOTICE, "Failed to create replacement ICE session\n");
717                 return;
718         }
719
720         pj_thread_register_check();
721
722         i = ao2_iterator_init(rtp->ice_active_remote_candidates, 0);
723
724         while ((candidate = ao2_iterator_next(&i)) && (cand_cnt < PJ_ICE_MAX_CAND)) {
725                 pj_str_t address;
726
727                 /* there needs to be at least one rtp and rtcp candidate in the list */
728                 has_rtp |= candidate->id == AST_RTP_ICE_COMPONENT_RTP;
729                 has_rtcp |= candidate->id == AST_RTP_ICE_COMPONENT_RTCP;
730
731                 pj_strdup2(rtp->ice->pool, &candidates[cand_cnt].foundation, candidate->foundation);
732                 candidates[cand_cnt].comp_id = candidate->id;
733                 candidates[cand_cnt].prio = candidate->priority;
734
735                 pj_sockaddr_parse(pj_AF_UNSPEC(), 0, pj_cstr(&address, ast_sockaddr_stringify(&candidate->address)), &candidates[cand_cnt].addr);
736
737                 if (!ast_sockaddr_isnull(&candidate->relay_address)) {
738                         pj_sockaddr_parse(pj_AF_UNSPEC(), 0, pj_cstr(&address, ast_sockaddr_stringify(&candidate->relay_address)), &candidates[cand_cnt].rel_addr);
739                 }
740
741                 if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_HOST) {
742                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_HOST;
743                 } else if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_SRFLX) {
744                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_SRFLX;
745                 } else if (candidate->type == AST_RTP_ICE_CANDIDATE_TYPE_RELAYED) {
746                         candidates[cand_cnt].type = PJ_ICE_CAND_TYPE_RELAYED;
747                 }
748
749                 if (candidate->id == AST_RTP_ICE_COMPONENT_RTP && rtp->turn_rtp) {
750                         ast_debug(3, "RTP candidate %s (%p)\n", ast_sockaddr_stringify(&candidate->address), instance);
751                         pj_turn_sock_set_perm(rtp->turn_rtp, 1, &candidates[cand_cnt].addr, 1);
752                 } else if (candidate->id == AST_RTP_ICE_COMPONENT_RTCP && rtp->turn_rtcp) {
753                         ast_debug(3, "RTCP candidate %s (%p)\n", ast_sockaddr_stringify(&candidate->address), instance);
754                         pj_turn_sock_set_perm(rtp->turn_rtcp, 1, &candidates[cand_cnt].addr, 1);
755                 }
756
757                 cand_cnt++;
758                 ao2_ref(candidate, -1);
759         }
760
761         ao2_iterator_destroy(&i);
762
763         if (cand_cnt < ao2_container_count(rtp->ice_active_remote_candidates)) {
764                 ast_log(LOG_WARNING, "Lost %d ICE candidates. Consider increasing PJ_ICE_MAX_CAND in PJSIP (%p)\n",
765                         ao2_container_count(rtp->ice_active_remote_candidates) - cand_cnt, instance);
766         }
767
768         if (!has_rtp) {
769                 ast_log(LOG_WARNING, "No RTP candidates; skipping ICE checklist (%p)\n", instance);
770         }
771
772         if (!has_rtcp) {
773                 ast_log(LOG_WARNING, "No RTCP candidates; skipping ICE checklist (%p)\n", instance);
774         }
775
776         if (has_rtp && has_rtcp) {
777                 pj_status_t res = pj_ice_sess_create_check_list(rtp->ice, &ufrag, &passwd, cand_cnt, &candidates[0]);
778                 char reason[80];
779
780                 if (res == PJ_SUCCESS) {
781                         ast_debug(3, "Successfully created ICE checklist (%p)\n", instance);
782                         ast_test_suite_event_notify("ICECHECKLISTCREATE", "Result: SUCCESS");
783                         pj_ice_sess_start_check(rtp->ice);
784                         pj_timer_heap_poll(timer_heap, NULL);
785                         rtp->strict_rtp_state = STRICT_RTP_OPEN;
786                         return;
787                 }
788
789                 pj_strerror(res, reason, sizeof(reason));
790                 ast_log(LOG_WARNING, "Failed to create ICE session check list: %s (%p)\n", reason, instance);
791         }
792
793         ast_test_suite_event_notify("ICECHECKLISTCREATE", "Result: FAILURE");
794
795         /* even though create check list failed don't stop ice as
796            it might still work */
797         /* however we do need to reset remote candidates since
798            this function may be re-entered */
799         ao2_ref(rtp->ice_active_remote_candidates, -1);
800         rtp->ice_active_remote_candidates = NULL;
801         rtp->ice->rcand_cnt = rtp->ice->clist.count = 0;
802 }
803
804 static const char *ast_rtp_ice_get_ufrag(struct ast_rtp_instance *instance)
805 {
806         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
807
808         return rtp->local_ufrag;
809 }
810
811 static const char *ast_rtp_ice_get_password(struct ast_rtp_instance *instance)
812 {
813         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
814
815         return rtp->local_passwd;
816 }
817
818 static struct ao2_container *ast_rtp_ice_get_local_candidates(struct ast_rtp_instance *instance)
819 {
820         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
821
822         if (rtp->ice_local_candidates) {
823                 ao2_ref(rtp->ice_local_candidates, +1);
824         }
825
826         return rtp->ice_local_candidates;
827 }
828
829 static void ast_rtp_ice_lite(struct ast_rtp_instance *instance)
830 {
831         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
832
833         if (!rtp->ice) {
834                 return;
835         }
836
837         pj_thread_register_check();
838
839         pj_ice_sess_change_role(rtp->ice, PJ_ICE_SESS_ROLE_CONTROLLING);
840 }
841
842 static void ast_rtp_ice_set_role(struct ast_rtp_instance *instance, enum ast_rtp_ice_role role)
843 {
844         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
845
846         ast_debug(3, "Set role to %s (%p)\n",
847                 role == AST_RTP_ICE_ROLE_CONTROLLED ? "CONTROLLED" : "CONTROLLING", instance);
848
849         if (!rtp->ice) {
850                 ast_debug(3, "Set role failed; no ice instance (%p)\n", instance);
851                 return;
852         }
853
854         pj_thread_register_check();
855
856         pj_ice_sess_change_role(rtp->ice, role == AST_RTP_ICE_ROLE_CONTROLLED ?
857                 PJ_ICE_SESS_ROLE_CONTROLLED : PJ_ICE_SESS_ROLE_CONTROLLING);
858 }
859
860 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,
861                                         const pj_sockaddr_t *addr, const pj_sockaddr_t *base_addr, const pj_sockaddr_t *rel_addr, int addr_len)
862 {
863         pj_str_t foundation;
864         struct ast_rtp_engine_ice_candidate *candidate, *existing;
865         char address[PJ_INET6_ADDRSTRLEN];
866
867         pj_thread_register_check();
868
869         pj_ice_calc_foundation(rtp->ice->pool, &foundation, type, addr);
870
871         if (!rtp->ice_local_candidates && !(rtp->ice_local_candidates = ao2_container_alloc(1, NULL, ice_candidate_cmp))) {
872                 return;
873         }
874
875         if (!(candidate = ao2_alloc(sizeof(*candidate), ast_rtp_ice_candidate_destroy))) {
876                 return;
877         }
878
879         candidate->foundation = ast_strndup(pj_strbuf(&foundation), pj_strlen(&foundation));
880         candidate->id = comp_id;
881         candidate->transport = ast_strdup("UDP");
882
883         ast_sockaddr_parse(&candidate->address, pj_sockaddr_print(addr, address, sizeof(address), 0), 0);
884         ast_sockaddr_set_port(&candidate->address, pj_sockaddr_get_port(addr));
885
886         if (rel_addr) {
887                 ast_sockaddr_parse(&candidate->relay_address, pj_sockaddr_print(rel_addr, address, sizeof(address), 0), 0);
888                 ast_sockaddr_set_port(&candidate->relay_address, pj_sockaddr_get_port(rel_addr));
889         }
890
891         if (type == PJ_ICE_CAND_TYPE_HOST) {
892                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_HOST;
893         } else if (type == PJ_ICE_CAND_TYPE_SRFLX) {
894                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_SRFLX;
895         } else if (type == PJ_ICE_CAND_TYPE_RELAYED) {
896                 candidate->type = AST_RTP_ICE_CANDIDATE_TYPE_RELAYED;
897         }
898
899         if ((existing = ao2_find(rtp->ice_local_candidates, candidate, OBJ_POINTER))) {
900                 ao2_ref(existing, -1);
901                 ao2_ref(candidate, -1);
902                 return;
903         }
904
905         if (pj_ice_sess_add_cand(rtp->ice, comp_id, transport_id, type, local_pref, &foundation, addr, base_addr, rel_addr, addr_len, NULL) != PJ_SUCCESS) {
906                 ao2_ref(candidate, -1);
907                 return;
908         }
909
910         /* By placing the candidate into the ICE session it will have produced the priority, so update the local candidate with it */
911         candidate->priority = rtp->ice->lcand[rtp->ice->lcand_cnt - 1].prio;
912
913         ao2_link(rtp->ice_local_candidates, candidate);
914         ao2_ref(candidate, -1);
915 }
916
917 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)
918 {
919         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
920         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
921         pj_status_t status;
922
923         status = pj_ice_sess_on_rx_pkt(rtp->ice, AST_RTP_ICE_COMPONENT_RTP, TRANSPORT_TURN_RTP, pkt, pkt_len, peer_addr,
924                 addr_len);
925         if (status != PJ_SUCCESS) {
926                 char buf[100];
927
928                 pj_strerror(status, buf, sizeof(buf));
929                 ast_log(LOG_WARNING, "PJ ICE Rx error status code: %d '%s'.\n",
930                         (int)status, buf);
931                 return;
932         }
933         if (!rtp->rtp_passthrough) {
934                 return;
935         }
936         rtp->rtp_passthrough = 0;
937
938         ast_sendto(rtp->s, pkt, pkt_len, 0, &rtp->rtp_loop);
939 }
940
941 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)
942 {
943         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
944         struct ast_rtp *rtp;
945
946         /* If this is a leftover from an already notified RTP instance just ignore the state change */
947         if (!instance) {
948                 return;
949         }
950
951         rtp = ast_rtp_instance_get_data(instance);
952
953         /* We store the new state so the other thread can actually handle it */
954         ast_mutex_lock(&rtp->lock);
955         rtp->turn_state = new_state;
956         ast_cond_signal(&rtp->cond);
957
958         if (new_state == PJ_TURN_STATE_DESTROYING) {
959                 pj_turn_sock_set_user_data(rtp->turn_rtp, NULL);
960                 rtp->turn_rtp = NULL;
961         }
962
963         ast_mutex_unlock(&rtp->lock);
964 }
965
966 /* RTP TURN Socket interface declaration */
967 static pj_turn_sock_cb ast_rtp_turn_rtp_sock_cb = {
968         .on_rx_data = ast_rtp_on_turn_rx_rtp_data,
969         .on_state = ast_rtp_on_turn_rtp_state,
970 };
971
972 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)
973 {
974         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
975         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
976         pj_status_t status;
977
978         status = pj_ice_sess_on_rx_pkt(rtp->ice, AST_RTP_ICE_COMPONENT_RTCP, TRANSPORT_TURN_RTCP, pkt, pkt_len, peer_addr,
979                 addr_len);
980         if (status != PJ_SUCCESS) {
981                 char buf[100];
982
983                 pj_strerror(status, buf, sizeof(buf));
984                 ast_log(LOG_WARNING, "PJ ICE Rx error status code: %d '%s'.\n",
985                         (int)status, buf);
986                 return;
987         }
988         if (!rtp->rtcp_passthrough) {
989                 return;
990         }
991         rtp->rtcp_passthrough = 0;
992
993         ast_sendto(rtp->rtcp->s, pkt, pkt_len, 0, &rtp->rtcp_loop);
994 }
995
996 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)
997 {
998         struct ast_rtp_instance *instance = pj_turn_sock_get_user_data(turn_sock);
999         struct ast_rtp *rtp = NULL;
1000
1001         /* If this is a leftover from an already destroyed RTP instance just ignore the state change */
1002         if (!instance) {
1003                 return;
1004         }
1005
1006         rtp = ast_rtp_instance_get_data(instance);
1007
1008         /* We store the new state so the other thread can actually handle it */
1009         ast_mutex_lock(&rtp->lock);
1010         rtp->turn_state = new_state;
1011         ast_cond_signal(&rtp->cond);
1012
1013         if (new_state == PJ_TURN_STATE_DESTROYING) {
1014                 pj_turn_sock_set_user_data(rtp->turn_rtcp, NULL);
1015                 rtp->turn_rtcp = NULL;
1016         }
1017
1018         ast_mutex_unlock(&rtp->lock);
1019 }
1020
1021 /* RTCP TURN Socket interface declaration */
1022 static pj_turn_sock_cb ast_rtp_turn_rtcp_sock_cb = {
1023         .on_rx_data = ast_rtp_on_turn_rx_rtcp_data,
1024         .on_state = ast_rtp_on_turn_rtcp_state,
1025 };
1026
1027 /*! \brief Worker thread for ioqueue and timerheap */
1028 static int ioqueue_worker_thread(void *data)
1029 {
1030         struct ast_rtp_ioqueue_thread *ioqueue = data;
1031
1032         while (!ioqueue->terminate) {
1033                 const pj_time_val delay = {0, 10};
1034
1035                 pj_ioqueue_poll(ioqueue->ioqueue, &delay);
1036
1037                 pj_timer_heap_poll(ioqueue->timerheap, NULL);
1038         }
1039
1040         return 0;
1041 }
1042
1043 /*! \brief Destroyer for ioqueue thread */
1044 static void rtp_ioqueue_thread_destroy(struct ast_rtp_ioqueue_thread *ioqueue)
1045 {
1046         if (ioqueue->thread) {
1047                 ioqueue->terminate = 1;
1048                 pj_thread_join(ioqueue->thread);
1049                 pj_thread_destroy(ioqueue->thread);
1050         }
1051
1052         pj_pool_release(ioqueue->pool);
1053         ast_free(ioqueue);
1054 }
1055
1056 /*! \brief Removal function for ioqueue thread, determines if it should be terminated and destroyed */
1057 static void rtp_ioqueue_thread_remove(struct ast_rtp_ioqueue_thread *ioqueue)
1058 {
1059         int destroy = 0;
1060
1061         /* If nothing is using this ioqueue thread destroy it */
1062         AST_LIST_LOCK(&ioqueues);
1063         if ((ioqueue->count - 2) == 0) {
1064                 destroy = 1;
1065                 AST_LIST_REMOVE(&ioqueues, ioqueue, next);
1066         }
1067         AST_LIST_UNLOCK(&ioqueues);
1068
1069         if (!destroy) {
1070                 return;
1071         }
1072
1073         rtp_ioqueue_thread_destroy(ioqueue);
1074 }
1075
1076 /*! \brief Finder and allocator for an ioqueue thread */
1077 static struct ast_rtp_ioqueue_thread *rtp_ioqueue_thread_get_or_create(void)
1078 {
1079         struct ast_rtp_ioqueue_thread *ioqueue;
1080         pj_lock_t *lock;
1081
1082         AST_LIST_LOCK(&ioqueues);
1083
1084         /* See if an ioqueue thread exists that can handle more */
1085         AST_LIST_TRAVERSE(&ioqueues, ioqueue, next) {
1086                 if ((ioqueue->count + 2) < PJ_IOQUEUE_MAX_HANDLES) {
1087                         break;
1088                 }
1089         }
1090
1091         /* If we found one bump it up and return it */
1092         if (ioqueue) {
1093                 ioqueue->count += 2;
1094                 goto end;
1095         }
1096
1097         ioqueue = ast_calloc(1, sizeof(*ioqueue));
1098         if (!ioqueue) {
1099                 goto end;
1100         }
1101
1102         ioqueue->pool = pj_pool_create(&cachingpool.factory, "rtp", 512, 512, NULL);
1103
1104         /* We use a timer on the ioqueue thread for TURN so that two threads aren't operating
1105          * on a session at the same time
1106          */
1107         if (pj_timer_heap_create(ioqueue->pool, 4, &ioqueue->timerheap) != PJ_SUCCESS) {
1108                 goto fatal;
1109         }
1110
1111         if (pj_lock_create_recursive_mutex(ioqueue->pool, "rtp%p", &lock) != PJ_SUCCESS) {
1112                 goto fatal;
1113         }
1114
1115         pj_timer_heap_set_lock(ioqueue->timerheap, lock, PJ_TRUE);
1116
1117         if (pj_ioqueue_create(ioqueue->pool, PJ_IOQUEUE_MAX_HANDLES, &ioqueue->ioqueue) != PJ_SUCCESS) {
1118                 goto fatal;
1119         }
1120
1121         if (pj_thread_create(ioqueue->pool, "ice", &ioqueue_worker_thread, ioqueue, 0, 0, &ioqueue->thread) != PJ_SUCCESS) {
1122                 goto fatal;
1123         }
1124
1125         AST_LIST_INSERT_HEAD(&ioqueues, ioqueue, next);
1126
1127         /* Since this is being returned to an active session the count always starts at 2 */
1128         ioqueue->count = 2;
1129
1130         goto end;
1131
1132 fatal:
1133         rtp_ioqueue_thread_destroy(ioqueue);
1134         ioqueue = NULL;
1135
1136 end:
1137         AST_LIST_UNLOCK(&ioqueues);
1138         return ioqueue;
1139 }
1140
1141 static void ast_rtp_ice_turn_request(struct ast_rtp_instance *instance, enum ast_rtp_ice_component_type component,
1142                 enum ast_transport transport, const char *server, unsigned int port, const char *username, const char *password)
1143 {
1144         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1145         pj_turn_sock **turn_sock;
1146         const pj_turn_sock_cb *turn_cb;
1147         pj_turn_tp_type conn_type;
1148         int conn_transport;
1149         pj_stun_auth_cred cred = { 0, };
1150         pj_str_t turn_addr;
1151         struct ast_sockaddr addr = { { 0, } };
1152         pj_stun_config stun_config;
1153         struct timeval wait = ast_tvadd(ast_tvnow(), ast_samp2tv(TURN_STATE_WAIT_TIME, 1000));
1154         struct timespec ts = { .tv_sec = wait.tv_sec, .tv_nsec = wait.tv_usec * 1000, };
1155         pj_turn_session_info info;
1156         struct ast_sockaddr local, loop;
1157
1158         ast_rtp_instance_get_local_address(instance, &local);
1159         if (ast_sockaddr_is_ipv4(&local)) {
1160                 ast_sockaddr_parse(&loop, "127.0.0.1", PARSE_PORT_FORBID);
1161         } else {
1162                 ast_sockaddr_parse(&loop, "::1", PARSE_PORT_FORBID);
1163         }
1164
1165         /* Determine what component we are requesting a TURN session for */
1166         if (component == AST_RTP_ICE_COMPONENT_RTP) {
1167                 turn_sock = &rtp->turn_rtp;
1168                 turn_cb = &ast_rtp_turn_rtp_sock_cb;
1169                 conn_transport = TRANSPORT_TURN_RTP;
1170                 ast_sockaddr_set_port(&loop, ast_sockaddr_port(&local));
1171         } else if (component == AST_RTP_ICE_COMPONENT_RTCP) {
1172                 turn_sock = &rtp->turn_rtcp;
1173                 turn_cb = &ast_rtp_turn_rtcp_sock_cb;
1174                 conn_transport = TRANSPORT_TURN_RTCP;
1175                 ast_sockaddr_set_port(&loop, ast_sockaddr_port(&rtp->rtcp->us));
1176         } else {
1177                 return;
1178         }
1179
1180         if (transport == AST_TRANSPORT_UDP) {
1181                 conn_type = PJ_TURN_TP_UDP;
1182         } else if (transport == AST_TRANSPORT_TCP) {
1183                 conn_type = PJ_TURN_TP_TCP;
1184         } else {
1185                 ast_assert(0);
1186                 return;
1187         }
1188
1189         ast_sockaddr_parse(&addr, server, PARSE_PORT_FORBID);
1190
1191         ast_mutex_lock(&rtp->lock);
1192         if (*turn_sock) {
1193                 pj_turn_sock_destroy(*turn_sock);
1194                 rtp->turn_state = PJ_TURN_STATE_NULL;
1195                 while (rtp->turn_state != PJ_TURN_STATE_DESTROYING) {
1196                         ast_cond_timedwait(&rtp->cond, &rtp->lock, &ts);
1197                 }
1198         }
1199         ast_mutex_unlock(&rtp->lock);
1200
1201         if (component == AST_RTP_ICE_COMPONENT_RTP && !rtp->ioqueue) {
1202                 rtp->ioqueue = rtp_ioqueue_thread_get_or_create();
1203                 if (!rtp->ioqueue) {
1204                         return;
1205                 }
1206         }
1207
1208         pj_stun_config_init(&stun_config, &cachingpool.factory, 0, rtp->ioqueue->ioqueue, rtp->ioqueue->timerheap);
1209
1210         if (pj_turn_sock_create(&stun_config, ast_sockaddr_is_ipv4(&addr) ? pj_AF_INET() : pj_AF_INET6(), conn_type,
1211                 turn_cb, NULL, instance, turn_sock) != PJ_SUCCESS) {
1212                 ast_log(LOG_WARNING, "Could not create a TURN client socket\n");
1213                 return;
1214         }
1215
1216         cred.type = PJ_STUN_AUTH_CRED_STATIC;
1217         pj_strset2(&cred.data.static_cred.username, (char*)username);
1218         cred.data.static_cred.data_type = PJ_STUN_PASSWD_PLAIN;
1219         pj_strset2(&cred.data.static_cred.data, (char*)password);
1220
1221         /* Because the TURN socket is asynchronous but we are synchronous we need to wait until it is done */
1222         ast_mutex_lock(&rtp->lock);
1223         pj_turn_sock_alloc(*turn_sock, pj_cstr(&turn_addr, server), port, NULL, &cred, NULL);
1224         while (rtp->turn_state < PJ_TURN_STATE_READY) {
1225                 ast_cond_timedwait(&rtp->cond, &rtp->lock, &ts);
1226         }
1227         ast_mutex_unlock(&rtp->lock);
1228
1229         /* If a TURN session was allocated add it as a candidate */
1230         if (rtp->turn_state != PJ_TURN_STATE_READY) {
1231                 return;
1232         }
1233
1234         pj_turn_sock_get_info(*turn_sock, &info);
1235
1236         ast_rtp_ice_add_cand(rtp, component, conn_transport, PJ_ICE_CAND_TYPE_RELAYED, 65535, &info.relay_addr,
1237                 &info.relay_addr, &info.mapped_addr, pj_sockaddr_get_len(&info.relay_addr));
1238
1239         if (component == AST_RTP_ICE_COMPONENT_RTP) {
1240                 ast_sockaddr_copy(&rtp->rtp_loop, &loop);
1241         } else if (component == AST_RTP_ICE_COMPONENT_RTCP) {
1242                 ast_sockaddr_copy(&rtp->rtcp_loop, &loop);
1243         }
1244 }
1245
1246 static char *generate_random_string(char *buf, size_t size)
1247 {
1248         long val[4];
1249         int x;
1250
1251         for (x=0; x<4; x++) {
1252                 val[x] = ast_random();
1253         }
1254         snprintf(buf, size, "%08lx%08lx%08lx%08lx", (long unsigned)val[0], (long unsigned)val[1], (long unsigned)val[2], (long unsigned)val[3]);
1255
1256         return buf;
1257 }
1258
1259 /* ICE RTP Engine interface declaration */
1260 static struct ast_rtp_engine_ice ast_rtp_ice = {
1261         .set_authentication = ast_rtp_ice_set_authentication,
1262         .add_remote_candidate = ast_rtp_ice_add_remote_candidate,
1263         .start = ast_rtp_ice_start,
1264         .stop = ast_rtp_ice_stop,
1265         .get_ufrag = ast_rtp_ice_get_ufrag,
1266         .get_password = ast_rtp_ice_get_password,
1267         .get_local_candidates = ast_rtp_ice_get_local_candidates,
1268         .ice_lite = ast_rtp_ice_lite,
1269         .set_role = ast_rtp_ice_set_role,
1270         .turn_request = ast_rtp_ice_turn_request,
1271 };
1272 #endif
1273
1274 #ifdef HAVE_OPENSSL_SRTP
1275 static int dtls_verify_callback(int preverify_ok, X509_STORE_CTX *ctx)
1276 {
1277         /* We don't want to actually verify the certificate so just accept what they have provided */
1278         return 1;
1279 }
1280
1281 static int dtls_details_initialize(struct dtls_details *dtls, SSL_CTX *ssl_ctx,
1282         enum ast_rtp_dtls_setup setup)
1283 {
1284         dtls->dtls_setup = setup;
1285
1286         if (!(dtls->ssl = SSL_new(ssl_ctx))) {
1287                 ast_log(LOG_ERROR, "Failed to allocate memory for SSL\n");
1288                 goto error;
1289         }
1290
1291         if (!(dtls->read_bio = BIO_new(BIO_s_mem()))) {
1292                 ast_log(LOG_ERROR, "Failed to allocate memory for inbound SSL traffic\n");
1293                 goto error;
1294         }
1295         BIO_set_mem_eof_return(dtls->read_bio, -1);
1296
1297         if (!(dtls->write_bio = BIO_new(BIO_s_mem()))) {
1298                 ast_log(LOG_ERROR, "Failed to allocate memory for outbound SSL traffic\n");
1299                 goto error;
1300         }
1301         BIO_set_mem_eof_return(dtls->write_bio, -1);
1302
1303         SSL_set_bio(dtls->ssl, dtls->read_bio, dtls->write_bio);
1304
1305         if (dtls->dtls_setup == AST_RTP_DTLS_SETUP_PASSIVE) {
1306                 SSL_set_accept_state(dtls->ssl);
1307         } else {
1308                 SSL_set_connect_state(dtls->ssl);
1309         }
1310         dtls->connection = AST_RTP_DTLS_CONNECTION_NEW;
1311
1312         ast_mutex_init(&dtls->lock);
1313
1314         return 0;
1315
1316 error:
1317         if (dtls->read_bio) {
1318                 BIO_free(dtls->read_bio);
1319                 dtls->read_bio = NULL;
1320         }
1321
1322         if (dtls->write_bio) {
1323                 BIO_free(dtls->write_bio);
1324                 dtls->write_bio = NULL;
1325         }
1326
1327         if (dtls->ssl) {
1328                 SSL_free(dtls->ssl);
1329                 dtls->ssl = NULL;
1330         }
1331         return -1;
1332 }
1333
1334 static int dtls_setup_rtcp(struct ast_rtp_instance *instance)
1335 {
1336         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1337
1338         if (!rtp->ssl_ctx || !rtp->rtcp) {
1339                 return 0;
1340         }
1341
1342         return dtls_details_initialize(&rtp->rtcp->dtls, rtp->ssl_ctx, rtp->dtls.dtls_setup);
1343 }
1344
1345 static int ast_rtp_dtls_set_configuration(struct ast_rtp_instance *instance, const struct ast_rtp_dtls_cfg *dtls_cfg)
1346 {
1347         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1348         int res;
1349 #ifdef HAVE_OPENSSL_EC
1350         EC_KEY *ecdh;
1351 #endif
1352
1353         if (!dtls_cfg->enabled) {
1354                 return 0;
1355         }
1356
1357         if (!ast_rtp_engine_srtp_is_registered()) {
1358                 ast_log(LOG_ERROR, "SRTP support module is not loaded or available. Try loading res_srtp.so.\n");
1359                 return -1;
1360         }
1361
1362         if (rtp->ssl_ctx) {
1363                 return 0;
1364         }
1365
1366 #if OPENSSL_VERSION_NUMBER < 0x10002000L
1367         rtp->ssl_ctx = SSL_CTX_new(DTLSv1_method());
1368 #else
1369         rtp->ssl_ctx = SSL_CTX_new(DTLS_method());
1370 #endif
1371         if (!rtp->ssl_ctx) {
1372                 return -1;
1373         }
1374
1375         SSL_CTX_set_read_ahead(rtp->ssl_ctx, 1);
1376
1377 #ifdef HAVE_OPENSSL_EC
1378
1379         if (!ast_strlen_zero(dtls_cfg->pvtfile)) {
1380                 BIO *bio = BIO_new_file(dtls_cfg->pvtfile, "r");
1381                 if (bio != NULL) {
1382                         DH *dh = PEM_read_bio_DHparams(bio, NULL, NULL, NULL);
1383                         if (dh != NULL) {
1384                                 if (SSL_CTX_set_tmp_dh(rtp->ssl_ctx, dh)) {
1385                                         long options = SSL_OP_CIPHER_SERVER_PREFERENCE |
1386                                                 SSL_OP_SINGLE_DH_USE | SSL_OP_SINGLE_ECDH_USE;
1387                                         options = SSL_CTX_set_options(rtp->ssl_ctx, options);
1388                                         ast_verb(2, "DTLS DH initialized, PFS enabled\n");
1389                                 }
1390                                 DH_free(dh);
1391                         }
1392                         BIO_free(bio);
1393                 }
1394         }
1395         /* enables AES-128 ciphers, to get AES-256 use NID_secp384r1 */
1396         ecdh = EC_KEY_new_by_curve_name(NID_X9_62_prime256v1);
1397         if (ecdh != NULL) {
1398                 if (SSL_CTX_set_tmp_ecdh(rtp->ssl_ctx, ecdh)) {
1399                         #ifndef SSL_CTRL_SET_ECDH_AUTO
1400                                 #define SSL_CTRL_SET_ECDH_AUTO 94
1401                         #endif
1402                         /* SSL_CTX_set_ecdh_auto(rtp->ssl_ctx, on); requires OpenSSL 1.0.2 which wraps: */
1403                         if (SSL_CTX_ctrl(rtp->ssl_ctx, SSL_CTRL_SET_ECDH_AUTO, 1, NULL)) {
1404                                 ast_verb(2, "DTLS ECDH initialized (automatic), faster PFS enabled\n");
1405                         } else {
1406                                 ast_verb(2, "DTLS ECDH initialized (secp256r1), faster PFS enabled\n");
1407                         }
1408                 }
1409                 EC_KEY_free(ecdh);
1410         }
1411
1412 #endif /* #ifdef HAVE_OPENSSL_EC */
1413
1414         rtp->dtls_verify = dtls_cfg->verify;
1415
1416         SSL_CTX_set_verify(rtp->ssl_ctx, (rtp->dtls_verify & AST_RTP_DTLS_VERIFY_FINGERPRINT) || (rtp->dtls_verify & AST_RTP_DTLS_VERIFY_CERTIFICATE) ?
1417                 SSL_VERIFY_PEER | SSL_VERIFY_FAIL_IF_NO_PEER_CERT : SSL_VERIFY_NONE, !(rtp->dtls_verify & AST_RTP_DTLS_VERIFY_CERTIFICATE) ?
1418                 dtls_verify_callback : NULL);
1419
1420         if (dtls_cfg->suite == AST_AES_CM_128_HMAC_SHA1_80) {
1421                 SSL_CTX_set_tlsext_use_srtp(rtp->ssl_ctx, "SRTP_AES128_CM_SHA1_80");
1422         } else if (dtls_cfg->suite == AST_AES_CM_128_HMAC_SHA1_32) {
1423                 SSL_CTX_set_tlsext_use_srtp(rtp->ssl_ctx, "SRTP_AES128_CM_SHA1_32");
1424         } else {
1425                 ast_log(LOG_ERROR, "Unsupported suite specified for DTLS-SRTP on RTP instance '%p'\n", instance);
1426                 return -1;
1427         }
1428
1429         rtp->local_hash = dtls_cfg->hash;
1430
1431         if (!ast_strlen_zero(dtls_cfg->certfile)) {
1432                 char *private = ast_strlen_zero(dtls_cfg->pvtfile) ? dtls_cfg->certfile : dtls_cfg->pvtfile;
1433                 BIO *certbio;
1434                 X509 *cert = NULL;
1435                 const EVP_MD *type;
1436                 unsigned int size, i;
1437                 unsigned char fingerprint[EVP_MAX_MD_SIZE];
1438                 char *local_fingerprint = rtp->local_fingerprint;
1439
1440                 if (!SSL_CTX_use_certificate_file(rtp->ssl_ctx, dtls_cfg->certfile, SSL_FILETYPE_PEM)) {
1441                         ast_log(LOG_ERROR, "Specified certificate file '%s' for RTP instance '%p' could not be used\n",
1442                                 dtls_cfg->certfile, instance);
1443                         return -1;
1444                 }
1445
1446                 if (!SSL_CTX_use_PrivateKey_file(rtp->ssl_ctx, private, SSL_FILETYPE_PEM) ||
1447                     !SSL_CTX_check_private_key(rtp->ssl_ctx)) {
1448                         ast_log(LOG_ERROR, "Specified private key file '%s' for RTP instance '%p' could not be used\n",
1449                                 private, instance);
1450                         return -1;
1451                 }
1452
1453                 if (!(certbio = BIO_new(BIO_s_file()))) {
1454                         ast_log(LOG_ERROR, "Failed to allocate memory for certificate fingerprinting on RTP instance '%p'\n",
1455                                 instance);
1456                         return -1;
1457                 }
1458
1459                 if (rtp->local_hash == AST_RTP_DTLS_HASH_SHA1) {
1460                         type = EVP_sha1();
1461                 } else if (rtp->local_hash == AST_RTP_DTLS_HASH_SHA256) {
1462                         type = EVP_sha256();
1463                 } else {
1464                         ast_log(LOG_ERROR, "Unsupported fingerprint hash type on RTP instance '%p'\n",
1465                                 instance);
1466                         return -1;
1467                 }
1468
1469                 if (!BIO_read_filename(certbio, dtls_cfg->certfile) ||
1470                     !(cert = PEM_read_bio_X509(certbio, NULL, 0, NULL)) ||
1471                     !X509_digest(cert, type, fingerprint, &size) ||
1472                     !size) {
1473                         ast_log(LOG_ERROR, "Could not produce fingerprint from certificate '%s' for RTP instance '%p'\n",
1474                                 dtls_cfg->certfile, instance);
1475                         BIO_free_all(certbio);
1476                         if (cert) {
1477                                 X509_free(cert);
1478                         }
1479                         return -1;
1480                 }
1481
1482                 for (i = 0; i < size; i++) {
1483                         sprintf(local_fingerprint, "%02hhX:", fingerprint[i]);
1484                         local_fingerprint += 3;
1485                 }
1486
1487                 *(local_fingerprint-1) = 0;
1488
1489                 BIO_free_all(certbio);
1490                 X509_free(cert);
1491         }
1492
1493         if (!ast_strlen_zero(dtls_cfg->cipher)) {
1494                 if (!SSL_CTX_set_cipher_list(rtp->ssl_ctx, dtls_cfg->cipher)) {
1495                         ast_log(LOG_ERROR, "Invalid cipher specified in cipher list '%s' for RTP instance '%p'\n",
1496                                 dtls_cfg->cipher, instance);
1497                         return -1;
1498                 }
1499         }
1500
1501         if (!ast_strlen_zero(dtls_cfg->cafile) || !ast_strlen_zero(dtls_cfg->capath)) {
1502                 if (!SSL_CTX_load_verify_locations(rtp->ssl_ctx, S_OR(dtls_cfg->cafile, NULL), S_OR(dtls_cfg->capath, NULL))) {
1503                         ast_log(LOG_ERROR, "Invalid certificate authority file '%s' or path '%s' specified for RTP instance '%p'\n",
1504                                 S_OR(dtls_cfg->cafile, ""), S_OR(dtls_cfg->capath, ""), instance);
1505                         return -1;
1506                 }
1507         }
1508
1509         rtp->rekey = dtls_cfg->rekey;
1510         rtp->suite = dtls_cfg->suite;
1511
1512         res = dtls_details_initialize(&rtp->dtls, rtp->ssl_ctx, dtls_cfg->default_setup);
1513         if (!res) {
1514                 dtls_setup_rtcp(instance);
1515         }
1516
1517         return res;
1518 }
1519
1520 static int ast_rtp_dtls_active(struct ast_rtp_instance *instance)
1521 {
1522         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1523
1524         return !rtp->ssl_ctx ? 0 : 1;
1525 }
1526
1527 static void ast_rtp_dtls_stop(struct ast_rtp_instance *instance)
1528 {
1529         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1530
1531         dtls_srtp_stop_timeout_timer(instance, rtp, 0);
1532
1533         if (rtp->ssl_ctx) {
1534                 SSL_CTX_free(rtp->ssl_ctx);
1535                 rtp->ssl_ctx = NULL;
1536         }
1537
1538         if (rtp->dtls.ssl) {
1539                 SSL_free(rtp->dtls.ssl);
1540                 rtp->dtls.ssl = NULL;
1541                 ast_mutex_destroy(&rtp->dtls.lock);
1542         }
1543
1544         if (rtp->rtcp) {
1545                 dtls_srtp_stop_timeout_timer(instance, rtp, 1);
1546
1547                 if (rtp->rtcp->dtls.ssl) {
1548                         SSL_free(rtp->rtcp->dtls.ssl);
1549                         rtp->rtcp->dtls.ssl = NULL;
1550                         ast_mutex_destroy(&rtp->rtcp->dtls.lock);
1551                 }
1552         }
1553 }
1554
1555 static void ast_rtp_dtls_reset(struct ast_rtp_instance *instance)
1556 {
1557         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1558
1559         if (SSL_is_init_finished(rtp->dtls.ssl)) {
1560                 SSL_shutdown(rtp->dtls.ssl);
1561                 rtp->dtls.connection = AST_RTP_DTLS_CONNECTION_NEW;
1562         }
1563
1564         if (rtp->rtcp && SSL_is_init_finished(rtp->rtcp->dtls.ssl)) {
1565                 SSL_shutdown(rtp->rtcp->dtls.ssl);
1566                 rtp->rtcp->dtls.connection = AST_RTP_DTLS_CONNECTION_NEW;
1567         }
1568 }
1569
1570 static enum ast_rtp_dtls_connection ast_rtp_dtls_get_connection(struct ast_rtp_instance *instance)
1571 {
1572         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1573
1574         return rtp->dtls.connection;
1575 }
1576
1577 static enum ast_rtp_dtls_setup ast_rtp_dtls_get_setup(struct ast_rtp_instance *instance)
1578 {
1579         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1580
1581         return rtp->dtls.dtls_setup;
1582 }
1583
1584 static void dtls_set_setup(enum ast_rtp_dtls_setup *dtls_setup, enum ast_rtp_dtls_setup setup, SSL *ssl)
1585 {
1586         enum ast_rtp_dtls_setup old = *dtls_setup;
1587
1588         switch (setup) {
1589         case AST_RTP_DTLS_SETUP_ACTIVE:
1590                 *dtls_setup = AST_RTP_DTLS_SETUP_PASSIVE;
1591                 break;
1592         case AST_RTP_DTLS_SETUP_PASSIVE:
1593                 *dtls_setup = AST_RTP_DTLS_SETUP_ACTIVE;
1594                 break;
1595         case AST_RTP_DTLS_SETUP_ACTPASS:
1596                 /* We can't respond to an actpass setup with actpass ourselves... so respond with active, as we can initiate connections */
1597                 if (*dtls_setup == AST_RTP_DTLS_SETUP_ACTPASS) {
1598                         *dtls_setup = AST_RTP_DTLS_SETUP_ACTIVE;
1599                 }
1600                 break;
1601         case AST_RTP_DTLS_SETUP_HOLDCONN:
1602                 *dtls_setup = AST_RTP_DTLS_SETUP_HOLDCONN;
1603                 break;
1604         default:
1605                 /* This should never occur... if it does exit early as we don't know what state things are in */
1606                 return;
1607         }
1608
1609         /* If the setup state did not change we go on as if nothing happened */
1610         if (old == *dtls_setup) {
1611                 return;
1612         }
1613
1614         /* If they don't want us to establish a connection wait until later */
1615         if (*dtls_setup == AST_RTP_DTLS_SETUP_HOLDCONN) {
1616                 return;
1617         }
1618
1619         if (*dtls_setup == AST_RTP_DTLS_SETUP_ACTIVE) {
1620                 SSL_set_connect_state(ssl);
1621         } else if (*dtls_setup == AST_RTP_DTLS_SETUP_PASSIVE) {
1622                 SSL_set_accept_state(ssl);
1623         } else {
1624                 return;
1625         }
1626 }
1627
1628 static void ast_rtp_dtls_set_setup(struct ast_rtp_instance *instance, enum ast_rtp_dtls_setup setup)
1629 {
1630         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1631
1632         if (rtp->dtls.ssl) {
1633                 dtls_set_setup(&rtp->dtls.dtls_setup, setup, rtp->dtls.ssl);
1634         }
1635
1636         if (rtp->rtcp && rtp->rtcp->dtls.ssl) {
1637                 dtls_set_setup(&rtp->rtcp->dtls.dtls_setup, setup, rtp->rtcp->dtls.ssl);
1638         }
1639 }
1640
1641 static void ast_rtp_dtls_set_fingerprint(struct ast_rtp_instance *instance, enum ast_rtp_dtls_hash hash, const char *fingerprint)
1642 {
1643         char *tmp = ast_strdupa(fingerprint), *value;
1644         int pos = 0;
1645         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1646
1647         if (hash != AST_RTP_DTLS_HASH_SHA1 && hash != AST_RTP_DTLS_HASH_SHA256) {
1648                 return;
1649         }
1650
1651         rtp->remote_hash = hash;
1652
1653         while ((value = strsep(&tmp, ":")) && (pos != (EVP_MAX_MD_SIZE - 1))) {
1654                 sscanf(value, "%02hhx", &rtp->remote_fingerprint[pos++]);
1655         }
1656 }
1657
1658 static enum ast_rtp_dtls_hash ast_rtp_dtls_get_fingerprint_hash(struct ast_rtp_instance *instance)
1659 {
1660         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1661
1662         return rtp->local_hash;
1663 }
1664
1665 static const char *ast_rtp_dtls_get_fingerprint(struct ast_rtp_instance *instance)
1666 {
1667         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1668
1669         return rtp->local_fingerprint;
1670 }
1671
1672 /* DTLS RTP Engine interface declaration */
1673 static struct ast_rtp_engine_dtls ast_rtp_dtls = {
1674         .set_configuration = ast_rtp_dtls_set_configuration,
1675         .active = ast_rtp_dtls_active,
1676         .stop = ast_rtp_dtls_stop,
1677         .reset = ast_rtp_dtls_reset,
1678         .get_connection = ast_rtp_dtls_get_connection,
1679         .get_setup = ast_rtp_dtls_get_setup,
1680         .set_setup = ast_rtp_dtls_set_setup,
1681         .set_fingerprint = ast_rtp_dtls_set_fingerprint,
1682         .get_fingerprint_hash = ast_rtp_dtls_get_fingerprint_hash,
1683         .get_fingerprint = ast_rtp_dtls_get_fingerprint,
1684 };
1685
1686 #endif
1687
1688 /* RTP Engine Declaration */
1689 static struct ast_rtp_engine asterisk_rtp_engine = {
1690         .name = "asterisk",
1691         .new = ast_rtp_new,
1692         .destroy = ast_rtp_destroy,
1693         .dtmf_begin = ast_rtp_dtmf_begin,
1694         .dtmf_end = ast_rtp_dtmf_end,
1695         .dtmf_end_with_duration = ast_rtp_dtmf_end_with_duration,
1696         .dtmf_mode_set = ast_rtp_dtmf_mode_set,
1697         .dtmf_mode_get = ast_rtp_dtmf_mode_get,
1698         .update_source = ast_rtp_update_source,
1699         .change_source = ast_rtp_change_source,
1700         .write = ast_rtp_write,
1701         .read = ast_rtp_read,
1702         .prop_set = ast_rtp_prop_set,
1703         .fd = ast_rtp_fd,
1704         .remote_address_set = ast_rtp_remote_address_set,
1705         .red_init = rtp_red_init,
1706         .red_buffer = rtp_red_buffer,
1707         .local_bridge = ast_rtp_local_bridge,
1708         .get_stat = ast_rtp_get_stat,
1709         .dtmf_compatible = ast_rtp_dtmf_compatible,
1710         .stun_request = ast_rtp_stun_request,
1711         .stop = ast_rtp_stop,
1712         .qos = ast_rtp_qos_set,
1713         .sendcng = ast_rtp_sendcng,
1714 #ifdef HAVE_PJPROJECT
1715         .ice = &ast_rtp_ice,
1716 #endif
1717 #ifdef HAVE_OPENSSL_SRTP
1718         .dtls = &ast_rtp_dtls,
1719         .activate = ast_rtp_activate,
1720 #endif
1721 };
1722
1723 #ifdef HAVE_OPENSSL_SRTP
1724 static void dtls_perform_handshake(struct ast_rtp_instance *instance, struct dtls_details *dtls, int rtcp)
1725 {
1726         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1727
1728         /* If we are not acting as a client connecting to the remote side then
1729          * don't start the handshake as it will accomplish nothing and would conflict
1730          * with the handshake we receive from the remote side.
1731          */
1732         if (!dtls->ssl || (dtls->dtls_setup != AST_RTP_DTLS_SETUP_ACTIVE)) {
1733                 return;
1734         }
1735
1736         SSL_do_handshake(dtls->ssl);
1737
1738         /* Since the handshake is started in a thread outside of the channel thread it's possible
1739          * for the response to be handled in the channel thread before we start the timeout timer.
1740          * To ensure this doesn't actually happen we hold the DTLS lock. The channel thread will
1741          * block until we're done at which point the timeout timer will be immediately stopped.
1742          */
1743         ast_mutex_lock(&dtls->lock);
1744         dtls_srtp_check_pending(instance, rtp, rtcp);
1745         dtls_srtp_start_timeout_timer(instance, rtp, rtcp);
1746         ast_mutex_unlock(&dtls->lock);
1747 }
1748 #endif
1749
1750 #ifdef HAVE_PJPROJECT
1751 static void rtp_learning_seq_init(struct rtp_learning_info *info, uint16_t seq);
1752
1753 static void ast_rtp_on_ice_complete(pj_ice_sess *ice, pj_status_t status)
1754 {
1755         struct ast_rtp_instance *instance = ice->user_data;
1756         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1757
1758         if (status == PJ_SUCCESS) {
1759                 struct ast_sockaddr remote_address;
1760
1761                 /* Symmetric RTP must be disabled for the remote address to not get overwritten */
1762                 ast_rtp_instance_set_prop(instance, AST_RTP_PROPERTY_NAT, 0);
1763
1764                 update_address_with_ice_candidate(rtp, AST_RTP_ICE_COMPONENT_RTP, &remote_address);
1765                 ast_rtp_instance_set_remote_address(instance, &remote_address);
1766
1767                 if (rtp->rtcp) {
1768                         update_address_with_ice_candidate(rtp, AST_RTP_ICE_COMPONENT_RTCP, &rtp->rtcp->them);
1769                 }
1770         }
1771  
1772 #ifdef HAVE_OPENSSL_SRTP
1773         dtls_perform_handshake(instance, &rtp->dtls, 0);
1774
1775         if (rtp->rtcp) {
1776                 dtls_perform_handshake(instance, &rtp->rtcp->dtls, 1);
1777         }
1778 #endif
1779
1780         if (!strictrtp) {
1781                 return;
1782         }
1783
1784         rtp->strict_rtp_state = STRICT_RTP_LEARN;
1785         rtp_learning_seq_init(&rtp->rtp_source_learn, (uint16_t)rtp->seqno);
1786 }
1787
1788 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)
1789 {
1790         struct ast_rtp_instance *instance = ice->user_data;
1791         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1792
1793         /* 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
1794          * returns */
1795         if (transport_id == TRANSPORT_SOCKET_RTP || transport_id == TRANSPORT_SOCKET_RTCP) {
1796                 rtp->passthrough = 1;
1797         } else if (transport_id == TRANSPORT_TURN_RTP) {
1798                 rtp->rtp_passthrough = 1;
1799         } else if (transport_id == TRANSPORT_TURN_RTCP) {
1800                 rtp->rtcp_passthrough = 1;
1801         }
1802 }
1803
1804 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)
1805 {
1806         struct ast_rtp_instance *instance = ice->user_data;
1807         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1808         pj_status_t status = PJ_EINVALIDOP;
1809         pj_ssize_t _size = (pj_ssize_t)size;
1810
1811         if (transport_id == TRANSPORT_SOCKET_RTP) {
1812                 /* Traffic is destined to go right out the RTP socket we already have */
1813                 status = pj_sock_sendto(rtp->s, pkt, &_size, 0, dst_addr, dst_addr_len);
1814                 /* sendto on a connectionless socket should send all the data, or none at all */
1815                 ast_assert(_size == size || status != PJ_SUCCESS);
1816         } else if (transport_id == TRANSPORT_SOCKET_RTCP) {
1817                 /* Traffic is destined to go right out the RTCP socket we already have */
1818                 if (rtp->rtcp) {
1819                         status = pj_sock_sendto(rtp->rtcp->s, pkt, &_size, 0, dst_addr, dst_addr_len);
1820                         /* sendto on a connectionless socket should send all the data, or none at all */
1821                         ast_assert(_size == size || status != PJ_SUCCESS);
1822                 } else {
1823                         status = PJ_SUCCESS;
1824                 }
1825         } else if (transport_id == TRANSPORT_TURN_RTP) {
1826                 /* Traffic is going through the RTP TURN relay */
1827                 if (rtp->turn_rtp) {
1828                         status = pj_turn_sock_sendto(rtp->turn_rtp, pkt, size, dst_addr, dst_addr_len);
1829                 }
1830         } else if (transport_id == TRANSPORT_TURN_RTCP) {
1831                 /* Traffic is going through the RTCP TURN relay */
1832                 if (rtp->turn_rtcp) {
1833                         status = pj_turn_sock_sendto(rtp->turn_rtcp, pkt, size, dst_addr, dst_addr_len);
1834                 }
1835         }
1836
1837         return status;
1838 }
1839
1840 /* ICE Session interface declaration */
1841 static pj_ice_sess_cb ast_rtp_ice_sess_cb = {
1842         .on_ice_complete = ast_rtp_on_ice_complete,
1843         .on_rx_data = ast_rtp_on_ice_rx_data,
1844         .on_tx_pkt = ast_rtp_on_ice_tx_pkt,
1845 };
1846
1847 /*! \brief Worker thread for timerheap */
1848 static int timer_worker_thread(void *data)
1849 {
1850         pj_ioqueue_t *ioqueue;
1851
1852         if (pj_ioqueue_create(pool, 1, &ioqueue) != PJ_SUCCESS) {
1853                 return -1;
1854         }
1855
1856         while (!timer_terminate) {
1857                 const pj_time_val delay = {0, 10};
1858
1859                 pj_timer_heap_poll(timer_heap, NULL);
1860                 pj_ioqueue_poll(ioqueue, &delay);
1861         }
1862
1863         return 0;
1864 }
1865 #endif
1866
1867 static inline int rtp_debug_test_addr(struct ast_sockaddr *addr)
1868 {
1869         if (!rtpdebug) {
1870                 return 0;
1871         }
1872         if (!ast_sockaddr_isnull(&rtpdebugaddr)) {
1873                 if (rtpdebugport) {
1874                         return (ast_sockaddr_cmp(&rtpdebugaddr, addr) == 0); /* look for RTP packets from IP+Port */
1875                 } else {
1876                         return (ast_sockaddr_cmp_addr(&rtpdebugaddr, addr) == 0); /* only look for RTP packets from IP */
1877                 }
1878         }
1879
1880         return 1;
1881 }
1882
1883 static inline int rtcp_debug_test_addr(struct ast_sockaddr *addr)
1884 {
1885         if (!rtcpdebug) {
1886                 return 0;
1887         }
1888         if (!ast_sockaddr_isnull(&rtcpdebugaddr)) {
1889                 if (rtcpdebugport) {
1890                         return (ast_sockaddr_cmp(&rtcpdebugaddr, addr) == 0); /* look for RTCP packets from IP+Port */
1891                 } else {
1892                         return (ast_sockaddr_cmp_addr(&rtcpdebugaddr, addr) == 0); /* only look for RTCP packets from IP */
1893                 }
1894         }
1895
1896         return 1;
1897 }
1898
1899 #ifdef HAVE_OPENSSL_SRTP
1900 static int dtls_srtp_handle_timeout(struct ast_rtp_instance *instance, int rtcp)
1901 {
1902         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
1903         struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
1904         struct timeval dtls_timeout;
1905
1906         DTLSv1_handle_timeout(dtls->ssl);
1907         dtls_srtp_check_pending(instance, rtp, rtcp);
1908
1909         /* If a timeout can't be retrieved then this recurring scheduled item must stop */
1910         if (!DTLSv1_get_timeout(dtls->ssl, &dtls_timeout)) {
1911                 dtls->timeout_timer = -1;
1912                 return 0;
1913         }
1914
1915         return dtls_timeout.tv_sec * 1000 + dtls_timeout.tv_usec / 1000;
1916 }
1917
1918 static int dtls_srtp_handle_rtp_timeout(const void *data)
1919 {
1920         struct ast_rtp_instance *instance = (struct ast_rtp_instance *)data;
1921         int reschedule;
1922
1923         reschedule = dtls_srtp_handle_timeout(instance, 0);
1924
1925         if (!reschedule) {
1926                 ao2_ref(instance, -1);
1927         }
1928
1929         return reschedule;
1930 }
1931
1932 static int dtls_srtp_handle_rtcp_timeout(const void *data)
1933 {
1934         struct ast_rtp_instance *instance = (struct ast_rtp_instance *)data;
1935         int reschedule;
1936
1937         reschedule = dtls_srtp_handle_timeout(instance, 1);
1938
1939         if (!reschedule) {
1940                 ao2_ref(instance, -1);
1941         }
1942
1943         return reschedule;
1944 }
1945
1946 static void dtls_srtp_start_timeout_timer(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp)
1947 {
1948         struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
1949         struct timeval dtls_timeout;
1950
1951         if (DTLSv1_get_timeout(dtls->ssl, &dtls_timeout)) {
1952                 int timeout = dtls_timeout.tv_sec * 1000 + dtls_timeout.tv_usec / 1000;
1953
1954                 ast_assert(dtls->timeout_timer == -1);
1955
1956                 ao2_ref(instance, +1);
1957                 if ((dtls->timeout_timer = ast_sched_add(rtp->sched, timeout,
1958                         !rtcp ? dtls_srtp_handle_rtp_timeout : dtls_srtp_handle_rtcp_timeout, instance)) < 0) {
1959                         ao2_ref(instance, -1);
1960                         ast_log(LOG_WARNING, "Scheduling '%s' DTLS retransmission for RTP instance [%p] failed.\n",
1961                                 !rtcp ? "RTP" : "RTCP", instance);
1962                 }
1963         }
1964 }
1965
1966 static void dtls_srtp_stop_timeout_timer(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp)
1967 {
1968         struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
1969
1970         AST_SCHED_DEL_UNREF(rtp->sched, dtls->timeout_timer, ao2_ref(instance, -1));
1971 }
1972
1973 static void dtls_srtp_check_pending(struct ast_rtp_instance *instance, struct ast_rtp *rtp, int rtcp)
1974 {
1975         struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
1976         size_t pending;
1977
1978         if (!dtls->ssl || !dtls->write_bio) {
1979                 return;
1980         }
1981
1982         pending = BIO_ctrl_pending(dtls->write_bio);
1983
1984         if (pending > 0) {
1985                 char outgoing[pending];
1986                 size_t out;
1987                 struct ast_sockaddr remote_address = { {0, } };
1988                 int ice;
1989
1990                 if (!rtcp) {
1991                         ast_rtp_instance_get_remote_address(instance, &remote_address);
1992                 } else {
1993                         ast_sockaddr_copy(&remote_address, &rtp->rtcp->them);
1994                 }
1995
1996                 /* If we do not yet know an address to send this to defer it until we do */
1997                 if (ast_sockaddr_isnull(&remote_address)) {
1998                         return;
1999                 }
2000
2001                 out = BIO_read(dtls->write_bio, outgoing, sizeof(outgoing));
2002                 __rtp_sendto(instance, outgoing, out, 0, &remote_address, rtcp, &ice, 0);
2003         }
2004 }
2005
2006 static int dtls_srtp_renegotiate(const void *data)
2007 {
2008         struct ast_rtp_instance *instance = (struct ast_rtp_instance *)data;
2009         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2010
2011         SSL_renegotiate(rtp->dtls.ssl);
2012         SSL_do_handshake(rtp->dtls.ssl);
2013         dtls_srtp_check_pending(instance, rtp, 0);
2014
2015         if (rtp->rtcp && rtp->rtcp->dtls.ssl) {
2016                 SSL_renegotiate(rtp->rtcp->dtls.ssl);
2017                 SSL_do_handshake(rtp->rtcp->dtls.ssl);
2018                 dtls_srtp_check_pending(instance, rtp, 1);
2019         }
2020
2021         rtp->rekeyid = -1;
2022         ao2_ref(instance, -1);
2023
2024         return 0;
2025 }
2026
2027 static int dtls_srtp_setup(struct ast_rtp *rtp, struct ast_srtp *srtp, struct ast_rtp_instance *instance, int rtcp)
2028 {
2029         unsigned char material[SRTP_MASTER_LEN * 2];
2030         unsigned char *local_key, *local_salt, *remote_key, *remote_salt;
2031         struct ast_srtp_policy *local_policy, *remote_policy = NULL;
2032         struct ast_rtp_instance_stats stats = { 0, };
2033         int res = -1;
2034         struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
2035
2036         /* If a fingerprint is present in the SDP make sure that the peer certificate matches it */
2037         if (rtp->dtls_verify & AST_RTP_DTLS_VERIFY_FINGERPRINT) {
2038                 X509 *certificate;
2039
2040                 if (!(certificate = SSL_get_peer_certificate(dtls->ssl))) {
2041                         ast_log(LOG_WARNING, "No certificate was provided by the peer on RTP instance '%p'\n", instance);
2042                         return -1;
2043                 }
2044
2045                 /* If a fingerprint is present in the SDP make sure that the peer certificate matches it */
2046                 if (rtp->remote_fingerprint[0]) {
2047                         const EVP_MD *type;
2048                         unsigned char fingerprint[EVP_MAX_MD_SIZE];
2049                         unsigned int size;
2050
2051                         if (rtp->remote_hash == AST_RTP_DTLS_HASH_SHA1) {
2052                                 type = EVP_sha1();
2053                         } else if (rtp->remote_hash == AST_RTP_DTLS_HASH_SHA256) {
2054                                 type = EVP_sha256();
2055                         } else {
2056                                 ast_log(LOG_WARNING, "Unsupported fingerprint hash type on RTP instance '%p'\n", instance);
2057                                 return -1;
2058                         }
2059
2060                         if (!X509_digest(certificate, type, fingerprint, &size) ||
2061                             !size ||
2062                             memcmp(fingerprint, rtp->remote_fingerprint, size)) {
2063                                 X509_free(certificate);
2064                                 ast_log(LOG_WARNING, "Fingerprint provided by remote party does not match that of peer certificate on RTP instance '%p'\n",
2065                                         instance);
2066                                 return -1;
2067                         }
2068                 }
2069
2070                 X509_free(certificate);
2071         }
2072
2073         /* Ensure that certificate verification was successful */
2074         if ((rtp->dtls_verify & AST_RTP_DTLS_VERIFY_CERTIFICATE) && SSL_get_verify_result(dtls->ssl) != X509_V_OK) {
2075                 ast_log(LOG_WARNING, "Peer certificate on RTP instance '%p' failed verification test\n",
2076                         instance);
2077                 return -1;
2078         }
2079
2080         /* Produce key information and set up SRTP */
2081         if (!SSL_export_keying_material(dtls->ssl, material, SRTP_MASTER_LEN * 2, "EXTRACTOR-dtls_srtp", 19, NULL, 0, 0)) {
2082                 ast_log(LOG_WARNING, "Unable to extract SRTP keying material from DTLS-SRTP negotiation on RTP instance '%p'\n",
2083                         instance);
2084                 return -1;
2085         }
2086
2087         /* Whether we are acting as a server or client determines where the keys/salts are */
2088         if (rtp->dtls.dtls_setup == AST_RTP_DTLS_SETUP_ACTIVE) {
2089                 local_key = material;
2090                 remote_key = local_key + SRTP_MASTER_KEY_LEN;
2091                 local_salt = remote_key + SRTP_MASTER_KEY_LEN;
2092                 remote_salt = local_salt + SRTP_MASTER_SALT_LEN;
2093         } else {
2094                 remote_key = material;
2095                 local_key = remote_key + SRTP_MASTER_KEY_LEN;
2096                 remote_salt = local_key + SRTP_MASTER_KEY_LEN;
2097                 local_salt = remote_salt + SRTP_MASTER_SALT_LEN;
2098         }
2099
2100         if (!(local_policy = res_srtp_policy->alloc())) {
2101                 return -1;
2102         }
2103
2104         if (res_srtp_policy->set_master_key(local_policy, local_key, SRTP_MASTER_KEY_LEN, local_salt, SRTP_MASTER_SALT_LEN) < 0) {
2105                 ast_log(LOG_WARNING, "Could not set key/salt information on local policy of '%p' when setting up DTLS-SRTP\n", rtp);
2106                 goto error;
2107         }
2108
2109         if (res_srtp_policy->set_suite(local_policy, rtp->suite)) {
2110                 ast_log(LOG_WARNING, "Could not set suite to '%u' on local policy of '%p' when setting up DTLS-SRTP\n", rtp->suite, rtp);
2111                 goto error;
2112         }
2113
2114         if (ast_rtp_instance_get_stats(instance, &stats, AST_RTP_INSTANCE_STAT_LOCAL_SSRC)) {
2115                 goto error;
2116         }
2117
2118         res_srtp_policy->set_ssrc(local_policy, stats.local_ssrc, 0);
2119
2120         if (!(remote_policy = res_srtp_policy->alloc())) {
2121                 goto error;
2122         }
2123
2124         if (res_srtp_policy->set_master_key(remote_policy, remote_key, SRTP_MASTER_KEY_LEN, remote_salt, SRTP_MASTER_SALT_LEN) < 0) {
2125                 ast_log(LOG_WARNING, "Could not set key/salt information on remote policy of '%p' when setting up DTLS-SRTP\n", rtp);
2126                 goto error;
2127         }
2128
2129         if (res_srtp_policy->set_suite(remote_policy, rtp->suite)) {
2130                 ast_log(LOG_WARNING, "Could not set suite to '%u' on remote policy of '%p' when setting up DTLS-SRTP\n", rtp->suite, rtp);
2131                 goto error;
2132         }
2133
2134         res_srtp_policy->set_ssrc(remote_policy, 0, 1);
2135
2136         if (ast_rtp_instance_add_srtp_policy(instance, remote_policy, local_policy, rtcp)) {
2137                 ast_log(LOG_WARNING, "Could not set policies when setting up DTLS-SRTP on '%p'\n", rtp);
2138                 goto error;
2139         }
2140
2141         if (rtp->rekey) {
2142                 ao2_ref(instance, +1);
2143                 if ((rtp->rekeyid = ast_sched_add(rtp->sched, rtp->rekey * 1000, dtls_srtp_renegotiate, instance)) < 0) {
2144                         ao2_ref(instance, -1);
2145                         goto error;
2146                 }
2147         }
2148
2149         res = 0;
2150
2151 error:
2152         /* policy->destroy() called even on success to release local reference to these resources */
2153         res_srtp_policy->destroy(local_policy);
2154
2155         if (remote_policy) {
2156                 res_srtp_policy->destroy(remote_policy);
2157         }
2158
2159         return res;
2160 }
2161 #endif
2162
2163 static int __rtp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int rtcp)
2164 {
2165         int len;
2166         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2167         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance, rtcp);
2168         char *in = buf;
2169 #ifdef HAVE_PJPROJECT
2170         struct ast_sockaddr *loop = rtcp ? &rtp->rtcp_loop : &rtp->rtp_loop;
2171 #endif
2172
2173         if ((len = ast_recvfrom(rtcp ? rtp->rtcp->s : rtp->s, buf, size, flags, sa)) < 0) {
2174            return len;
2175         }
2176
2177 #ifdef HAVE_OPENSSL_SRTP
2178         /* If this is an SSL packet pass it to OpenSSL for processing. RFC section for first byte value:
2179          * https://tools.ietf.org/html/rfc5764#section-5.1.2 */
2180         if ((*in >= 20) && (*in <= 63)) {
2181                 struct dtls_details *dtls = !rtcp ? &rtp->dtls : &rtp->rtcp->dtls;
2182                 int res = 0;
2183
2184                 /* If no SSL session actually exists terminate things */
2185                 if (!dtls->ssl) {
2186                         ast_log(LOG_ERROR, "Received SSL traffic on RTP instance '%p' without an SSL session\n",
2187                                 instance);
2188                         return -1;
2189                 }
2190
2191                 /* This mutex is locked so that this thread blocks until the dtls_perform_handshake function
2192                  * completes.
2193                  */
2194                 ast_mutex_lock(&dtls->lock);
2195                 ast_mutex_unlock(&dtls->lock);
2196
2197                 /* Before we feed data into OpenSSL ensure that the timeout timer is either stopped or completed */
2198                 dtls_srtp_stop_timeout_timer(instance, rtp, rtcp);
2199
2200                 /* If we don't yet know if we are active or passive and we receive a packet... we are obviously passive */
2201                 if (dtls->dtls_setup == AST_RTP_DTLS_SETUP_ACTPASS) {
2202                         dtls->dtls_setup = AST_RTP_DTLS_SETUP_PASSIVE;
2203                         SSL_set_accept_state(dtls->ssl);
2204                 }
2205
2206                 dtls_srtp_check_pending(instance, rtp, rtcp);
2207
2208                 BIO_write(dtls->read_bio, buf, len);
2209
2210                 len = SSL_read(dtls->ssl, buf, len);
2211
2212                 if ((len < 0) && (SSL_get_error(dtls->ssl, len) == SSL_ERROR_SSL)) {
2213                         unsigned long error = ERR_get_error();
2214                         ast_log(LOG_ERROR, "DTLS failure occurred on RTP instance '%p' due to reason '%s', terminating\n",
2215                                 instance, ERR_reason_error_string(error));
2216                         return -1;
2217                 }
2218
2219                 dtls_srtp_check_pending(instance, rtp, rtcp);
2220
2221                 if (SSL_is_init_finished(dtls->ssl)) {
2222                         /* Any further connections will be existing since this is now established */
2223                         dtls->connection = AST_RTP_DTLS_CONNECTION_EXISTING;
2224                         /* Use the keying material to set up key/salt information */
2225                         res = dtls_srtp_setup(rtp, srtp, instance, rtcp);
2226                 } else {
2227                         /* Since we've sent additional traffic start the timeout timer for retransmission */
2228                         dtls_srtp_start_timeout_timer(instance, rtp, rtcp);
2229                 }
2230
2231                 return res;
2232         }
2233 #endif
2234
2235 #ifdef HAVE_PJPROJECT
2236         if (!ast_sockaddr_isnull(loop) && !ast_sockaddr_cmp(loop, sa)) {
2237                 /* ICE traffic will have been handled in the TURN callback, so skip it but update the address
2238                  * so it reflects the actual source and not the loopback
2239                  */
2240                 if (rtcp) {
2241                         ast_sockaddr_copy(sa, &rtp->rtcp->them);
2242                 } else {
2243                         ast_rtp_instance_get_remote_address(instance, sa);
2244                 }
2245         } else if (rtp->ice) {
2246                 pj_str_t combined = pj_str(ast_sockaddr_stringify(sa));
2247                 pj_sockaddr address;
2248                 pj_status_t status;
2249
2250                 pj_thread_register_check();
2251
2252                 pj_sockaddr_parse(pj_AF_UNSPEC(), 0, &combined, &address);
2253
2254                 status = pj_ice_sess_on_rx_pkt(rtp->ice, rtcp ? AST_RTP_ICE_COMPONENT_RTCP : AST_RTP_ICE_COMPONENT_RTP,
2255                         rtcp ? TRANSPORT_SOCKET_RTCP : TRANSPORT_SOCKET_RTP, buf, len, &address,
2256                         pj_sockaddr_get_len(&address));
2257                 if (status != PJ_SUCCESS) {
2258                         char buf[100];
2259
2260                         pj_strerror(status, buf, sizeof(buf));
2261                         ast_log(LOG_WARNING, "PJ ICE Rx error status code: %d '%s'.\n",
2262                                 (int)status, buf);
2263                         return -1;
2264                 }
2265                 if (!rtp->passthrough) {
2266                         return 0;
2267                 }
2268                 rtp->passthrough = 0;
2269         }
2270 #endif
2271
2272         if ((*in & 0xC0) && res_srtp && srtp && res_srtp->unprotect(srtp, buf, &len, rtcp) < 0) {
2273            return -1;
2274         }
2275
2276         return len;
2277 }
2278
2279 static int rtcp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa)
2280 {
2281         return __rtp_recvfrom(instance, buf, size, flags, sa, 1);
2282 }
2283
2284 static int rtp_recvfrom(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa)
2285 {
2286         return __rtp_recvfrom(instance, buf, size, flags, sa, 0);
2287 }
2288
2289 static int __rtp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int rtcp, int *ice, int use_srtp)
2290 {
2291         int len = size;
2292         void *temp = buf;
2293         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2294         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance, rtcp);
2295         int res;
2296
2297         *ice = 0;
2298
2299         if (use_srtp && res_srtp && srtp && res_srtp->protect(srtp, &temp, &len, rtcp) < 0) {
2300                 return -1;
2301         }
2302
2303 #ifdef HAVE_PJPROJECT
2304         if (rtp->ice) {
2305                 pj_thread_register_check();
2306
2307                 if (pj_ice_sess_send_data(rtp->ice, rtcp ? AST_RTP_ICE_COMPONENT_RTCP : AST_RTP_ICE_COMPONENT_RTP, temp, len) == PJ_SUCCESS) {
2308                         *ice = 1;
2309                         return len;
2310                 }
2311         }
2312 #endif
2313
2314         res = ast_sendto(rtcp ? rtp->rtcp->s : rtp->s, temp, len, flags, sa);
2315         if (res > 0) {
2316                 ast_rtp_instance_set_last_tx(instance, time(NULL));
2317         }
2318
2319         return res;
2320 }
2321
2322 static int rtcp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int *ice)
2323 {
2324         return __rtp_sendto(instance, buf, size, flags, sa, 1, ice, 1);
2325 }
2326
2327 static int rtp_sendto(struct ast_rtp_instance *instance, void *buf, size_t size, int flags, struct ast_sockaddr *sa, int *ice)
2328 {
2329         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2330         int hdrlen = 12;
2331         int res;
2332
2333         if ((res = __rtp_sendto(instance, buf, size, flags, sa, 0, ice, 1)) > 0) {
2334                 rtp->txcount++;
2335                 rtp->txoctetcount += (res - hdrlen);
2336         }
2337
2338         return res;
2339 }
2340
2341 static int rtp_get_rate(struct ast_format *format)
2342 {
2343         /* For those wondering: due to a fluke in RFC publication, G.722 is advertised
2344          * as having a sample rate of 8kHz, while implementations must know that its
2345          * real rate is 16kHz. Seriously.
2346          */
2347         return (ast_format_cmp(format, ast_format_g722) == AST_FORMAT_CMP_EQUAL) ? 8000 : (int)ast_format_get_sample_rate(format);
2348 }
2349
2350 static unsigned int ast_rtcp_calc_interval(struct ast_rtp *rtp)
2351 {
2352         unsigned int interval;
2353         /*! \todo XXX Do a more reasonable calculation on this one
2354          * Look in RFC 3550 Section A.7 for an example*/
2355         interval = rtcpinterval;
2356         return interval;
2357 }
2358
2359 /*! \brief Calculate normal deviation */
2360 static double normdev_compute(double normdev, double sample, unsigned int sample_count)
2361 {
2362         normdev = normdev * sample_count + sample;
2363         sample_count++;
2364
2365         return normdev / sample_count;
2366 }
2367
2368 static double stddev_compute(double stddev, double sample, double normdev, double normdev_curent, unsigned int sample_count)
2369 {
2370 /*
2371                 for the formula check http://www.cs.umd.edu/~austinjp/constSD.pdf
2372                 return sqrt( (sample_count*pow(stddev,2) + sample_count*pow((sample-normdev)/(sample_count+1),2) + pow(sample-normdev_curent,2)) / (sample_count+1));
2373                 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
2374                 optimized formula
2375 */
2376 #define SQUARE(x) ((x) * (x))
2377
2378         stddev = sample_count * stddev;
2379         sample_count++;
2380
2381         return stddev +
2382                 ( sample_count * SQUARE( (sample - normdev) / sample_count ) ) +
2383                 ( SQUARE(sample - normdev_curent) / sample_count );
2384
2385 #undef SQUARE
2386 }
2387
2388 static int create_new_socket(const char *type, int af)
2389 {
2390         int sock = socket(af, SOCK_DGRAM, 0);
2391
2392         if (sock < 0) {
2393                 if (!type) {
2394                         type = "RTP/RTCP";
2395                 }
2396                 ast_log(LOG_WARNING, "Unable to allocate %s socket: %s\n", type, strerror(errno));
2397         } else {
2398                 long flags = fcntl(sock, F_GETFL);
2399                 fcntl(sock, F_SETFL, flags | O_NONBLOCK);
2400 #ifdef SO_NO_CHECK
2401                 if (nochecksums) {
2402                         setsockopt(sock, SOL_SOCKET, SO_NO_CHECK, &nochecksums, sizeof(nochecksums));
2403                 }
2404 #endif
2405         }
2406
2407         return sock;
2408 }
2409
2410 /*!
2411  * \internal
2412  * \brief Initializes sequence values and probation for learning mode.
2413  * \note This is an adaptation of pjmedia's pjmedia_rtp_seq_init function.
2414  *
2415  * \param info The learning information to track
2416  * \param seq sequence number read from the rtp header to initialize the information with
2417  */
2418 static void rtp_learning_seq_init(struct rtp_learning_info *info, uint16_t seq)
2419 {
2420         info->max_seq = seq - 1;
2421         info->packets = learning_min_sequential;
2422 }
2423
2424 /*!
2425  * \internal
2426  * \brief Updates sequence information for learning mode and determines if probation/learning mode should remain in effect.
2427  * \note This function was adapted from pjmedia's pjmedia_rtp_seq_update function.
2428  *
2429  * \param info Structure tracking the learning progress of some address
2430  * \param seq sequence number read from the rtp header
2431  * \retval 0 if probation mode should exit for this address
2432  * \retval non-zero if probation mode should continue
2433  */
2434 static int rtp_learning_rtp_seq_update(struct rtp_learning_info *info, uint16_t seq)
2435 {
2436         if (seq == info->max_seq + 1) {
2437                 /* packet is in sequence */
2438                 info->packets--;
2439         } else {
2440                 /* Sequence discontinuity; reset */
2441                 info->packets = learning_min_sequential - 1;
2442         }
2443         info->max_seq = seq;
2444
2445         return (info->packets == 0);
2446 }
2447
2448 #ifdef HAVE_PJPROJECT
2449 static void rtp_add_candidates_to_ice(struct ast_rtp_instance *instance, struct ast_rtp *rtp, struct ast_sockaddr *addr, int port, int component,
2450                                       int transport)
2451 {
2452         pj_sockaddr address[16];
2453         unsigned int count = PJ_ARRAY_SIZE(address), pos = 0;
2454
2455         /* Add all the local interface IP addresses */
2456         if (ast_sockaddr_is_ipv4(addr)) {
2457                 pj_enum_ip_interface(pj_AF_INET(), &count, address);
2458         } else if (ast_sockaddr_is_any(addr)) {
2459                 pj_enum_ip_interface(pj_AF_UNSPEC(), &count, address);
2460         } else {
2461                 pj_enum_ip_interface(pj_AF_INET6(), &count, address);
2462         }
2463
2464         host_candidate_overrides_apply(count, address);
2465
2466         for (pos = 0; pos < count; pos++) {
2467                 pj_sockaddr_set_port(&address[pos], port);
2468                 ast_rtp_ice_add_cand(rtp, component, transport, PJ_ICE_CAND_TYPE_HOST, 65535, &address[pos], &address[pos], NULL,
2469                                      pj_sockaddr_get_len(&address[pos]));
2470         }
2471
2472         /* If configured to use a STUN server to get our external mapped address do so */
2473         if (stunaddr.sin_addr.s_addr && ast_sockaddr_is_ipv4(addr) && count) {
2474                 struct sockaddr_in answer;
2475
2476                 if (!ast_stun_request(component == AST_RTP_ICE_COMPONENT_RTCP ? rtp->rtcp->s : rtp->s, &stunaddr, NULL, &answer)) {
2477                         pj_sockaddr base;
2478                         pj_str_t mapped = pj_str(ast_strdupa(ast_inet_ntoa(answer.sin_addr)));
2479
2480                         /* Use the first local host candidate as the base */
2481                         pj_sockaddr_cp(&base, &address[0]);
2482
2483                         pj_sockaddr_init(pj_AF_INET(), &address[0], &mapped, ntohs(answer.sin_port));
2484
2485                         ast_rtp_ice_add_cand(rtp, component, transport, PJ_ICE_CAND_TYPE_SRFLX, 65535, &address[0], &base,
2486                                              &base, pj_sockaddr_get_len(&address[0]));
2487                 }
2488         }
2489
2490         /* If configured to use a TURN relay create a session and allocate */
2491         if (pj_strlen(&turnaddr)) {
2492                 ast_rtp_ice_turn_request(instance, component, AST_TRANSPORT_TCP, pj_strbuf(&turnaddr), turnport,
2493                         pj_strbuf(&turnusername), pj_strbuf(&turnpassword));
2494         }
2495 }
2496 #endif
2497
2498 /*!
2499  * \internal
2500  * \brief Calculates the elapsed time from issue of the first tx packet in an
2501  *        rtp session and a specified time
2502  *
2503  * \param rtp pointer to the rtp struct with the transmitted rtp packet
2504  * \param delivery time of delivery - if NULL or zero value, will be ast_tvnow()
2505  *
2506  * \return time elapsed in milliseconds
2507  */
2508 static unsigned int calc_txstamp(struct ast_rtp *rtp, struct timeval *delivery)
2509 {
2510         struct timeval t;
2511         long ms;
2512
2513         if (ast_tvzero(rtp->txcore)) {
2514                 rtp->txcore = ast_tvnow();
2515                 rtp->txcore.tv_usec -= rtp->txcore.tv_usec % 20000;
2516         }
2517
2518         t = (delivery && !ast_tvzero(*delivery)) ? *delivery : ast_tvnow();
2519         if ((ms = ast_tvdiff_ms(t, rtp->txcore)) < 0) {
2520                 ms = 0;
2521         }
2522         rtp->txcore = t;
2523
2524         return (unsigned int) ms;
2525 }
2526
2527 #ifdef HAVE_PJPROJECT
2528 /*!
2529  * \internal
2530  * \brief Creates an ICE session. Can be used to replace a destroyed ICE session.
2531  *
2532  * \param instance RTP instance for which the ICE session is being replaced
2533  * \param addr ast_sockaddr to use for adding RTP candidates to the ICE session
2534  * \param port port to use for adding RTP candidates to the ICE session
2535  * \param replace 0 when creating a new session, 1 when replacing a destroyed session
2536  *
2537  * \retval 0 on success
2538  * \retval -1 on failure
2539  */
2540 static int ice_create(struct ast_rtp_instance *instance, struct ast_sockaddr *addr,
2541         int port, int replace)
2542 {
2543         pj_stun_config stun_config;
2544         pj_str_t ufrag, passwd;
2545         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2546
2547         ao2_cleanup(rtp->ice_local_candidates);
2548         rtp->ice_local_candidates = NULL;
2549
2550         pj_thread_register_check();
2551
2552         pj_stun_config_init(&stun_config, &cachingpool.factory, 0, NULL, timer_heap);
2553
2554         ufrag = pj_str(rtp->local_ufrag);
2555         passwd = pj_str(rtp->local_passwd);
2556
2557         /* Create an ICE session for ICE negotiation */
2558         if (pj_ice_sess_create(&stun_config, NULL, PJ_ICE_SESS_ROLE_UNKNOWN, 2,
2559                         &ast_rtp_ice_sess_cb, &ufrag, &passwd, NULL, &rtp->ice) == PJ_SUCCESS) {
2560                 /* Make this available for the callbacks */
2561                 rtp->ice->user_data = instance;
2562
2563                 /* Add all of the available candidates to the ICE session */
2564                 rtp_add_candidates_to_ice(instance, rtp, addr, port, AST_RTP_ICE_COMPONENT_RTP,
2565                         TRANSPORT_SOCKET_RTP);
2566
2567                 /* Only add the RTCP candidates to ICE when replacing the session. New sessions
2568                  * handle this in a separate part of the setup phase */
2569                 if (replace && rtp->rtcp) {
2570                         rtp_add_candidates_to_ice(instance, rtp, &rtp->rtcp->us,
2571                                 ast_sockaddr_port(&rtp->rtcp->us), AST_RTP_ICE_COMPONENT_RTCP,
2572                                 TRANSPORT_SOCKET_RTCP);
2573                 }
2574
2575                 return 0;
2576         }
2577
2578         return -1;
2579
2580 }
2581 #endif
2582
2583 static int ast_rtp_new(struct ast_rtp_instance *instance,
2584                        struct ast_sched_context *sched, struct ast_sockaddr *addr,
2585                        void *data)
2586 {
2587         struct ast_rtp *rtp = NULL;
2588         int x, startplace;
2589
2590         /* Create a new RTP structure to hold all of our data */
2591         if (!(rtp = ast_calloc(1, sizeof(*rtp)))) {
2592                 return -1;
2593         }
2594
2595         /* Initialize synchronization aspects */
2596         ast_mutex_init(&rtp->lock);
2597         ast_cond_init(&rtp->cond, NULL);
2598
2599         /* Set default parameters on the newly created RTP structure */
2600         rtp->ssrc = ast_random();
2601         rtp->seqno = ast_random() & 0x7fff;
2602         rtp->strict_rtp_state = (strictrtp ? STRICT_RTP_LEARN : STRICT_RTP_OPEN);
2603         if (strictrtp) {
2604                 rtp_learning_seq_init(&rtp->rtp_source_learn, (uint16_t)rtp->seqno);
2605                 rtp_learning_seq_init(&rtp->alt_source_learn, (uint16_t)rtp->seqno);
2606         }
2607
2608         /* Create a new socket for us to listen on and use */
2609         if ((rtp->s =
2610              create_new_socket("RTP",
2611                                ast_sockaddr_is_ipv4(addr) ? AF_INET  :
2612                                ast_sockaddr_is_ipv6(addr) ? AF_INET6 : -1)) < 0) {
2613                 ast_log(LOG_WARNING, "Failed to create a new socket for RTP instance '%p'\n", instance);
2614                 ast_free(rtp);
2615                 return -1;
2616         }
2617
2618         /* Now actually find a free RTP port to use */
2619         x = (rtpend == rtpstart) ? rtpstart : (ast_random() % (rtpend - rtpstart)) + rtpstart;
2620         x = x & ~1;
2621         startplace = x;
2622
2623         for (;;) {
2624                 ast_sockaddr_set_port(addr, x);
2625                 /* Try to bind, this will tell us whether the port is available or not */
2626                 if (!ast_bind(rtp->s, addr)) {
2627                         ast_debug(1, "Allocated port %d for RTP instance '%p'\n", x, instance);
2628                         ast_rtp_instance_set_local_address(instance, addr);
2629                         break;
2630                 }
2631
2632                 x += 2;
2633                 if (x > rtpend) {
2634                         x = (rtpstart + 1) & ~1;
2635                 }
2636
2637                 /* See if we ran out of ports or if the bind actually failed because of something other than the address being in use */
2638                 if (x == startplace || (errno != EADDRINUSE && errno != EACCES)) {
2639                         ast_log(LOG_ERROR, "Oh dear... we couldn't allocate a port for RTP instance '%p'\n", instance);
2640                         close(rtp->s);
2641                         ast_free(rtp);
2642                         return -1;
2643                 }
2644         }
2645
2646 #ifdef HAVE_PJPROJECT
2647         generate_random_string(rtp->local_ufrag, sizeof(rtp->local_ufrag));
2648         generate_random_string(rtp->local_passwd, sizeof(rtp->local_passwd));
2649 #endif
2650         ast_rtp_instance_set_data(instance, rtp);
2651 #ifdef HAVE_PJPROJECT
2652         /* Create an ICE session for ICE negotiation */
2653         if (icesupport) {
2654                 ast_debug(3, "Creating ICE session %s (%d) for RTP instance '%p'\n", ast_sockaddr_stringify(addr), x, instance);
2655                 if (ice_create(instance, addr, x, 0)) {
2656                         ast_log(LOG_NOTICE, "Failed to start ICE session\n");
2657                 } else {
2658                         rtp->ice_port = x;
2659                         ast_sockaddr_copy(&rtp->ice_original_rtp_addr, addr);
2660                 }
2661         }
2662 #endif
2663
2664         /* Record any information we may need */
2665         rtp->sched = sched;
2666
2667 #ifdef HAVE_OPENSSL_SRTP
2668         rtp->rekeyid = -1;
2669         rtp->dtls.timeout_timer = -1;
2670 #endif
2671
2672         rtp->f.subclass.format = ao2_bump(ast_format_none);
2673         rtp->lastrxformat = ao2_bump(ast_format_none);
2674         rtp->lasttxformat = ao2_bump(ast_format_none);
2675
2676         return 0;
2677 }
2678
2679 static int ast_rtp_destroy(struct ast_rtp_instance *instance)
2680 {
2681         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2682 #ifdef HAVE_PJPROJECT
2683         struct timeval wait = ast_tvadd(ast_tvnow(), ast_samp2tv(TURN_STATE_WAIT_TIME, 1000));
2684         struct timespec ts = { .tv_sec = wait.tv_sec, .tv_nsec = wait.tv_usec * 1000, };
2685 #endif
2686
2687 #ifdef HAVE_OPENSSL_SRTP
2688         ast_rtp_dtls_stop(instance);
2689 #endif
2690
2691         /* Destroy the smoother that was smoothing out audio if present */
2692         if (rtp->smoother) {
2693                 ast_smoother_free(rtp->smoother);
2694         }
2695
2696         /* Close our own socket so we no longer get packets */
2697         if (rtp->s > -1) {
2698                 close(rtp->s);
2699         }
2700
2701         /* Destroy RTCP if it was being used */
2702         if (rtp->rtcp) {
2703                 /*
2704                  * It is not possible for there to be an active RTCP scheduler
2705                  * entry at this point since it holds a reference to the
2706                  * RTP instance while it's active.
2707                  */
2708                 close(rtp->rtcp->s);
2709                 ast_free(rtp->rtcp->local_addr_str);
2710                 ast_free(rtp->rtcp);
2711         }
2712
2713         /* Destroy RED if it was being used */
2714         if (rtp->red) {
2715                 AST_SCHED_DEL(rtp->sched, rtp->red->schedid);
2716                 ast_free(rtp->red);
2717         }
2718
2719 #ifdef HAVE_PJPROJECT
2720         pj_thread_register_check();
2721
2722         /* Destroy the RTP TURN relay if being used */
2723         ast_mutex_lock(&rtp->lock);
2724         if (rtp->turn_rtp) {
2725                 pj_turn_sock_destroy(rtp->turn_rtp);
2726                 rtp->turn_state = PJ_TURN_STATE_NULL;
2727                 while (rtp->turn_state != PJ_TURN_STATE_DESTROYING) {
2728                         ast_cond_timedwait(&rtp->cond, &rtp->lock, &ts);
2729                 }
2730         }
2731
2732         /* Destroy the RTCP TURN relay if being used */
2733         if (rtp->turn_rtcp) {
2734                 pj_turn_sock_destroy(rtp->turn_rtcp);
2735                 rtp->turn_state = PJ_TURN_STATE_NULL;
2736                 while (rtp->turn_state != PJ_TURN_STATE_DESTROYING) {
2737                         ast_cond_timedwait(&rtp->cond, &rtp->lock, &ts);
2738                 }
2739         }
2740         ast_mutex_unlock(&rtp->lock);
2741
2742         if (rtp->ioqueue) {
2743                 rtp_ioqueue_thread_remove(rtp->ioqueue);
2744         }
2745
2746         /* Destroy the ICE session if being used */
2747         if (rtp->ice) {
2748                 pj_ice_sess_destroy(rtp->ice);
2749         }
2750
2751         /* Destroy any candidates */
2752         if (rtp->ice_local_candidates) {
2753                 ao2_ref(rtp->ice_local_candidates, -1);
2754         }
2755
2756         if (rtp->ice_active_remote_candidates) {
2757                 ao2_ref(rtp->ice_active_remote_candidates, -1);
2758         }
2759 #endif
2760
2761         ao2_cleanup(rtp->lasttxformat);
2762         ao2_cleanup(rtp->lastrxformat);
2763         ao2_cleanup(rtp->f.subclass.format);
2764
2765         /* Destroy synchronization items */
2766         ast_mutex_destroy(&rtp->lock);
2767         ast_cond_destroy(&rtp->cond);
2768
2769         /* Finally destroy ourselves */
2770         ast_free(rtp);
2771
2772         return 0;
2773 }
2774
2775 static int ast_rtp_dtmf_mode_set(struct ast_rtp_instance *instance, enum ast_rtp_dtmf_mode dtmf_mode)
2776 {
2777         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2778         rtp->dtmfmode = dtmf_mode;
2779         return 0;
2780 }
2781
2782 static enum ast_rtp_dtmf_mode ast_rtp_dtmf_mode_get(struct ast_rtp_instance *instance)
2783 {
2784         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2785         return rtp->dtmfmode;
2786 }
2787
2788 static int ast_rtp_dtmf_begin(struct ast_rtp_instance *instance, char digit)
2789 {
2790         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2791         struct ast_sockaddr remote_address = { {0,} };
2792         int hdrlen = 12, res = 0, i = 0, payload = 101;
2793         char data[256];
2794         unsigned int *rtpheader = (unsigned int*)data;
2795
2796         ast_rtp_instance_get_remote_address(instance, &remote_address);
2797
2798         /* If we have no remote address information bail out now */
2799         if (ast_sockaddr_isnull(&remote_address)) {
2800                 return -1;
2801         }
2802
2803         /* Convert given digit into what we want to transmit */
2804         if ((digit <= '9') && (digit >= '0')) {
2805                 digit -= '0';
2806         } else if (digit == '*') {
2807                 digit = 10;
2808         } else if (digit == '#') {
2809                 digit = 11;
2810         } else if ((digit >= 'A') && (digit <= 'D')) {
2811                 digit = digit - 'A' + 12;
2812         } else if ((digit >= 'a') && (digit <= 'd')) {
2813                 digit = digit - 'a' + 12;
2814         } else {
2815                 ast_log(LOG_WARNING, "Don't know how to represent '%c'\n", digit);
2816                 return -1;
2817         }
2818
2819         /* Grab the payload that they expect the RFC2833 packet to be received in */
2820         payload = ast_rtp_codecs_payload_code_tx(ast_rtp_instance_get_codecs(instance), 0, NULL, AST_RTP_DTMF);
2821
2822         rtp->dtmfmute = ast_tvadd(ast_tvnow(), ast_tv(0, 500000));
2823         rtp->send_duration = 160;
2824         rtp->lastts += calc_txstamp(rtp, NULL) * DTMF_SAMPLE_RATE_MS;
2825         rtp->lastdigitts = rtp->lastts + rtp->send_duration;
2826
2827         /* Create the actual packet that we will be sending */
2828         rtpheader[0] = htonl((2 << 30) | (1 << 23) | (payload << 16) | (rtp->seqno));
2829         rtpheader[1] = htonl(rtp->lastdigitts);
2830         rtpheader[2] = htonl(rtp->ssrc);
2831
2832         /* Actually send the packet */
2833         for (i = 0; i < 2; i++) {
2834                 int ice;
2835
2836                 rtpheader[3] = htonl((digit << 24) | (0xa << 16) | (rtp->send_duration));
2837                 res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
2838                 if (res < 0) {
2839                         ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
2840                                 ast_sockaddr_stringify(&remote_address),
2841                                 strerror(errno));
2842                 }
2843                 if (rtp_debug_test_addr(&remote_address)) {
2844                         ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6d, ts %-6.6u, len %-6.6d)\n",
2845                                     ast_sockaddr_stringify(&remote_address),
2846                                     ice ? " (via ICE)" : "",
2847                                     payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
2848                 }
2849                 rtp->seqno++;
2850                 rtp->send_duration += 160;
2851                 rtpheader[0] = htonl((2 << 30) | (payload << 16) | (rtp->seqno));
2852         }
2853
2854         /* Record that we are in the process of sending a digit and information needed to continue doing so */
2855         rtp->sending_digit = 1;
2856         rtp->send_digit = digit;
2857         rtp->send_payload = payload;
2858
2859         return 0;
2860 }
2861
2862 static int ast_rtp_dtmf_continuation(struct ast_rtp_instance *instance)
2863 {
2864         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2865         struct ast_sockaddr remote_address = { {0,} };
2866         int hdrlen = 12, res = 0;
2867         char data[256];
2868         unsigned int *rtpheader = (unsigned int*)data;
2869         int ice;
2870
2871         ast_rtp_instance_get_remote_address(instance, &remote_address);
2872
2873         /* Make sure we know where the other side is so we can send them the packet */
2874         if (ast_sockaddr_isnull(&remote_address)) {
2875                 return -1;
2876         }
2877
2878         /* Actually create the packet we will be sending */
2879         rtpheader[0] = htonl((2 << 30) | (rtp->send_payload << 16) | (rtp->seqno));
2880         rtpheader[1] = htonl(rtp->lastdigitts);
2881         rtpheader[2] = htonl(rtp->ssrc);
2882         rtpheader[3] = htonl((rtp->send_digit << 24) | (0xa << 16) | (rtp->send_duration));
2883
2884         /* Boom, send it on out */
2885         res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
2886         if (res < 0) {
2887                 ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
2888                         ast_sockaddr_stringify(&remote_address),
2889                         strerror(errno));
2890         }
2891
2892         if (rtp_debug_test_addr(&remote_address)) {
2893                 ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6d, ts %-6.6u, len %-6.6d)\n",
2894                             ast_sockaddr_stringify(&remote_address),
2895                             ice ? " (via ICE)" : "",
2896                             rtp->send_payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
2897         }
2898
2899         /* And now we increment some values for the next time we swing by */
2900         rtp->seqno++;
2901         rtp->send_duration += 160;
2902         rtp->lastts += calc_txstamp(rtp, NULL) * DTMF_SAMPLE_RATE_MS;
2903
2904         return 0;
2905 }
2906
2907 static int ast_rtp_dtmf_end_with_duration(struct ast_rtp_instance *instance, char digit, unsigned int duration)
2908 {
2909         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2910         struct ast_sockaddr remote_address = { {0,} };
2911         int hdrlen = 12, res = -1, i = 0;
2912         char data[256];
2913         unsigned int *rtpheader = (unsigned int*)data;
2914         unsigned int measured_samples;
2915
2916         ast_rtp_instance_get_remote_address(instance, &remote_address);
2917
2918         /* Make sure we know where the remote side is so we can send them the packet we construct */
2919         if (ast_sockaddr_isnull(&remote_address)) {
2920                 goto cleanup;
2921         }
2922
2923         /* Convert the given digit to the one we are going to send */
2924         if ((digit <= '9') && (digit >= '0')) {
2925                 digit -= '0';
2926         } else if (digit == '*') {
2927                 digit = 10;
2928         } else if (digit == '#') {
2929                 digit = 11;
2930         } else if ((digit >= 'A') && (digit <= 'D')) {
2931                 digit = digit - 'A' + 12;
2932         } else if ((digit >= 'a') && (digit <= 'd')) {
2933                 digit = digit - 'a' + 12;
2934         } else {
2935                 ast_log(LOG_WARNING, "Don't know how to represent '%c'\n", digit);
2936                 goto cleanup;
2937         }
2938
2939         rtp->dtmfmute = ast_tvadd(ast_tvnow(), ast_tv(0, 500000));
2940
2941         if (duration > 0 && (measured_samples = duration * rtp_get_rate(rtp->f.subclass.format) / 1000) > rtp->send_duration) {
2942                 ast_debug(2, "Adjusting final end duration from %d to %u\n", rtp->send_duration, measured_samples);
2943                 rtp->send_duration = measured_samples;
2944         }
2945
2946         /* Construct the packet we are going to send */
2947         rtpheader[1] = htonl(rtp->lastdigitts);
2948         rtpheader[2] = htonl(rtp->ssrc);
2949         rtpheader[3] = htonl((digit << 24) | (0xa << 16) | (rtp->send_duration));
2950         rtpheader[3] |= htonl((1 << 23));
2951
2952         /* Send it 3 times, that's the magical number */
2953         for (i = 0; i < 3; i++) {
2954                 int ice;
2955
2956                 rtpheader[0] = htonl((2 << 30) | (rtp->send_payload << 16) | (rtp->seqno));
2957
2958                 res = rtp_sendto(instance, (void *) rtpheader, hdrlen + 4, 0, &remote_address, &ice);
2959
2960                 if (res < 0) {
2961                         ast_log(LOG_ERROR, "RTP Transmission error to %s: %s\n",
2962                                 ast_sockaddr_stringify(&remote_address),
2963                                 strerror(errno));
2964                 }
2965
2966                 if (rtp_debug_test_addr(&remote_address)) {
2967                         ast_verbose("Sent RTP DTMF packet to %s%s (type %-2.2d, seq %-6.6d, ts %-6.6u, len %-6.6d)\n",
2968                                     ast_sockaddr_stringify(&remote_address),
2969                                     ice ? " (via ICE)" : "",
2970                                     rtp->send_payload, rtp->seqno, rtp->lastdigitts, res - hdrlen);
2971                 }
2972
2973                 rtp->seqno++;
2974         }
2975         res = 0;
2976
2977         /* Oh and we can't forget to turn off the stuff that says we are sending DTMF */
2978         rtp->lastts += calc_txstamp(rtp, NULL) * DTMF_SAMPLE_RATE_MS;
2979 cleanup:
2980         rtp->sending_digit = 0;
2981         rtp->send_digit = 0;
2982
2983         return res;
2984 }
2985
2986 static int ast_rtp_dtmf_end(struct ast_rtp_instance *instance, char digit)
2987 {
2988         return ast_rtp_dtmf_end_with_duration(instance, digit, 0);
2989 }
2990
2991 static void ast_rtp_update_source(struct ast_rtp_instance *instance)
2992 {
2993         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
2994
2995         /* We simply set this bit so that the next packet sent will have the marker bit turned on */
2996         ast_set_flag(rtp, FLAG_NEED_MARKER_BIT);
2997         ast_debug(3, "Setting the marker bit due to a source update\n");
2998
2999         return;
3000 }
3001
3002 static void ast_rtp_change_source(struct ast_rtp_instance *instance)
3003 {
3004         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
3005         struct ast_srtp *srtp = ast_rtp_instance_get_srtp(instance, 0);
3006         struct ast_srtp *rtcp_srtp = ast_rtp_instance_get_srtp(instance, 1);
3007         unsigned int ssrc = ast_random();
3008
3009         if (!rtp->lastts) {
3010                 ast_debug(3, "Not changing SSRC since we haven't sent any RTP yet\n");
3011                 return;
3012         }
3013
3014         /* We simply set this bit so that the next packet sent will have the marker bit turned on */
3015         ast_set_flag(rtp, FLAG_NEED_MARKER_BIT);
3016
3017         ast_debug(3, "Changing ssrc from %u to %u due to a source change\n", rtp->ssrc, ssrc);
3018
3019         if (srtp) {
3020                 ast_debug(3, "Changing ssrc for SRTP from %u to %u\n", rtp->ssrc, ssrc);
3021                 res_srtp->change_source(srtp, rtp->ssrc, ssrc);
3022                 if (rtcp_srtp != srtp) {
3023                         res_srtp->change_source(srtp, rtp->ssrc, ssrc);
3024                 }
3025         }
3026
3027         rtp->ssrc = ssrc;
3028
3029         return;
3030 }
3031
3032 static void timeval2ntp(struct timeval tv, unsigned int *msw, unsigned int *lsw)
3033 {
3034         unsigned int sec, usec, frac;
3035         sec = tv.tv_sec + 2208988800u; /* Sec between 1900 and 1970 */
3036         usec = tv.tv_usec;
3037         frac = (usec << 12) + (usec << 8) - ((usec * 3650) >> 6);
3038         *msw = sec;
3039         *lsw = frac;
3040 }
3041
3042 static void ntp2timeval(unsigned int msw, unsigned int lsw, struct timeval *tv)
3043 {
3044         tv->tv_sec = msw - 2208988800u;
3045         tv->tv_usec = ((lsw << 6) / 3650) - (lsw >> 12) - (lsw >> 8);
3046 }
3047
3048 static void calculate_lost_packet_statistics(struct ast_rtp *rtp,
3049                 unsigned int *lost_packets,
3050                 int *fraction_lost)
3051 {
3052         unsigned int extended_seq_no;
3053         unsigned int expected_packets;
3054         unsigned int expected_interval;
3055         unsigned int received_interval;
3056         double rxlost_current;
3057         int lost_interval;
3058
3059         /* Compute statistics */
3060         extended_seq_no = rtp->cycles + rtp->lastrxseqno;
3061         expected_packets = extended_seq_no - rtp->seedrxseqno + 1;
3062         if (rtp->rxcount > expected_packets) {
3063                 expected_packets += rtp->rxcount - expected_packets;
3064         }
3065         *lost_packets = expected_packets - rtp->rxcount;
3066         expected_interval = expected_packets - rtp->rtcp->expected_prior;
3067         received_interval = rtp->rxcount - rtp->rtcp->received_prior;
3068         lost_interval = expected_interval - received_interval;
3069         if (expected_interval == 0 || lost_interval <= 0) {
3070                 *fraction_lost = 0;
3071         } else {
3072                 *fraction_lost = (lost_interval << 8) / expected_interval;
3073         }
3074
3075         /* Update RTCP statistics */
3076         rtp->rtcp->received_prior = rtp->rxcount;
3077         rtp->rtcp->expected_prior = expected_packets;
3078         if (lost_interval <= 0) {
3079                 rtp->rtcp->rxlost = 0;
3080         } else {
3081                 rtp->rtcp->rxlost = lost_interval;
3082         }
3083         if (rtp->rtcp->rxlost_count == 0) {
3084                 rtp->rtcp->minrxlost = rtp->rtcp->rxlost;
3085         }
3086         if (lost_interval < rtp->rtcp->minrxlost) {
3087                 rtp->rtcp->minrxlost = rtp->rtcp->rxlost;
3088         }
3089         if (lost_interval > rtp->rtcp->maxrxlost) {
3090                 rtp->rtcp->maxrxlost = rtp->rtcp->rxlost;
3091         }
3092         rxlost_current = normdev_compute(rtp->rtcp->normdev_rxlost,
3093                         rtp->rtcp->rxlost,
3094                         rtp->rtcp->rxlost_count);
3095         rtp->rtcp->stdev_rxlost = stddev_compute(rtp->rtcp->stdev_rxlost,
3096                         rtp->rtcp->rxlost,
3097                         rtp->rtcp->normdev_rxlost,
3098                         rxlost_current,
3099                         rtp->rtcp->rxlost_count);
3100         rtp->rtcp->normdev_rxlost = rxlost_current;
3101         rtp->rtcp->rxlost_count++;
3102 }
3103
3104 /*! \brief Send RTCP SR or RR report */
3105 static int ast_rtcp_write_report(struct ast_rtp_instance *instance, int sr)
3106 {
3107         struct ast_rtp *rtp = ast_rtp_instance_get_data(instance);
3108         RAII_VAR(struct ast_json *, message_blob, NULL, ast_json_unref);
3109         int res;
3110         int len = 0;
3111         struct timeval now;
3112         unsigned int now_lsw;
3113         unsigned int now_msw;
3114         unsigned int *rtcpheader;
3115         unsigned int lost_packets;
3116         int fraction_lost;
3117         struct timeval dlsr = { 0, };
3118         char bdata[512];
3119         int rate = rtp_get_rate(rtp->f.subclass.format);
3120         int ice;
3121         int header_offset = 0;
3122         struct ast_sockaddr remote_address = { { 0, } };
3123         struct ast_rtp_rtcp_report_block *report_block = NULL;
3124         RAII_VAR(struct ast_rtp_rtcp_report *, rtcp_report,
3125                         ast_rtp_rtcp_report_alloc(rtp->themssrc ? 1 : 0),
3126                         ao2_cleanup);
3127
3128         if (!rtp || !rtp->rtcp) {
3129                 return 0;
3130         }
3131
3132         if (ast_sockaddr_isnull(&rtp->rtcp->them)) {  /* This'll stop rtcp for this rtp session */
3133                 /* RTCP was stopped. */
3134                 return 0;
3135         }
3136
3137         if (!rtcp_report) {
3138                 return 1;
3139         }
3140
3141         /* Compute statistics */
3142         calculate_lost_packet_statistics(rtp, &lost_packets, &fraction_lost);
3143
3144         gettimeofday(&now, NULL);
3145         rtcp_report->reception_report_count = rtp->themssrc ? 1 : 0;
3146         rtcp_report->ssrc = rtp->ssrc;
3147         rtcp_report->type = sr ? RTCP_PT_SR : RTCP_PT_RR;
3148         if (sr) {
3149                 rtcp_report->sender_information.ntp_timestamp = now;
3150                 rtcp_report->sender_information.rtp_timestamp = rtp->lastts;
3151                 rtcp_report->sender_information.packet_count = rtp->txcount;
3152                 rtcp_report->sender_information.octet_count = rtp->txoctetcount;
3153         }
3154
3155         if (rtp->themssrc) {
3156                 report_block = ast_calloc(1, sizeof(*report_block));
3157                 if (!report_block) {
3158                         return 1;
3159                 }
3160
3161                 rtcp_report->report_block[0] = report_block;
3162                 report_block->source_ssrc = rtp->themssrc;
3163                 report_block->lost_count.fraction = (fraction_lost & 0xff);
3164                 report_block->lost_count.packets = (lost_packets & 0xffffff);
3165                 report_block->highest_seq_no = (rtp->cycles | (rtp->lastrxseqno & 0xffff));
3166                 report_block->ia_jitter = (unsigned int)(rtp->rxjitter * rate);
3167                 report_block->lsr = rtp->rtcp->themrxlsr;
3168                 /* If we haven't received an SR report, DLSR should be 0 */
3169                 if (!ast_tvzero(rtp->rtcp->rxlsr)) {
3170                         timersub(&now, &rtp->rtcp->rxlsr, &dlsr);
3171                         report_block->dlsr = (((dlsr.tv_sec * 1000) + (dlsr.tv_usec / 1000)) * 65536) / 1000;
3172                 }
3173         }
3174         timeval2ntp(rtcp_report->sender_information.ntp_timestamp, &now_msw, &now_lsw);
3175         rtcpheader = (unsigned int *)bdata;
3176         rtcpheader[1] = htonl(rtcp_report->ssrc);            /* Our SSRC */
3177         len += 8;
3178         if (sr) {
3179                 header_offset = 5;
3180                 rtcpheader[2] = htonl(now_msw);                 /* now, MSW. gettimeofday() + SEC_BETWEEN_1900_AND_1970*/
3181                 rtcpheader[3] = htonl(now_lsw);                 /* now, LSW */
3182                 rtcpheader[4] = htonl(rtcp_report->sender_information.rtp_timestamp);
3183                 rtcpheader[5] = htonl(rtcp_report->sender_information.packet_count);
3184                 rtcpheader[6] = htonl(rtcp_report->sender_information.octet_count);
3185                 len += 20;
3186         }
3187         if (report_block) {
3188                 rtcpheader[2 + header_offset] = htonl(report_block->source_ssrc);     /* Their SSRC */
3189                 rtcpheader[3 + header_offset] = htonl((report_block->lost_count.fraction << 24) | report_block->lost_count.packets);
3190                 rtcpheader[4 + header_offset] = htonl(report_block->highest_seq_no);
3191                 rtcpheader[5 + header_offset] = htonl(report_block->ia_jitter);
3192                 rtcpheader[6 + header_offset] = htonl(report_block->lsr);
3193                 rtcpheader[7 + header_offset] = htonl(report_block->dlsr);
3194                 len += 24;
3195         }
3196         rtcpheader[0] = htonl((2 << 30) | (rtcp_report->reception_report_count << 24)
3197                                         | ((sr ? RTCP_PT_SR : RTCP_PT_RR) << 16) | ((len/4)-1));
3198
3199         /* Insert SDES here. Probably should make SDES text equal to mimetypes[code].type (not subtype 'cos */
3200         /* it can change mid call, and SDES can't) */
3201         rtcpheader[len/4]     = htonl((2 << 30) | (1 << 24) | (RTCP_PT_SDES << 16) | 2);
3202         rtcpheader[(len/4)+1] = htonl(rtcp_report->ssrc);
3203         rtcpheader[(len/4)+2] = htonl(0x01 << 24);
3204         len += 12;
3205
3206         ast_sockaddr_copy(&remote_address, &rtp->rtcp->them);
3207         res = rtcp_sendto(instance, (unsigned int *)rtcpheader, len, 0, &remote_address, &ice);
3208         if (res < 0) {
3209                 ast_log(LOG_ERROR, "RTCP %s transmission error to %s, rtcp halted %s\n",
3210                         sr ? "SR" : "RR",
3211                         ast_sockaddr_stringify(&rtp->rtcp->them),
3212                         strerror(errno));
3213                 return 0;
3214         }
3215
3216         /* Update RTCP SR/RR statistics */
3217         if (sr) {
3218                 rtp->rtcp->txlsr = rtcp_report->sender_information.ntp_timestamp;
3219                 rtp->rtcp->sr_count++;
3220                 rtp->rtcp->lastsrtxcount = rtp->txcount;
3221         } else {
3222                 rtp->rtcp->rr_count++;
3223         }
3224
3225         if (rtcp_debug_test_addr(&rtp->rtcp->them)) {
3226                 ast_verbose("* Sent RTCP %s to %s%s\n", sr ? "SR" : "RR",
3227                                 ast_sockaddr_stringify(&remote_address), ice ? " (via ICE)" : "");
3228                 ast_verbose("  Our SSRC: %u\n", rtcp_report->ssrc);
3229                 if (sr) {
3230                         ast_verbose("  Sent(NTP): %u.%010u\n",
3231                                 (unsigned int)rtcp_report->sender_information.ntp_timestamp.tv_sec,
3232                                 (unsigned int)rtcp_report->sender_information.ntp_timestamp.tv_usec * 4096);
3233                         ast_verbose("  Sent(RTP): %u\n", rtcp_report->sender_information.rtp_timestamp);
3234                         ast_verbose("  Sent packets: %u\n", rtcp_report->sender_information.packet_count);
3235                         ast_verbose("  Sent octets: %u\n", rtcp_report->sender_information.octet_count);
3236                 }
3237                 if (report_block) {
3238                         ast_verbose("  Report block:\n");
3239                         ast_verbose("    Their SSRC: %u\n", report_block->source_ss