/* (C) 2021 by sysmocom - s.f.m.c. GmbH * Author: Pau Espin Pedrol * All Rights Reserved * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU Affero General Public License as published by * the Free Software Foundation; either version 3 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU Affero General Public License for more details. * * You should have received a copy of the GNU Affero General Public License * along with this program. If not, see . * */ #include "config.h" #include #include #include #include #include struct rtp_conn *rtp_conn_alloc(struct hnb_ue *ue) { struct rtp_conn *conn; conn = talloc_zero(ue, struct rtp_conn); if (!conn) return NULL; conn->ue = ue; llist_add(&conn->list, &ue->conn_cs.conn_list); return conn; } void rtp_conn_free(struct rtp_conn *conn) { if (!conn) return; if (conn->socket) { osmo_rtp_socket_free(conn->socket); conn->socket = NULL; } llist_del(&conn->list); talloc_free(conn); } /* Mixture between osmo_rtp_get_bound_addr and osmo_rtp_get_bound_ip_port using osmo_sockaddr */ /*static int rtp_get_bound_addr(struct osmo_rtp_socket *rs, struct osmo_sockaddr *osa) { int rc; socklen_t alen = sizeof(*osa); rc = getsockname(rs->rtp_bfd.fd, (struct sockaddr *)&osa->u.sa, &alen); if (rc < 0) { LOGP(DRTP, LOGL_ERROR, "getsockname(%d) failed: %s\n", rs->rtp_bfd.fd, strerror(errno)); return rc; } LOGP(DRTP, LOGL_DEBUG, "rtp socket: %s\n", osmo_sock_get_name2(rs->rtp_bfd.fd)); return 0; }*/ /* osmo_rtp_socket_connect() is broken, OS#5356 */ static int rtp_get_bound_addr(struct osmo_rtp_socket *rs, const struct osmo_sockaddr *rem_addr, struct osmo_sockaddr *osa) { int rc; uint16_t port; socklen_t alen = sizeof(*osa); /* First, retrieve bound port using getsockname: */ rc = getsockname(rs->rtp_bfd.fd, (struct sockaddr *)&osa->u.sa, &alen); if (rc < 0) return rc; switch (osa->u.sa.sa_family) { case AF_INET6: port = ntohs(osa->u.sin6.sin6_port); break; case AF_INET: port = ntohs(osa->u.sin.sin_port); break; default: return -EINVAL; } /* osmo_rtp_socket_connect() is broken, OS#5356, so we didn't connect() * and hence local_addr may still be unresolved (0.0.0.0) in the socket. * let's get it from OS regular routing: */ rc = osmo_sockaddr_local_ip(osa, rem_addr); if (rc < 0) { LOGP(DRTP, LOGL_ERROR, "osmo_sockaddr_local_ip(%d) failed: err=%d\n", rs->rtp_bfd.fd, -rc); return rc; } /* Copy back the correct port to the returned address: */ switch (osa->u.sa.sa_family) { case AF_INET6: osa->u.sin6.sin6_port = htons(port); break; case AF_INET: osa->u.sin.sin_port = htons(port); break; default: return -EINVAL; } return 0; } static int rtp_bind(struct hnb *hnb, struct osmo_rtp_socket *rs, const char *ip) { int rc; unsigned int i; unsigned int tries; tries = (hnb->rtp.port_range_end - hnb->rtp.port_range_start) / 2; for (i = 0; i < tries; i++) { uint16_t port; if (hnb->rtp.port_range_next >= hnb->rtp.port_range_end) hnb->rtp.port_range_next = hnb->rtp.port_range_start; port = hnb->rtp.port_range_next; rc = osmo_rtp_socket_bind(rs, ip, port); hnb->rtp.port_range_next += 2; if (rc != 0) continue; if (hnb->rtp.ip_dscp != -1) { if (osmo_rtp_socket_set_dscp(rs, hnb->rtp.ip_dscp)) LOGP(DRTP, LOGL_ERROR, "failed to set DSCP=%d: %s\n", hnb->rtp.ip_dscp, strerror(errno)); } if (hnb->rtp.priority != -1) { if (osmo_rtp_socket_set_priority(rs, hnb->rtp.priority)) LOGP(DRTP, LOGL_ERROR, "failed to set socket priority %d: %s\n", hnb->rtp.priority, strerror(errno)); } return port; } return -1; } static void rtp_rx_cb(struct osmo_rtp_socket *rs, const uint8_t *rtp_pl, unsigned int rtp_pl_len, uint16_t seq_number, uint32_t timestamp, bool marker) { struct rtp_conn *conn = (struct rtp_conn *)rs->priv; LOGUE(conn->ue, DRTP, LOGL_DEBUG, "Rx RTP seq=%u ts=%u M=%u pl=%p len=%u\n", seq_number, timestamp, marker, rtp_pl, rtp_pl_len); llsk_audio_tx_conn_data_ind(conn, rtp_pl, rtp_pl_len); } int rtp_conn_setup(struct rtp_conn *conn, const struct osmo_sockaddr *rem_addr) { int rc; char cname[256+4]; char name[32]; struct osmo_rtp_socket *rs; const char *local_wildcard_ipstr = "0.0.0.0"; char remote_ipstr[INET6_ADDRSTRLEN]; uint16_t remote_port; struct hnb_ue *ue = conn->ue; struct hnb *hnb = ue->hnb; if (osmo_sockaddr_to_str_and_uint(remote_ipstr, sizeof(remote_ipstr), &remote_port, &rem_addr->u.sa) == 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Failed parsing remote address!\n"); return -EINVAL; } conn->rem_addr = *rem_addr; rs = conn->socket = osmo_rtp_socket_create(ue, 0); rc = osmo_rtp_socket_set_param(rs, hnb->rtp.jitter_adaptive ? OSMO_RTP_P_JIT_ADAP : OSMO_RTP_P_JITBUF, hnb->rtp.jitter_buf_ms); if (rc < 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Failed to set RTP socket parameters: %s\n", strerror(-rc)); goto free_ret; } /* TS 25.414 Section 5.1.3.3.1.6: A dynamic Payload Type (IETF RFC 1890 * [23]) shall be used. Values in the Range between 96 and 127 shall be * used. The value shall be ignored in the receiving entity. */ rc = osmo_rtp_socket_set_pt(rs, 96); if (rc < 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Failed to set RTP socket Payload-Type 96\n"); /* Continue, the other side is anyway ignoring it... */ } rs->priv = conn; rs->rx_cb = &rtp_rx_cb; rc = rtp_bind(hnb, rs, local_wildcard_ipstr); if (rc < 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Failed to bind RTP/RTCP sockets\n"); goto free_ret; } conn->id = rc; /* We use local port as rtp conn ID */ /* Ensure RTCP SDES contains some useful information */ snprintf(cname, sizeof(cname), "hnb@%s", local_wildcard_ipstr); snprintf(name, sizeof(name), "ue@%u-%u", conn->ue->conn_id, conn->id); osmo_rtp_set_source_desc(rs, cname, name, NULL, NULL, NULL, "OsmoHNodeB-" PACKAGE_VERSION, NULL); rc = osmo_rtp_socket_connect(rs, remote_ipstr, remote_port); if (rc < 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Failed to connect RTP/RTCP sockets\n"); goto free_ret; } /* osmo_rtp_socket_connect() is broken, OS#5356 */ //rc = rtp_get_bound_addr(rs, &conn->loc_addr); rc = rtp_get_bound_addr(rs, rem_addr, &conn->loc_addr); if (rc < 0) { LOGUE(ue, DRTP, LOGL_ERROR, "Cannot obtain locally bound IP/port: %d\n", rc); goto free_ret; } return rc; free_ret: osmo_rtp_socket_free(conn->socket); conn->socket = NULL; return rc; }