blob: dc8cd81b619e3cba35049a2375a8808bc3f1f861 [file] [log] [blame]
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +08001/*
2 * (C) 2010 by Holger Hans Peter Freyther <zecke@selfish.org>
3 * (C) 2010 by On-Waves
4 * All Rights Reserved
5 *
6 * This program is free software; you can redistribute it and/or modify
Harald Welte9af6ddf2011-01-01 15:25:50 +01007 * it under the terms of the GNU Affero General Public License as published by
8 * the Free Software Foundation; either version 3 of the License, or
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +08009 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
Harald Welte9af6ddf2011-01-01 15:25:50 +010014 * GNU Affero General Public License for more details.
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080015 *
Harald Welte9af6ddf2011-01-01 15:25:50 +010016 * You should have received a copy of the GNU Affero General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080018 *
19 */
20
21#include <openbsc/bsc_nat.h>
Holger Hans Peter Freytherc2b31ed2010-07-31 05:17:17 +080022#include <openbsc/bsc_nat_sccp.h>
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080023#include <openbsc/gsm_data.h>
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080024#include <openbsc/debug.h>
Holger Hans Peter Freyther19c530c2010-10-13 23:52:01 +020025#include <openbsc/ipaccess.h>
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +020026#include <openbsc/mgcp.h>
27#include <openbsc/mgcp_internal.h>
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080028
Harald Welted5db12c2010-08-03 15:11:51 +020029#include <osmocom/sccp/sccp.h>
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +080030
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +020031#include <osmocore/talloc.h>
Holger Hans Peter Freyther13959482010-06-15 18:50:57 +080032#include <osmocore/gsm0808.h>
Holger Hans Peter Freyther69d801e2010-06-15 20:13:33 +080033#include <osmocore/protocol/gsm_08_08.h>
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +020034
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080035#include <netinet/in.h>
36#include <arpa/inet.h>
37
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +020038#include <errno.h>
39#include <unistd.h>
40
Holger Hans Peter Freyther45fd07d2010-08-28 18:22:14 +080041static int bsc_assign_endpoint(struct bsc_connection *bsc, struct sccp_connections *con)
42{
43 const int number_endpoints = ARRAY_SIZE(bsc->endpoint_status);
44 int i;
45
46 for (i = 1; i < number_endpoints; ++i) {
47 int endpoint = (bsc->last_endpoint + i) % number_endpoints;
48 if (endpoint == 0)
49 endpoint = 1;
50
51 if (bsc->endpoint_status[endpoint] == 0) {
52 bsc->endpoint_status[endpoint] = 1;
53 con->bsc_endp = endpoint;
54 bsc->last_endpoint = endpoint;
55 return 0;
56 }
57 }
58
59 return -1;
60}
61
62static uint16_t create_cic(int endpoint)
63{
64 int timeslot, multiplex;
65
66 mgcp_endpoint_to_timeslot(endpoint, &multiplex, &timeslot);
67 return (multiplex << 5) | (timeslot & 0x1f);
68}
69
70int bsc_mgcp_assign_patch(struct sccp_connections *con, struct msgb *msg)
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080071{
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +080072 struct sccp_connections *mcon;
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080073 struct tlv_parsed tp;
Holger Hans Peter Freythere2c15202010-07-23 19:09:21 +080074 uint16_t cic;
Holger Hans Peter Freytherdbd16fe2010-07-23 19:08:55 +080075 uint8_t timeslot;
76 uint8_t multiplex;
Holger Hans Peter Freyther14069772010-11-04 17:14:41 +010077 unsigned int endp;
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080078
79 if (!msg->l3h) {
80 LOGP(DNAT, LOGL_ERROR, "Assignment message should have l3h pointer.\n");
81 return -1;
82 }
83
84 if (msgb_l3len(msg) < 3) {
85 LOGP(DNAT, LOGL_ERROR, "Assignment message has not enough space for GSM0808.\n");
86 return -1;
87 }
88
89 tlv_parse(&tp, gsm0808_att_tlvdef(), msg->l3h + 3, msgb_l3len(msg) - 3, 0, 0);
90 if (!TLVP_PRESENT(&tp, GSM0808_IE_CIRCUIT_IDENTITY_CODE)) {
91 LOGP(DNAT, LOGL_ERROR, "Circuit identity code not found in assignment message.\n");
92 return -1;
93 }
94
Holger Hans Peter Freythere2c15202010-07-23 19:09:21 +080095 cic = ntohs(*(uint16_t *)TLVP_VAL(&tp, GSM0808_IE_CIRCUIT_IDENTITY_CODE));
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080096 timeslot = cic & 0x1f;
97 multiplex = (cic & ~0x1f) >> 5;
98
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +080099
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800100 endp = mgcp_timeslot_to_endpoint(multiplex, timeslot);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800101
Holger Hans Peter Freyther14069772010-11-04 17:14:41 +0100102 if (endp >= con->bsc->nat->mgcp_cfg->number_endpoints) {
103 LOGP(DNAT, LOGL_ERROR,
104 "MSC attempted to assign bad endpoint 0x%x\n",
105 endp);
106 return -1;
107 }
108
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800109 /* find stale connections using that endpoint */
110 llist_for_each_entry(mcon, &con->bsc->nat->sccp_connections, list_entry) {
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800111 if (mcon->msc_endp == endp) {
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800112 LOGP(DNAT, LOGL_ERROR,
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800113 "Endpoint %d was assigned to 0x%x and now 0x%x\n",
114 endp,
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800115 sccp_src_ref_to_int(&mcon->patched_ref),
116 sccp_src_ref_to_int(&con->patched_ref));
117 bsc_mgcp_dlcx(mcon);
118 }
119 }
120
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800121 con->msc_endp = endp;
Holger Hans Peter Freyther45fd07d2010-08-28 18:22:14 +0800122 if (bsc_assign_endpoint(con->bsc, con) != 0)
123 return -1;
124
125 /*
126 * now patch the message for the new CIC...
127 * still assumed to be one multiplex only
128 */
129 cic = htons(create_cic(con->bsc_endp));
130 memcpy((uint8_t *) TLVP_VAL(&tp, GSM0808_IE_CIRCUIT_IDENTITY_CODE),
131 &cic, sizeof(cic));
132
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +0800133 return 0;
134}
135
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800136static void bsc_mgcp_free_endpoint(struct bsc_nat *nat, int i)
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200137{
138 if (nat->bsc_endpoints[i].transaction_id) {
139 talloc_free(nat->bsc_endpoints[i].transaction_id);
140 nat->bsc_endpoints[i].transaction_id = NULL;
141 }
142
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800143 nat->bsc_endpoints[i].transaction_state = 0;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200144 nat->bsc_endpoints[i].bsc = NULL;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200145}
146
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200147void bsc_mgcp_free_endpoints(struct bsc_nat *nat)
148{
149 int i;
150
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800151 for (i = 1; i < nat->mgcp_cfg->number_endpoints; ++i){
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200152 bsc_mgcp_free_endpoint(nat, i);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800153 mgcp_free_endp(&nat->mgcp_cfg->endpoints[i]);
154 }
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200155}
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200156
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800157/* send a MDCX where we do not want a response */
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800158static void bsc_mgcp_send_mdcx(struct bsc_connection *bsc, int port, struct mgcp_endpoint *endp)
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800159{
160 char buf[2096];
161 int len;
162
163 len = snprintf(buf, sizeof(buf),
Holger Hans Peter Freytherf42f45b2010-04-22 13:06:24 +0800164 "MDCX 23 %x@mgw MGCP 1.0\r\n"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800165 "Z: noanswer\r\n"
166 "\r\n"
167 "c=IN IP4 %s\r\n"
168 "m=audio %d RTP/AVP 255\r\n",
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800169 port,
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800170 bsc->nat->mgcp_cfg->source_addr,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800171 endp->bts_end.local_port);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800172 if (len < 0) {
173 LOGP(DMGCP, LOGL_ERROR, "snprintf for DLCX failed.\n");
174 return;
175 }
Holger Hans Peter Freytherd38aa452010-08-30 11:58:49 +0800176
177 #warning "The MDCX is not send to the BSC. It should"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800178}
179
180static void bsc_mgcp_send_dlcx(struct bsc_connection *bsc, int endpoint)
181{
182 char buf[2096];
183 int len;
184
185 len = snprintf(buf, sizeof(buf),
Holger Hans Peter Freytherbf812fa2010-08-30 12:01:36 +0800186 "DLCX 26 %x@mgw MGCP 1.0\r\n"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800187 "Z: noanswer\r\n", endpoint);
188 if (len < 0) {
189 LOGP(DMGCP, LOGL_ERROR, "snprintf for DLCX failed.\n");
190 return;
191 }
192
Holger Hans Peter Freytherdbd16fe2010-07-23 19:08:55 +0800193 bsc_write_mgcp(bsc, (uint8_t *) buf, len);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800194}
195
196void bsc_mgcp_init(struct sccp_connections *con)
197{
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800198 con->msc_endp = -1;
199 con->bsc_endp = -1;
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800200}
201
202void bsc_mgcp_dlcx(struct sccp_connections *con)
203{
204 /* send a DLCX down the stream */
Holger Hans Peter Freyther39cd32e2010-08-28 18:11:07 +0800205 if (con->bsc_endp != -1) {
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800206 if (con->bsc->endpoint_status[con->bsc_endp] != 1)
207 LOGP(DNAT, LOGL_ERROR, "Endpoint 0x%x was not in use\n", con->bsc_endp);
208 con->bsc->endpoint_status[con->bsc_endp] = 0;
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800209 bsc_mgcp_send_dlcx(con->bsc, con->bsc_endp);
210 bsc_mgcp_free_endpoint(con->bsc->nat, con->msc_endp);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800211 }
212
213 bsc_mgcp_init(con);
214}
215
216
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800217struct sccp_connections *bsc_mgcp_find_con(struct bsc_nat *nat, int endpoint)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200218{
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800219 struct sccp_connections *con = NULL;
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200220 struct sccp_connections *sccp;
221
222 llist_for_each_entry(sccp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800223 if (sccp->msc_endp == -1)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200224 continue;
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800225 if (sccp->msc_endp != endpoint)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200226 continue;
227
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800228 con = sccp;
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200229 }
230
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800231 if (con)
232 return con;
Holger Hans Peter Freythereb52e892010-04-18 02:14:45 +0800233
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200234 LOGP(DMGCP, LOGL_ERROR, "Failed to find the connection.\n");
235 return NULL;
236}
237
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200238int bsc_mgcp_policy_cb(struct mgcp_config *cfg, int endpoint, int state, const char *transaction_id)
239{
240 struct bsc_nat *nat;
241 struct bsc_endpoint *bsc_endp;
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800242 struct sccp_connections *sccp;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200243 struct mgcp_endpoint *mgcp_endp;
244 struct msgb *bsc_msg;
245
246 nat = cfg->data;
247 bsc_endp = &nat->bsc_endpoints[endpoint];
248 mgcp_endp = &nat->mgcp_cfg->endpoints[endpoint];
249
Holger Hans Peter Freytherfef76122010-04-24 21:05:18 +0800250 if (bsc_endp->transaction_id) {
251 LOGP(DMGCP, LOGL_ERROR, "Endpoint 0x%x had pending transaction: '%s'\n",
252 endpoint, bsc_endp->transaction_id);
253 talloc_free(bsc_endp->transaction_id);
254 bsc_endp->transaction_id = NULL;
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800255 bsc_endp->transaction_state = 0;
Holger Hans Peter Freytherfef76122010-04-24 21:05:18 +0800256 }
257 bsc_endp->bsc = NULL;
258
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800259 sccp = bsc_mgcp_find_con(nat, endpoint);
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200260
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800261 if (!sccp) {
Holger Hans Peter Freyther3d194d92010-04-24 21:02:01 +0800262 LOGP(DMGCP, LOGL_ERROR, "Did not find BSC for change on endpoint: 0x%x state: %d\n", endpoint, state);
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200263
264 switch (state) {
265 case MGCP_ENDP_CRCX:
266 return MGCP_POLICY_REJECT;
267 break;
268 case MGCP_ENDP_DLCX:
269 return MGCP_POLICY_CONT;
270 break;
271 case MGCP_ENDP_MDCX:
272 return MGCP_POLICY_CONT;
273 break;
274 default:
275 LOGP(DMGCP, LOGL_FATAL, "Unhandled state: %d\n", state);
276 return MGCP_POLICY_CONT;
277 break;
278 }
279 }
280
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200281 /* we need to generate a new and patched message */
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800282 bsc_msg = bsc_mgcp_rewrite((char *) nat->mgcp_msg, nat->mgcp_length, sccp->bsc_endp,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800283 nat->mgcp_cfg->source_addr, mgcp_endp->bts_end.local_port);
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200284 if (!bsc_msg) {
285 LOGP(DMGCP, LOGL_ERROR, "Failed to patch the msg.\n");
286 return MGCP_POLICY_CONT;
287 }
288
289
Holger Hans Peter Freytherb3e0a032010-04-04 18:11:49 +0200290 bsc_endp->transaction_id = talloc_strdup(nat, transaction_id);
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800291 bsc_endp->transaction_state = state;
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800292 bsc_endp->bsc = sccp->bsc;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200293
294 /* we need to update some bits */
295 if (state == MGCP_ENDP_CRCX) {
296 struct sockaddr_in sock;
297 socklen_t len = sizeof(sock);
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800298 if (getpeername(sccp->bsc->write_queue.bfd.fd, (struct sockaddr *) &sock, &len) != 0) {
Holger Hans Peter Freyther92febd32010-04-06 11:17:07 +0200299 LOGP(DMGCP, LOGL_ERROR, "Can not get the peername...%d/%s\n",
300 errno, strerror(errno));
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200301 } else {
Holger Hans Peter Freythera17d7012010-08-05 01:34:51 +0800302 mgcp_endp->bts_end.addr = sock.sin_addr;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200303 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200304
Holger Hans Peter Freythere66cac32010-08-05 01:50:44 +0800305 /* send the message and a fake MDCX to force sending of a dummy packet */
Holger Hans Peter Freyther19c530c2010-10-13 23:52:01 +0200306 bsc_write(sccp->bsc, bsc_msg, IPAC_PROTO_MGCP);
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800307 bsc_mgcp_send_mdcx(sccp->bsc, sccp->bsc_endp, mgcp_endp);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800308 return MGCP_POLICY_DEFER;
309 } else if (state == MGCP_ENDP_DLCX) {
310 /* we will free the endpoint now and send a DLCX to the BSC */
Holger Hans Peter Freyther3a347f02010-05-01 10:31:53 +0800311 msgb_free(bsc_msg);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800312 bsc_mgcp_dlcx(sccp);
313 return MGCP_POLICY_CONT;
314 } else {
Holger Hans Peter Freyther19c530c2010-10-13 23:52:01 +0200315 bsc_write(sccp->bsc, bsc_msg, IPAC_PROTO_MGCP);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800316 return MGCP_POLICY_DEFER;
317 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200318}
319
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200320/*
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800321 * We do have a failure, free data downstream..
322 */
323static void free_chan_downstream(struct mgcp_endpoint *endp, struct bsc_endpoint *bsc_endp,
324 struct bsc_connection *bsc)
325{
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800326 LOGP(DMGCP, LOGL_ERROR, "No CI, freeing endpoint 0x%x in state %d\n",
327 ENDPOINT_NUMBER(endp), bsc_endp->transaction_state);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800328
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800329 /* if a CRCX failed... send a DLCX down the stream */
330 if (bsc_endp->transaction_state == MGCP_ENDP_CRCX) {
331 struct sccp_connections *con;
332 con = bsc_mgcp_find_con(bsc->nat, ENDPOINT_NUMBER(endp));
333 if (!con) {
334 LOGP(DMGCP, LOGL_ERROR,
335 "No SCCP connection for endp 0x%x\n",
336 ENDPOINT_NUMBER(endp));
337 } else {
338 if (con->bsc == bsc) {
Holger Hans Peter Freyther8574dcf2010-08-29 22:39:07 +0800339 bsc_mgcp_send_dlcx(bsc, con->bsc_endp);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800340 } else {
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800341 LOGP(DMGCP, LOGL_ERROR,
342 "Endpoint belongs to a different BSC\n");
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800343 }
344 }
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800345 }
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800346
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800347 bsc_mgcp_free_endpoint(bsc->nat, ENDPOINT_NUMBER(endp));
348 mgcp_free_endp(endp);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800349}
350
351/*
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200352 * We have received a msg from the BSC. We will see if we know
353 * this transaction and if it belongs to the BSC. Then we will
354 * need to patch the content to point to the local network and we
355 * need to update the I: that was assigned by the BSS.
356 */
357void bsc_mgcp_forward(struct bsc_connection *bsc, struct msgb *msg)
358{
359 struct msgb *output;
360 struct bsc_endpoint *bsc_endp = NULL;
361 struct mgcp_endpoint *endp = NULL;
Holger Hans Peter Freytherd2dd6e82010-04-06 11:06:11 +0200362 int i, code;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200363 char transaction_id[60];
364
365 /* Some assumption that our buffer is big enough.. and null terminate */
366 if (msgb_l2len(msg) > 2000) {
367 LOGP(DMGCP, LOGL_ERROR, "MGCP message too long.\n");
368 return;
369 }
370
371 msg->l2h[msgb_l2len(msg)] = '\0';
372
373 if (bsc_mgcp_parse_response((const char *) msg->l2h, &code, transaction_id) != 0) {
374 LOGP(DMGCP, LOGL_ERROR, "Failed to parse response code.\n");
375 return;
376 }
377
378 for (i = 1; i < bsc->nat->mgcp_cfg->number_endpoints; ++i) {
379 if (bsc->nat->bsc_endpoints[i].bsc != bsc)
380 continue;
Holger Hans Peter Freyther3f7c7d02010-04-05 18:00:05 +0200381 /* no one listening? a bug? */
382 if (!bsc->nat->bsc_endpoints[i].transaction_id)
383 continue;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200384 if (strcmp(transaction_id, bsc->nat->bsc_endpoints[i].transaction_id) != 0)
385 continue;
386
387 endp = &bsc->nat->mgcp_cfg->endpoints[i];
388 bsc_endp = &bsc->nat->bsc_endpoints[i];
389 break;
390 }
391
392 if (!bsc_endp) {
Holger Hans Peter Freytherb9ac37d2010-04-05 17:58:52 +0200393 LOGP(DMGCP, LOGL_ERROR, "Could not find active endpoint: %s for msg: '%s'\n",
394 transaction_id, (const char *) msg->l2h);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200395 return;
396 }
397
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800398 endp->ci = bsc_mgcp_extract_ci((const char *) msg->l2h);
Holger Hans Peter Freytherb84b5f62010-08-06 08:34:46 +0800399 if (endp->ci == CI_UNUSED) {
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800400 free_chan_downstream(endp, bsc_endp, bsc);
Holger Hans Peter Freytherb84b5f62010-08-06 08:34:46 +0800401 return;
402 }
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200403
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200404 /* free some stuff */
405 talloc_free(bsc_endp->transaction_id);
406 bsc_endp->transaction_id = NULL;
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800407 bsc_endp->transaction_state = 0;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200408
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200409 /*
410 * rewrite the information. In case the endpoint was deleted
411 * there should be nothing for us to rewrite so putting endp->rtp_port
412 * with the value of 0 should be no problem.
413 */
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800414 output = bsc_mgcp_rewrite((char * ) msg->l2h, msgb_l2len(msg), -1,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800415 bsc->nat->mgcp_cfg->source_addr, endp->net_end.local_port);
Holger Hans Peter Freyther5cc94fb2010-04-05 22:56:49 +0200416
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200417 if (!output) {
418 LOGP(DMGCP, LOGL_ERROR, "Failed to rewrite MGCP msg.\n");
419 return;
420 }
421
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800422 if (write_queue_enqueue(&bsc->nat->mgcp_cfg->gw_fd, output) != 0) {
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200423 LOGP(DMGCP, LOGL_ERROR, "Failed to queue MGCP msg.\n");
424 msgb_free(output);
425 }
426}
427
428int bsc_mgcp_parse_response(const char *str, int *code, char transaction[60])
429{
430 /* we want to parse two strings */
431 return sscanf(str, "%3d %59s\n", code, transaction) != 2;
432}
433
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800434uint32_t bsc_mgcp_extract_ci(const char *str)
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200435{
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800436 unsigned int ci;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200437 char *res = strstr(str, "I: ");
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800438 if (!res) {
439 LOGP(DMGCP, LOGL_ERROR, "No CI in msg '%s'\n", str);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200440 return CI_UNUSED;
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800441 }
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200442
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800443 if (sscanf(res, "I: %u", &ci) != 1) {
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800444 LOGP(DMGCP, LOGL_ERROR, "Failed to parse CI in msg '%s'\n", str);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200445 return CI_UNUSED;
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800446 }
447
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200448 return ci;
449}
450
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800451static void patch_mgcp(struct msgb *output, const char *op, const char *tok,
452 int endp, int len, int cr)
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200453{
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800454 int slen;
455 int ret;
456 char buf[40];
457
458 buf[0] = buf[39] = '\0';
459 ret = sscanf(tok, "%*s %s", buf);
460
461 slen = sprintf((char *) output->l3h, "%s %s %x@mgw MGCP 1.0%s",
462 op, buf, endp, cr ? "\r\n" : "\n");
463 output->l3h = msgb_put(output, slen);
464}
465
466/* we need to replace some strings... */
467struct msgb *bsc_mgcp_rewrite(char *input, int length, int endpoint, const char *ip, int port)
468{
469 static const char *crcx_str = "CRCX ";
470 static const char *dlcx_str = "DLCX ";
471 static const char *mdcx_str = "MDCX ";
472
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200473 static const char *ip_str = "c=IN IP4 ";
474 static const char *aud_str = "m=audio ";
475
476 char buf[128];
477 char *running, *token;
478 struct msgb *output;
479
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200480 if (length > 4096 - 128) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200481 LOGP(DMGCP, LOGL_ERROR, "Input is too long.\n");
482 return NULL;
483 }
484
485 output = msgb_alloc_headroom(4096, 128, "MGCP rewritten");
486 if (!output) {
487 LOGP(DMGCP, LOGL_ERROR, "Failed to allocate new MGCP msg.\n");
488 return NULL;
489 }
490
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200491 running = input;
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200492 output->l2h = output->data;
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800493 output->l3h = output->l2h;
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200494 for (token = strsep(&running, "\n"); running; token = strsep(&running, "\n")) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200495 int len = strlen(token);
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200496 int cr = len > 0 && token[len - 1] == '\r';
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200497
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800498 if (strncmp(crcx_str, token, (sizeof crcx_str) - 1) == 0) {
499 patch_mgcp(output, "CRCX", token, endpoint, len, cr);
500 } else if (strncmp(dlcx_str, token, (sizeof dlcx_str) - 1) == 0) {
501 patch_mgcp(output, "DLCX", token, endpoint, len, cr);
502 } else if (strncmp(mdcx_str, token, (sizeof mdcx_str) - 1) == 0) {
503 patch_mgcp(output, "MDCX", token, endpoint, len, cr);
504 } else if (strncmp(ip_str, token, (sizeof ip_str) - 1) == 0) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200505 output->l3h = msgb_put(output, strlen(ip_str));
506 memcpy(output->l3h, ip_str, strlen(ip_str));
507 output->l3h = msgb_put(output, strlen(ip));
508 memcpy(output->l3h, ip, strlen(ip));
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200509
510 if (cr) {
511 output->l3h = msgb_put(output, 2);
512 output->l3h[0] = '\r';
513 output->l3h[1] = '\n';
514 } else {
515 output->l3h = msgb_put(output, 1);
516 output->l3h[0] = '\n';
517 }
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200518 } else if (strncmp(aud_str, token, (sizeof aud_str) - 1) == 0) {
519 int payload;
520 if (sscanf(token, "m=audio %*d RTP/AVP %d", &payload) != 1) {
521 LOGP(DMGCP, LOGL_ERROR, "Could not parsed audio line.\n");
522 msgb_free(output);
523 return NULL;
524 }
525
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200526 snprintf(buf, sizeof(buf)-1, "m=audio %d RTP/AVP %d%s",
527 port, payload, cr ? "\r\n" : "\n");
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200528 buf[sizeof(buf)-1] = '\0';
529
530 output->l3h = msgb_put(output, strlen(buf));
531 memcpy(output->l3h, buf, strlen(buf));
532 } else {
533 output->l3h = msgb_put(output, len + 1);
534 memcpy(output->l3h, token, len);
535 output->l3h[len] = '\n';
536 }
537 }
538
539 return output;
540}
541
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200542static int mgcp_do_read(struct bsc_fd *fd)
543{
544 struct bsc_nat *nat;
545 struct msgb *msg, *resp;
546 int rc;
547
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200548 nat = fd->data;
549
550 rc = read(fd->fd, nat->mgcp_msg, sizeof(nat->mgcp_msg) - 1);
551 if (rc <= 0) {
552 LOGP(DMGCP, LOGL_ERROR, "Failed to read errno: %d\n", errno);
553 return -1;
554 }
555
556 nat->mgcp_msg[rc] = '\0';
557 nat->mgcp_length = rc;
558
559 msg = msgb_alloc(sizeof(nat->mgcp_msg), "MGCP GW Read");
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200560 if (!msg) {
561 LOGP(DMGCP, LOGL_ERROR, "Failed to create buffer.\n");
562 return -1;
563 }
564
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200565 msg->l2h = msgb_put(msg, rc);
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200566 memcpy(msg->l2h, nat->mgcp_msg, msgb_l2len(msg));
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200567 resp = mgcp_handle_message(nat->mgcp_cfg, msg);
568 msgb_free(msg);
569
570 /* we do have a direct answer... e.g. AUEP */
571 if (resp) {
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800572 if (write_queue_enqueue(&nat->mgcp_cfg->gw_fd, resp) != 0) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200573 LOGP(DMGCP, LOGL_ERROR, "Failed to enqueue msg.\n");
574 msgb_free(resp);
575 }
576 }
577
578 return 0;
579}
580
581static int mgcp_do_write(struct bsc_fd *bfd, struct msgb *msg)
582{
583 int rc;
584
585 rc = write(bfd->fd, msg->data, msg->len);
586
587 if (rc != msg->len) {
588 LOGP(DMGCP, LOGL_ERROR, "Failed to write msg to MGCP CallAgent.\n");
589 return -1;
590 }
591
592 return rc;
593}
594
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800595int bsc_mgcp_nat_init(struct bsc_nat *nat)
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200596{
597 int on;
598 struct sockaddr_in addr;
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800599 struct mgcp_config *cfg = nat->mgcp_cfg;
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200600
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800601 if (!cfg->call_agent_addr) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200602 LOGP(DMGCP, LOGL_ERROR, "The BSC nat requires the call agent ip to be set.\n");
603 return -1;
604 }
605
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800606 if (cfg->bts_ip) {
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200607 LOGP(DMGCP, LOGL_ERROR, "Do not set the BTS ip for the nat.\n");
608 return -1;
609 }
610
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800611 cfg->gw_fd.bfd.fd = socket(AF_INET, SOCK_DGRAM, 0);
612 if (cfg->gw_fd.bfd.fd < 0) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200613 LOGP(DMGCP, LOGL_ERROR, "Failed to create MGCP socket. errno: %d\n", errno);
614 return -1;
615 }
616
617 on = 1;
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800618 setsockopt(cfg->gw_fd.bfd.fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200619
620 addr.sin_family = AF_INET;
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800621 addr.sin_port = htons(cfg->source_port);
622 inet_aton(cfg->source_addr, &addr.sin_addr);
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200623
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800624 if (bind(cfg->gw_fd.bfd.fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200625 LOGP(DMGCP, LOGL_ERROR, "Failed to bind. errno: %d\n", errno);
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800626 close(cfg->gw_fd.bfd.fd);
627 cfg->gw_fd.bfd.fd = -1;
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200628 return -1;
629 }
630
631 addr.sin_port = htons(2727);
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800632 inet_aton(cfg->call_agent_addr, &addr.sin_addr);
633 if (connect(cfg->gw_fd.bfd.fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200634 LOGP(DMGCP, LOGL_ERROR, "Failed to connect to: '%s'. errno: %d\n",
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800635 cfg->call_agent_addr, errno);
636 close(cfg->gw_fd.bfd.fd);
637 cfg->gw_fd.bfd.fd = -1;
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200638 return -1;
639 }
640
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800641 write_queue_init(&cfg->gw_fd, 10);
642 cfg->gw_fd.bfd.when = BSC_FD_READ;
643 cfg->gw_fd.bfd.data = nat;
644 cfg->gw_fd.read_cb = mgcp_do_read;
645 cfg->gw_fd.write_cb = mgcp_do_write;
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200646
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800647 if (bsc_register_fd(&cfg->gw_fd.bfd) != 0) {
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200648 LOGP(DMGCP, LOGL_ERROR, "Failed to register MGCP fd.\n");
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800649 close(cfg->gw_fd.bfd.fd);
650 cfg->gw_fd.bfd.fd = -1;
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200651 return -1;
652 }
653
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200654 /* some more MGCP config handling */
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800655 cfg->data = nat;
656 cfg->policy_cb = bsc_mgcp_policy_cb;
657 cfg->force_realloc = 1;
Holger Hans Peter Freytherd5e6c232010-08-05 10:08:36 +0000658
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800659 if (cfg->bts_ip)
660 talloc_free(cfg->bts_ip);
661 cfg->bts_ip = "";
Holger Hans Peter Freytherd5e6c232010-08-05 10:08:36 +0000662
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200663 nat->bsc_endpoints = talloc_zero_array(nat,
664 struct bsc_endpoint,
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800665 cfg->number_endpoints + 1);
Holger Hans Peter Freyther3c792142010-09-19 04:34:04 +0800666 if (!nat->bsc_endpoints) {
667 LOGP(DMGCP, LOGL_ERROR, "Failed to allocate nat endpoints\n");
Holger Hans Peter Freyther249d69a2010-09-18 21:13:54 +0800668 close(cfg->gw_fd.bfd.fd);
669 cfg->gw_fd.bfd.fd = -1;
Holger Hans Peter Freyther3c792142010-09-19 04:34:04 +0800670 return -1;
671 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200672
Holger Hans Peter Freytherf2eedff2010-09-19 04:36:07 +0800673 if (mgcp_reset_transcoder(cfg) < 0) {
674 LOGP(DMGCP, LOGL_ERROR, "Failed to send packet to the transcoder.\n");
675 talloc_free(nat->bsc_endpoints);
676 nat->bsc_endpoints = NULL;
677 close(cfg->gw_fd.bfd.fd);
678 cfg->gw_fd.bfd.fd = -1;
679 return -1;
680 }
681
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200682 return 0;
683}
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200684
685void bsc_mgcp_clear_endpoints_for(struct bsc_connection *bsc)
686{
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800687 struct rate_ctr *ctr = NULL;
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200688 int i;
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800689
690 if (bsc->cfg)
691 ctr = &bsc->cfg->stats.ctrg->ctr[BCFG_CTR_DROPPED_CALLS];
692
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200693 for (i = 1; i < bsc->nat->mgcp_cfg->number_endpoints; ++i) {
694 struct bsc_endpoint *bsc_endp = &bsc->nat->bsc_endpoints[i];
695
696 if (bsc_endp->bsc != bsc)
697 continue;
698
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800699 if (ctr)
700 rate_ctr_inc(ctr);
701
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800702 bsc_mgcp_free_endpoint(bsc->nat, i);
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200703 mgcp_free_endp(&bsc->nat->mgcp_cfg->endpoints[i]);
704 }
705}