blob: db0fb743b940a002cec1d8acd965ee2fe2a3f2f6 [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
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (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
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 *
20 */
21
22#include <openbsc/bsc_nat.h>
Holger Hans Peter Freytherc2b31ed2010-07-31 05:17:17 +080023#include <openbsc/bsc_nat_sccp.h>
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080024#include <openbsc/gsm_data.h>
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +080025#include <openbsc/debug.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 Freytherf4b34392010-08-28 16:08:39 +080077 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
102 /* find stale connections using that endpoint */
103 llist_for_each_entry(mcon, &con->bsc->nat->sccp_connections, list_entry) {
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800104 if (mcon->msc_endp == endp) {
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800105 LOGP(DNAT, LOGL_ERROR,
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800106 "Endpoint %d was assigned to 0x%x and now 0x%x\n",
107 endp,
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800108 sccp_src_ref_to_int(&mcon->patched_ref),
109 sccp_src_ref_to_int(&con->patched_ref));
110 bsc_mgcp_dlcx(mcon);
111 }
112 }
113
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800114 con->msc_endp = endp;
Holger Hans Peter Freyther45fd07d2010-08-28 18:22:14 +0800115 if (bsc_assign_endpoint(con->bsc, con) != 0)
116 return -1;
117
118 /*
119 * now patch the message for the new CIC...
120 * still assumed to be one multiplex only
121 */
122 cic = htons(create_cic(con->bsc_endp));
123 memcpy((uint8_t *) TLVP_VAL(&tp, GSM0808_IE_CIRCUIT_IDENTITY_CODE),
124 &cic, sizeof(cic));
125
Holger Hans Peter Freyther465313e2010-06-15 18:49:53 +0800126 return 0;
127}
128
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800129static void bsc_mgcp_free_endpoint(struct bsc_nat *nat, int i)
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200130{
131 if (nat->bsc_endpoints[i].transaction_id) {
132 talloc_free(nat->bsc_endpoints[i].transaction_id);
133 nat->bsc_endpoints[i].transaction_id = NULL;
134 }
135
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800136 nat->bsc_endpoints[i].transaction_state = 0;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200137 nat->bsc_endpoints[i].bsc = NULL;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200138}
139
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200140void bsc_mgcp_free_endpoints(struct bsc_nat *nat)
141{
142 int i;
143
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800144 for (i = 1; i < nat->mgcp_cfg->number_endpoints; ++i){
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200145 bsc_mgcp_free_endpoint(nat, i);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800146 mgcp_free_endp(&nat->mgcp_cfg->endpoints[i]);
147 }
Holger Hans Peter Freyther241e1302010-03-31 09:16:56 +0200148}
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200149
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800150/* send a MDCX where we do not want a response */
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800151static void bsc_mgcp_send_mdcx(struct bsc_connection *bsc, int port, struct mgcp_endpoint *endp)
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800152{
153 char buf[2096];
154 int len;
155
156 len = snprintf(buf, sizeof(buf),
Holger Hans Peter Freytherf42f45b2010-04-22 13:06:24 +0800157 "MDCX 23 %x@mgw MGCP 1.0\r\n"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800158 "Z: noanswer\r\n"
159 "\r\n"
160 "c=IN IP4 %s\r\n"
161 "m=audio %d RTP/AVP 255\r\n",
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800162 port,
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800163 bsc->nat->mgcp_cfg->source_addr,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800164 endp->bts_end.local_port);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800165 if (len < 0) {
166 LOGP(DMGCP, LOGL_ERROR, "snprintf for DLCX failed.\n");
167 return;
168 }
Holger Hans Peter Freytherd38aa452010-08-30 11:58:49 +0800169
170 #warning "The MDCX is not send to the BSC. It should"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800171}
172
173static void bsc_mgcp_send_dlcx(struct bsc_connection *bsc, int endpoint)
174{
175 char buf[2096];
176 int len;
177
178 len = snprintf(buf, sizeof(buf),
Holger Hans Peter Freytherbf812fa2010-08-30 12:01:36 +0800179 "DLCX 26 %x@mgw MGCP 1.0\r\n"
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800180 "Z: noanswer\r\n", endpoint);
181 if (len < 0) {
182 LOGP(DMGCP, LOGL_ERROR, "snprintf for DLCX failed.\n");
183 return;
184 }
185
Holger Hans Peter Freytherdbd16fe2010-07-23 19:08:55 +0800186 bsc_write_mgcp(bsc, (uint8_t *) buf, len);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800187}
188
189void bsc_mgcp_init(struct sccp_connections *con)
190{
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800191 con->msc_endp = -1;
192 con->bsc_endp = -1;
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800193}
194
195void bsc_mgcp_dlcx(struct sccp_connections *con)
196{
197 /* send a DLCX down the stream */
Holger Hans Peter Freyther39cd32e2010-08-28 18:11:07 +0800198 if (con->bsc_endp != -1) {
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800199 if (con->bsc->endpoint_status[con->bsc_endp] != 1)
200 LOGP(DNAT, LOGL_ERROR, "Endpoint 0x%x was not in use\n", con->bsc_endp);
201 con->bsc->endpoint_status[con->bsc_endp] = 0;
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800202 bsc_mgcp_send_dlcx(con->bsc, con->bsc_endp);
203 bsc_mgcp_free_endpoint(con->bsc->nat, con->msc_endp);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800204 }
205
206 bsc_mgcp_init(con);
207}
208
209
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800210struct sccp_connections *bsc_mgcp_find_con(struct bsc_nat *nat, int endpoint)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200211{
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800212 struct sccp_connections *con = NULL;
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200213 struct sccp_connections *sccp;
214
215 llist_for_each_entry(sccp, &nat->sccp_connections, list_entry) {
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800216 if (sccp->msc_endp == -1)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200217 continue;
Holger Hans Peter Freytherf4b34392010-08-28 16:08:39 +0800218 if (sccp->msc_endp != endpoint)
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200219 continue;
220
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800221 con = sccp;
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200222 }
223
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800224 if (con)
225 return con;
Holger Hans Peter Freythereb52e892010-04-18 02:14:45 +0800226
Holger Hans Peter Freytherfc9bd232010-04-01 03:55:27 +0200227 LOGP(DMGCP, LOGL_ERROR, "Failed to find the connection.\n");
228 return NULL;
229}
230
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200231int bsc_mgcp_policy_cb(struct mgcp_config *cfg, int endpoint, int state, const char *transaction_id)
232{
233 struct bsc_nat *nat;
234 struct bsc_endpoint *bsc_endp;
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800235 struct sccp_connections *sccp;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200236 struct mgcp_endpoint *mgcp_endp;
237 struct msgb *bsc_msg;
238
239 nat = cfg->data;
240 bsc_endp = &nat->bsc_endpoints[endpoint];
241 mgcp_endp = &nat->mgcp_cfg->endpoints[endpoint];
242
Holger Hans Peter Freytherfef76122010-04-24 21:05:18 +0800243 if (bsc_endp->transaction_id) {
244 LOGP(DMGCP, LOGL_ERROR, "Endpoint 0x%x had pending transaction: '%s'\n",
245 endpoint, bsc_endp->transaction_id);
246 talloc_free(bsc_endp->transaction_id);
247 bsc_endp->transaction_id = NULL;
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800248 bsc_endp->transaction_state = 0;
Holger Hans Peter Freytherfef76122010-04-24 21:05:18 +0800249 }
250 bsc_endp->bsc = NULL;
251
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800252 sccp = bsc_mgcp_find_con(nat, endpoint);
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200253
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800254 if (!sccp) {
Holger Hans Peter Freyther3d194d92010-04-24 21:02:01 +0800255 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 +0200256
257 switch (state) {
258 case MGCP_ENDP_CRCX:
259 return MGCP_POLICY_REJECT;
260 break;
261 case MGCP_ENDP_DLCX:
262 return MGCP_POLICY_CONT;
263 break;
264 case MGCP_ENDP_MDCX:
265 return MGCP_POLICY_CONT;
266 break;
267 default:
268 LOGP(DMGCP, LOGL_FATAL, "Unhandled state: %d\n", state);
269 return MGCP_POLICY_CONT;
270 break;
271 }
272 }
273
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200274 /* we need to generate a new and patched message */
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800275 bsc_msg = bsc_mgcp_rewrite((char *) nat->mgcp_msg, nat->mgcp_length, sccp->bsc_endp,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800276 nat->mgcp_cfg->source_addr, mgcp_endp->bts_end.local_port);
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200277 if (!bsc_msg) {
278 LOGP(DMGCP, LOGL_ERROR, "Failed to patch the msg.\n");
279 return MGCP_POLICY_CONT;
280 }
281
282
Holger Hans Peter Freytherb3e0a032010-04-04 18:11:49 +0200283 bsc_endp->transaction_id = talloc_strdup(nat, transaction_id);
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800284 bsc_endp->transaction_state = state;
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800285 bsc_endp->bsc = sccp->bsc;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200286
287 /* we need to update some bits */
288 if (state == MGCP_ENDP_CRCX) {
289 struct sockaddr_in sock;
290 socklen_t len = sizeof(sock);
Holger Hans Peter Freyther08a1b162010-04-18 02:26:16 +0800291 if (getpeername(sccp->bsc->write_queue.bfd.fd, (struct sockaddr *) &sock, &len) != 0) {
Holger Hans Peter Freyther92febd32010-04-06 11:17:07 +0200292 LOGP(DMGCP, LOGL_ERROR, "Can not get the peername...%d/%s\n",
293 errno, strerror(errno));
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200294 } else {
Holger Hans Peter Freythera17d7012010-08-05 01:34:51 +0800295 mgcp_endp->bts_end.addr = sock.sin_addr;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200296 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200297
Holger Hans Peter Freythere66cac32010-08-05 01:50:44 +0800298 /* send the message and a fake MDCX to force sending of a dummy packet */
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800299 bsc_write(sccp->bsc, bsc_msg, NAT_IPAC_PROTO_MGCP);
Holger Hans Peter Freyther601180f2010-08-29 23:40:33 +0800300 bsc_mgcp_send_mdcx(sccp->bsc, sccp->bsc_endp, mgcp_endp);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800301 return MGCP_POLICY_DEFER;
302 } else if (state == MGCP_ENDP_DLCX) {
303 /* we will free the endpoint now and send a DLCX to the BSC */
Holger Hans Peter Freyther3a347f02010-05-01 10:31:53 +0800304 msgb_free(bsc_msg);
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800305 bsc_mgcp_dlcx(sccp);
306 return MGCP_POLICY_CONT;
307 } else {
308 bsc_write(sccp->bsc, bsc_msg, NAT_IPAC_PROTO_MGCP);
309 return MGCP_POLICY_DEFER;
310 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200311}
312
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200313/*
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800314 * We do have a failure, free data downstream..
315 */
316static void free_chan_downstream(struct mgcp_endpoint *endp, struct bsc_endpoint *bsc_endp,
317 struct bsc_connection *bsc)
318{
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800319 LOGP(DMGCP, LOGL_ERROR, "No CI, freeing endpoint 0x%x in state %d\n",
320 ENDPOINT_NUMBER(endp), bsc_endp->transaction_state);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800321
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800322 /* if a CRCX failed... send a DLCX down the stream */
323 if (bsc_endp->transaction_state == MGCP_ENDP_CRCX) {
324 struct sccp_connections *con;
325 con = bsc_mgcp_find_con(bsc->nat, ENDPOINT_NUMBER(endp));
326 if (!con) {
327 LOGP(DMGCP, LOGL_ERROR,
328 "No SCCP connection for endp 0x%x\n",
329 ENDPOINT_NUMBER(endp));
330 } else {
331 if (con->bsc == bsc) {
Holger Hans Peter Freyther8574dcf2010-08-29 22:39:07 +0800332 bsc_mgcp_send_dlcx(bsc, con->bsc_endp);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800333 } else {
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800334 LOGP(DMGCP, LOGL_ERROR,
335 "Endpoint belongs to a different BSC\n");
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800336 }
337 }
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800338 }
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800339
Holger Hans Peter Freytherc021fbe2010-08-28 16:46:27 +0800340 bsc_mgcp_free_endpoint(bsc->nat, ENDPOINT_NUMBER(endp));
341 mgcp_free_endp(endp);
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800342}
343
344/*
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200345 * We have received a msg from the BSC. We will see if we know
346 * this transaction and if it belongs to the BSC. Then we will
347 * need to patch the content to point to the local network and we
348 * need to update the I: that was assigned by the BSS.
349 */
350void bsc_mgcp_forward(struct bsc_connection *bsc, struct msgb *msg)
351{
352 struct msgb *output;
353 struct bsc_endpoint *bsc_endp = NULL;
354 struct mgcp_endpoint *endp = NULL;
Holger Hans Peter Freytherd2dd6e82010-04-06 11:06:11 +0200355 int i, code;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200356 char transaction_id[60];
357
358 /* Some assumption that our buffer is big enough.. and null terminate */
359 if (msgb_l2len(msg) > 2000) {
360 LOGP(DMGCP, LOGL_ERROR, "MGCP message too long.\n");
361 return;
362 }
363
364 msg->l2h[msgb_l2len(msg)] = '\0';
365
366 if (bsc_mgcp_parse_response((const char *) msg->l2h, &code, transaction_id) != 0) {
367 LOGP(DMGCP, LOGL_ERROR, "Failed to parse response code.\n");
368 return;
369 }
370
371 for (i = 1; i < bsc->nat->mgcp_cfg->number_endpoints; ++i) {
372 if (bsc->nat->bsc_endpoints[i].bsc != bsc)
373 continue;
Holger Hans Peter Freyther3f7c7d02010-04-05 18:00:05 +0200374 /* no one listening? a bug? */
375 if (!bsc->nat->bsc_endpoints[i].transaction_id)
376 continue;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200377 if (strcmp(transaction_id, bsc->nat->bsc_endpoints[i].transaction_id) != 0)
378 continue;
379
380 endp = &bsc->nat->mgcp_cfg->endpoints[i];
381 bsc_endp = &bsc->nat->bsc_endpoints[i];
382 break;
383 }
384
385 if (!bsc_endp) {
Holger Hans Peter Freytherb9ac37d2010-04-05 17:58:52 +0200386 LOGP(DMGCP, LOGL_ERROR, "Could not find active endpoint: %s for msg: '%s'\n",
387 transaction_id, (const char *) msg->l2h);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200388 return;
389 }
390
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800391 endp->ci = bsc_mgcp_extract_ci((const char *) msg->l2h);
Holger Hans Peter Freytherb84b5f62010-08-06 08:34:46 +0800392 if (endp->ci == CI_UNUSED) {
Holger Hans Peter Freyther7d476012010-08-06 19:16:34 +0800393 free_chan_downstream(endp, bsc_endp, bsc);
Holger Hans Peter Freytherb84b5f62010-08-06 08:34:46 +0800394 return;
395 }
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200396
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200397 /* free some stuff */
398 talloc_free(bsc_endp->transaction_id);
399 bsc_endp->transaction_id = NULL;
Holger Hans Peter Freyther5b2726e2010-08-06 09:05:05 +0800400 bsc_endp->transaction_state = 0;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200401
Holger Hans Peter Freytherdd16b422010-04-07 09:53:54 +0200402 /*
403 * rewrite the information. In case the endpoint was deleted
404 * there should be nothing for us to rewrite so putting endp->rtp_port
405 * with the value of 0 should be no problem.
406 */
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800407 output = bsc_mgcp_rewrite((char * ) msg->l2h, msgb_l2len(msg), -1,
Holger Hans Peter Freyther58ff2192010-08-05 03:08:35 +0800408 bsc->nat->mgcp_cfg->source_addr, endp->net_end.local_port);
Holger Hans Peter Freyther5cc94fb2010-04-05 22:56:49 +0200409
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200410 if (!output) {
411 LOGP(DMGCP, LOGL_ERROR, "Failed to rewrite MGCP msg.\n");
412 return;
413 }
414
415 if (write_queue_enqueue(&bsc->nat->mgcp_queue, output) != 0) {
416 LOGP(DMGCP, LOGL_ERROR, "Failed to queue MGCP msg.\n");
417 msgb_free(output);
418 }
419}
420
421int bsc_mgcp_parse_response(const char *str, int *code, char transaction[60])
422{
423 /* we want to parse two strings */
424 return sscanf(str, "%3d %59s\n", code, transaction) != 2;
425}
426
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800427uint32_t bsc_mgcp_extract_ci(const char *str)
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200428{
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800429 unsigned int ci;
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200430 char *res = strstr(str, "I: ");
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800431 if (!res) {
432 LOGP(DMGCP, LOGL_ERROR, "No CI in msg '%s'\n", str);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200433 return CI_UNUSED;
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800434 }
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200435
Holger Hans Peter Freyther46340132010-08-06 08:26:54 +0800436 if (sscanf(res, "I: %u", &ci) != 1) {
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800437 LOGP(DMGCP, LOGL_ERROR, "Failed to parse CI in msg '%s'\n", str);
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200438 return CI_UNUSED;
Holger Hans Peter Freyther9c31cfc2010-08-06 08:19:05 +0800439 }
440
Holger Hans Peter Freyther3c3bce12010-04-01 10:16:28 +0200441 return ci;
442}
443
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800444static void patch_mgcp(struct msgb *output, const char *op, const char *tok,
445 int endp, int len, int cr)
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200446{
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800447 int slen;
448 int ret;
449 char buf[40];
450
451 buf[0] = buf[39] = '\0';
452 ret = sscanf(tok, "%*s %s", buf);
453
454 slen = sprintf((char *) output->l3h, "%s %s %x@mgw MGCP 1.0%s",
455 op, buf, endp, cr ? "\r\n" : "\n");
456 output->l3h = msgb_put(output, slen);
457}
458
459/* we need to replace some strings... */
460struct msgb *bsc_mgcp_rewrite(char *input, int length, int endpoint, const char *ip, int port)
461{
462 static const char *crcx_str = "CRCX ";
463 static const char *dlcx_str = "DLCX ";
464 static const char *mdcx_str = "MDCX ";
465
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200466 static const char *ip_str = "c=IN IP4 ";
467 static const char *aud_str = "m=audio ";
468
469 char buf[128];
470 char *running, *token;
471 struct msgb *output;
472
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200473 if (length > 4096 - 128) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200474 LOGP(DMGCP, LOGL_ERROR, "Input is too long.\n");
475 return NULL;
476 }
477
478 output = msgb_alloc_headroom(4096, 128, "MGCP rewritten");
479 if (!output) {
480 LOGP(DMGCP, LOGL_ERROR, "Failed to allocate new MGCP msg.\n");
481 return NULL;
482 }
483
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200484 running = input;
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200485 output->l2h = output->data;
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800486 output->l3h = output->l2h;
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200487 for (token = strsep(&running, "\n"); running; token = strsep(&running, "\n")) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200488 int len = strlen(token);
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200489 int cr = len > 0 && token[len - 1] == '\r';
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200490
Holger Hans Peter Freytherf7c86c52010-08-30 13:44:32 +0800491 if (strncmp(crcx_str, token, (sizeof crcx_str) - 1) == 0) {
492 patch_mgcp(output, "CRCX", token, endpoint, len, cr);
493 } else if (strncmp(dlcx_str, token, (sizeof dlcx_str) - 1) == 0) {
494 patch_mgcp(output, "DLCX", token, endpoint, len, cr);
495 } else if (strncmp(mdcx_str, token, (sizeof mdcx_str) - 1) == 0) {
496 patch_mgcp(output, "MDCX", token, endpoint, len, cr);
497 } else if (strncmp(ip_str, token, (sizeof ip_str) - 1) == 0) {
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200498 output->l3h = msgb_put(output, strlen(ip_str));
499 memcpy(output->l3h, ip_str, strlen(ip_str));
500 output->l3h = msgb_put(output, strlen(ip));
501 memcpy(output->l3h, ip, strlen(ip));
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200502
503 if (cr) {
504 output->l3h = msgb_put(output, 2);
505 output->l3h[0] = '\r';
506 output->l3h[1] = '\n';
507 } else {
508 output->l3h = msgb_put(output, 1);
509 output->l3h[0] = '\n';
510 }
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200511 } else if (strncmp(aud_str, token, (sizeof aud_str) - 1) == 0) {
512 int payload;
513 if (sscanf(token, "m=audio %*d RTP/AVP %d", &payload) != 1) {
514 LOGP(DMGCP, LOGL_ERROR, "Could not parsed audio line.\n");
515 msgb_free(output);
516 return NULL;
517 }
518
Holger Hans Peter Freyther9e5300a2010-04-04 19:34:44 +0200519 snprintf(buf, sizeof(buf)-1, "m=audio %d RTP/AVP %d%s",
520 port, payload, cr ? "\r\n" : "\n");
Holger Hans Peter Freyther76c83542010-04-01 06:48:52 +0200521 buf[sizeof(buf)-1] = '\0';
522
523 output->l3h = msgb_put(output, strlen(buf));
524 memcpy(output->l3h, buf, strlen(buf));
525 } else {
526 output->l3h = msgb_put(output, len + 1);
527 memcpy(output->l3h, token, len);
528 output->l3h[len] = '\n';
529 }
530 }
531
532 return output;
533}
534
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200535static int mgcp_do_read(struct bsc_fd *fd)
536{
537 struct bsc_nat *nat;
538 struct msgb *msg, *resp;
539 int rc;
540
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200541 nat = fd->data;
542
543 rc = read(fd->fd, nat->mgcp_msg, sizeof(nat->mgcp_msg) - 1);
544 if (rc <= 0) {
545 LOGP(DMGCP, LOGL_ERROR, "Failed to read errno: %d\n", errno);
546 return -1;
547 }
548
549 nat->mgcp_msg[rc] = '\0';
550 nat->mgcp_length = rc;
551
552 msg = msgb_alloc(sizeof(nat->mgcp_msg), "MGCP GW Read");
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200553 if (!msg) {
554 LOGP(DMGCP, LOGL_ERROR, "Failed to create buffer.\n");
555 return -1;
556 }
557
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200558 msg->l2h = msgb_put(msg, rc);
Holger Hans Peter Freyther8d200652010-04-04 18:09:10 +0200559 memcpy(msg->l2h, nat->mgcp_msg, msgb_l2len(msg));
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200560 resp = mgcp_handle_message(nat->mgcp_cfg, msg);
561 msgb_free(msg);
562
563 /* we do have a direct answer... e.g. AUEP */
564 if (resp) {
565 if (write_queue_enqueue(&nat->mgcp_queue, resp) != 0) {
566 LOGP(DMGCP, LOGL_ERROR, "Failed to enqueue msg.\n");
567 msgb_free(resp);
568 }
569 }
570
571 return 0;
572}
573
574static int mgcp_do_write(struct bsc_fd *bfd, struct msgb *msg)
575{
576 int rc;
577
578 rc = write(bfd->fd, msg->data, msg->len);
579
580 if (rc != msg->len) {
581 LOGP(DMGCP, LOGL_ERROR, "Failed to write msg to MGCP CallAgent.\n");
582 return -1;
583 }
584
585 return rc;
586}
587
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800588int bsc_mgcp_nat_init(struct bsc_nat *nat)
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200589{
590 int on;
591 struct sockaddr_in addr;
592
593 if (!nat->mgcp_cfg->call_agent_addr) {
594 LOGP(DMGCP, LOGL_ERROR, "The BSC nat requires the call agent ip to be set.\n");
595 return -1;
596 }
597
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200598 if (nat->mgcp_cfg->bts_ip) {
599 LOGP(DMGCP, LOGL_ERROR, "Do not set the BTS ip for the nat.\n");
600 return -1;
601 }
602
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200603 nat->mgcp_queue.bfd.fd = socket(AF_INET, SOCK_DGRAM, 0);
604 if (nat->mgcp_queue.bfd.fd < 0) {
605 LOGP(DMGCP, LOGL_ERROR, "Failed to create MGCP socket. errno: %d\n", errno);
606 return -1;
607 }
608
609 on = 1;
610 setsockopt(nat->mgcp_queue.bfd.fd, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on));
611
612 addr.sin_family = AF_INET;
613 addr.sin_port = htons(nat->mgcp_cfg->source_port);
614 inet_aton(nat->mgcp_cfg->source_addr, &addr.sin_addr);
615
616 if (bind(nat->mgcp_queue.bfd.fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
617 LOGP(DMGCP, LOGL_ERROR, "Failed to bind. errno: %d\n", errno);
618 close(nat->mgcp_queue.bfd.fd);
619 nat->mgcp_queue.bfd.fd = -1;
620 return -1;
621 }
622
623 addr.sin_port = htons(2727);
624 inet_aton(nat->mgcp_cfg->call_agent_addr, &addr.sin_addr);
625 if (connect(nat->mgcp_queue.bfd.fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
626 LOGP(DMGCP, LOGL_ERROR, "Failed to connect to: '%s'. errno: %d\n",
627 nat->mgcp_cfg->call_agent_addr, errno);
628 close(nat->mgcp_queue.bfd.fd);
629 nat->mgcp_queue.bfd.fd = -1;
630 return -1;
631 }
632
633 write_queue_init(&nat->mgcp_queue, 10);
634 nat->mgcp_queue.bfd.when = BSC_FD_READ;
635 nat->mgcp_queue.bfd.data = nat;
636 nat->mgcp_queue.read_cb = mgcp_do_read;
637 nat->mgcp_queue.write_cb = mgcp_do_write;
638
639 if (bsc_register_fd(&nat->mgcp_queue.bfd) != 0) {
640 LOGP(DMGCP, LOGL_ERROR, "Failed to register MGCP fd.\n");
641 close(nat->mgcp_queue.bfd.fd);
642 nat->mgcp_queue.bfd.fd = -1;
643 return -1;
644 }
645
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200646 /* some more MGCP config handling */
Holger Hans Peter Freytherd5e6c232010-08-05 10:08:36 +0000647 if (nat->mgcp_cfg->audio_name)
648 talloc_free(nat->mgcp_cfg->audio_name);
649 nat->mgcp_cfg->audio_name = NULL;
650
Holger Hans Peter Freyther4ad58502010-04-06 11:14:03 +0200651 nat->mgcp_cfg->audio_payload = -1;
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200652 nat->mgcp_cfg->data = nat;
653 nat->mgcp_cfg->policy_cb = bsc_mgcp_policy_cb;
Holger Hans Peter Freytherbba59342010-04-07 10:52:48 +0200654 nat->mgcp_cfg->force_realloc = 1;
Holger Hans Peter Freytherd5e6c232010-08-05 10:08:36 +0000655
656 if (nat->mgcp_cfg->bts_ip)
657 talloc_free(nat->mgcp_cfg->bts_ip);
Holger Hans Peter Freyther290d84e2010-04-09 18:51:01 +0200658 nat->mgcp_cfg->bts_ip = "";
Holger Hans Peter Freytherd5e6c232010-08-05 10:08:36 +0000659
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200660 nat->bsc_endpoints = talloc_zero_array(nat,
661 struct bsc_endpoint,
662 nat->mgcp_cfg->number_endpoints + 1);
Holger Hans Peter Freyther3c792142010-09-19 04:34:04 +0800663 if (!nat->bsc_endpoints) {
664 LOGP(DMGCP, LOGL_ERROR, "Failed to allocate nat endpoints\n");
665 close(nat->mgcp_queue.bfd.fd);
666 nat->mgcp_queue.bfd.fd = -1;
667 return -1;
668 }
Holger Hans Peter Freythera0df82d2010-04-01 08:21:33 +0200669
Holger Hans Peter Freythera7f80182010-03-31 13:02:22 +0200670 return 0;
671}
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200672
673void bsc_mgcp_clear_endpoints_for(struct bsc_connection *bsc)
674{
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800675 struct rate_ctr *ctr = NULL;
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200676 int i;
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800677
678 if (bsc->cfg)
679 ctr = &bsc->cfg->stats.ctrg->ctr[BCFG_CTR_DROPPED_CALLS];
680
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200681 for (i = 1; i < bsc->nat->mgcp_cfg->number_endpoints; ++i) {
682 struct bsc_endpoint *bsc_endp = &bsc->nat->bsc_endpoints[i];
683
684 if (bsc_endp->bsc != bsc)
685 continue;
686
Holger Hans Peter Freyther8330c1c2010-06-17 18:29:42 +0800687 if (ctr)
688 rate_ctr_inc(ctr);
689
Holger Hans Peter Freyther7b7eef62010-04-22 12:08:17 +0800690 bsc_mgcp_free_endpoint(bsc->nat, i);
Holger Hans Peter Freyther26a43892010-04-05 23:09:27 +0200691 mgcp_free_endp(&bsc->nat->mgcp_cfg->endpoints[i]);
692 }
693}