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