Jacob Erlbeck | 497c2de | 2014-04-08 16:10:04 +0200 | [diff] [blame] | 1 | #include <stdlib.h> |
| 2 | #include <unistd.h> |
| 3 | #include <stdio.h> |
| 4 | #include <string.h> |
| 5 | #include <err.h> |
| 6 | |
| 7 | #include <osmocom/core/talloc.h> |
| 8 | #include <osmocom/core/application.h> |
| 9 | |
| 10 | #include <openbsc/debug.h> |
| 11 | #include <openbsc/gsm_data.h> |
| 12 | #include <openbsc/mgcp.h> |
| 13 | #include <openbsc/mgcp_internal.h> |
| 14 | |
| 15 | #include "bscconfig.h" |
| 16 | #ifndef BUILD_MGCP_TRANSCODING |
| 17 | #error "Requires MGCP transcoding enabled (see --enable-mgcp-transcoding)" |
| 18 | #endif |
| 19 | |
Jacob Erlbeck | 535173a | 2014-05-08 14:08:37 +0200 | [diff] [blame] | 20 | #include "openbsc/mgcp_transcode.h" |
Jacob Erlbeck | 497c2de | 2014-04-08 16:10:04 +0200 | [diff] [blame] | 21 | |
| 22 | uint8_t *audio_frame_l16[] = { |
| 23 | }; |
| 24 | |
| 25 | struct rtp_packets { |
| 26 | float t; |
| 27 | int len; |
| 28 | char *data; |
| 29 | }; |
| 30 | |
| 31 | struct rtp_packets audio_packets_l16[] = { |
| 32 | /* RTP: SeqNo=1, TS=160 */ |
| 33 | {0.020000, 332, |
| 34 | "\x80\x0B\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 35 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 36 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 37 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 38 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 39 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 40 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 41 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 42 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 43 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 44 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 45 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 46 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 47 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 48 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 49 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 50 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 51 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 52 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 53 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 54 | "\x00\x00\x40\x13\x5A\x9E\x40\x13\x00\x00\xBF\xED\xA5\x62\xBF\xED" |
| 55 | }, |
| 56 | }; |
| 57 | |
| 58 | struct rtp_packets audio_packets_gsm[] = { |
| 59 | /* RTP: SeqNo=1, TS=160 */ |
| 60 | {0.020000, 45, |
| 61 | "\x80\x03\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 62 | "\xD4\x7C\xE3\xE9\x62\x50\x39\xF0\xF8\xB4\x68\xEA\x6C\x0E\x81\x1B" |
| 63 | "\x56\x2A\xD5\xBC\x69\x9C\xD1\xF0\x66\x7A\xEC\x49\x7A\x33\x3D\x0A" |
| 64 | "\xDE" |
| 65 | }, |
| 66 | }; |
| 67 | |
| 68 | struct rtp_packets audio_packets_gsm_invalid_size[] = { |
| 69 | /* RTP: SeqNo=1, TS=160 */ |
| 70 | {0.020000, 41, |
| 71 | "\x80\x03\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 72 | "\xD4\x7C\xE3\xE9\x62\x50\x39\xF0\xF8\xB4\x68\xEA\x6C\x0E\x81\x1B" |
| 73 | "\x56\x2A\xD5\xBC\x69\x9C\xD1\xF0\x66\x7A\xEC\x49\x7A\x33\x3D\x0A" |
| 74 | "\xDE" |
| 75 | }, |
| 76 | }; |
| 77 | |
| 78 | struct rtp_packets audio_packets_gsm_invalid_data[] = { |
| 79 | /* RTP: SeqNo=1, TS=160 */ |
| 80 | {0.020000, 45, |
| 81 | "\x80\x03\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 82 | "\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE" |
| 83 | "\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE\xEE" |
| 84 | "\xEE" |
| 85 | }, |
| 86 | }; |
| 87 | |
| 88 | struct rtp_packets audio_packets_gsm_invalid_ptype[] = { |
| 89 | /* RTP: SeqNo=1, TS=160 */ |
| 90 | {0.020000, 45, |
| 91 | "\x80\x08\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 92 | "\xD4\x7C\xE3\xE9\x62\x50\x39\xF0\xF8\xB4\x68\xEA\x6C\x0E\x81\x1B" |
| 93 | "\x56\x2A\xD5\xBC\x69\x9C\xD1\xF0\x66\x7A\xEC\x49\x7A\x33\x3D\x0A" |
| 94 | "\xDE" |
| 95 | }, |
| 96 | }; |
| 97 | |
| 98 | struct rtp_packets audio_packets_g729[] = { |
| 99 | /* RTP: SeqNo=1, TS=160 */ |
| 100 | {0.020000, 32, |
| 101 | "\x80\x12\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 102 | "\xAF\xC2\x81\x40\x00\xFA\xCE\xA4\x21\x7C\xC5\xC3\x4F\xA5\x98\xF5" |
| 103 | "\xB2\x95\xC4\xAD" |
| 104 | }, |
| 105 | }; |
| 106 | |
| 107 | struct rtp_packets audio_packets_pcma[] = { |
| 108 | /* RTP: SeqNo=1, TS=160 */ |
| 109 | {0.020000, 172, |
| 110 | "\x80\x08\x00\x01\x00\x00\x00\xA0\x11\x22\x33\x44" |
| 111 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 112 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 113 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 114 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 115 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 116 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 117 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 118 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 119 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 120 | "\xD5\xA5\xA3\xA5\xD5\x25\x23\x25\xD5\xA5\xA3\xA5\xD5\x25\x23\x25" |
| 121 | }, |
| 122 | }; |
| 123 | |
| 124 | |
| 125 | |
| 126 | static int audio_name_to_type(const char *name) |
| 127 | { |
| 128 | if (!strcasecmp(name, "gsm")) |
| 129 | return 3; |
| 130 | #ifdef HAVE_BCG729 |
| 131 | else if (!strcasecmp(name, "g729")) |
| 132 | return 18; |
| 133 | #endif |
| 134 | else if (!strcasecmp(name, "pcma")) |
| 135 | return 8; |
| 136 | else if (!strcasecmp(name, "l16")) |
| 137 | return 11; |
| 138 | return -1; |
| 139 | } |
| 140 | |
| 141 | int mgcp_get_trans_frame_size(void *state_, int nsamples, int dst); |
| 142 | |
| 143 | static int transcode_test(const char *srcfmt, const char *dstfmt, |
| 144 | uint8_t *src_pkts, size_t src_pkt_size) |
| 145 | { |
| 146 | char buf[4096] = {0x80, 0}; |
| 147 | int rc; |
| 148 | struct mgcp_rtp_end *dst_end; |
| 149 | struct mgcp_rtp_end *src_end; |
| 150 | struct mgcp_trunk_config tcfg = {{0}}; |
| 151 | struct mgcp_endpoint endp = {0}; |
| 152 | struct mgcp_process_rtp_state *state; |
| 153 | int in_size; |
| 154 | int in_samples = 160; |
| 155 | int len, cont; |
| 156 | |
| 157 | printf("== Transcoding test ==\n"); |
| 158 | printf("converting %s -> %s\n", srcfmt, dstfmt); |
| 159 | |
| 160 | tcfg.endpoints = &endp; |
| 161 | tcfg.number_endpoints = 1; |
| 162 | endp.tcfg = &tcfg; |
| 163 | mgcp_free_endp(&endp); |
| 164 | |
| 165 | dst_end = &endp.bts_end; |
| 166 | src_end = &endp.net_end; |
| 167 | |
| 168 | src_end->payload_type = audio_name_to_type(srcfmt); |
| 169 | dst_end->payload_type = audio_name_to_type(dstfmt); |
| 170 | |
| 171 | rc = mgcp_transcoding_setup(&endp, dst_end, src_end); |
| 172 | if (rc < 0) |
| 173 | errx(1, "setup failed: %s", strerror(-rc)); |
| 174 | |
| 175 | state = dst_end->rtp_process_data; |
| 176 | OSMO_ASSERT(state != NULL); |
| 177 | |
| 178 | in_size = mgcp_transcoding_get_frame_size(state, in_samples, 0); |
| 179 | OSMO_ASSERT(sizeof(buf) >= in_size + 12); |
| 180 | |
| 181 | memcpy(buf, src_pkts, src_pkt_size); |
| 182 | |
| 183 | len = src_pkt_size; |
| 184 | |
| 185 | cont = mgcp_transcoding_process_rtp(&endp, dst_end, |
| 186 | buf, &len, sizeof(buf)); |
| 187 | if (cont < 0) |
| 188 | errx(1, "processing failed: %s", strerror(-cont)); |
| 189 | |
| 190 | if (len < 24) { |
| 191 | printf("encoded: %s\n", osmo_hexdump((unsigned char *)buf, len)); |
| 192 | } else { |
| 193 | const char *str = osmo_hexdump((unsigned char *)buf, len); |
| 194 | int i = 0; |
| 195 | const int prefix = 4; |
| 196 | const int cutlen = 48; |
| 197 | int nchars = 0; |
| 198 | |
| 199 | printf("encoded:\n"); |
| 200 | do { |
| 201 | nchars = printf("%*s%-.*s", prefix, "", cutlen, str + i); |
| 202 | i += nchars - prefix; |
| 203 | printf("\n"); |
| 204 | } while (nchars - prefix >= cutlen); |
| 205 | } |
| 206 | return 0; |
| 207 | } |
| 208 | |
| 209 | static int test_repacking(int in_samples, int out_samples, int no_transcode) |
| 210 | { |
| 211 | char buf[4096] = {0x80, 0}; |
| 212 | int cc, rc; |
| 213 | struct mgcp_rtp_end *dst_end; |
| 214 | struct mgcp_rtp_end *src_end; |
| 215 | struct mgcp_config *cfg; |
| 216 | struct mgcp_trunk_config tcfg = {{0}}; |
| 217 | struct mgcp_endpoint endp = {0}; |
| 218 | struct mgcp_process_rtp_state *state; |
| 219 | int in_cnt; |
| 220 | int out_size; |
| 221 | int in_size; |
| 222 | uint32_t ts = 0; |
| 223 | uint16_t seq = 0; |
| 224 | const char *srcfmt = "pcma"; |
| 225 | const char *dstfmt = no_transcode ? "pcma" : "l16"; |
| 226 | |
| 227 | cfg = mgcp_config_alloc(); |
| 228 | |
| 229 | tcfg.endpoints = &endp; |
| 230 | tcfg.number_endpoints = 1; |
| 231 | tcfg.cfg = cfg; |
| 232 | endp.tcfg = &tcfg; |
| 233 | endp.cfg = cfg; |
| 234 | mgcp_free_endp(&endp); |
| 235 | |
| 236 | dst_end = &endp.bts_end; |
| 237 | src_end = &endp.net_end; |
| 238 | |
| 239 | printf("== Transcoding test ==\n"); |
| 240 | printf("converting %s -> %s\n", srcfmt, dstfmt); |
| 241 | |
| 242 | src_end->payload_type = audio_name_to_type(srcfmt); |
| 243 | dst_end->payload_type = audio_name_to_type(dstfmt); |
| 244 | |
| 245 | if (out_samples) { |
| 246 | dst_end->frame_duration_den = dst_end->rate; |
| 247 | dst_end->frame_duration_num = out_samples; |
| 248 | dst_end->frames_per_packet = 1; |
| 249 | dst_end->force_output_ptime = 1; |
| 250 | } |
| 251 | |
| 252 | rc = mgcp_transcoding_setup(&endp, dst_end, src_end); |
| 253 | if (rc < 0) |
| 254 | errx(1, "setup failed: %s", strerror(-rc)); |
| 255 | |
| 256 | state = dst_end->rtp_process_data; |
| 257 | OSMO_ASSERT(state != NULL); |
| 258 | |
| 259 | in_size = mgcp_transcoding_get_frame_size(state, in_samples, 0); |
| 260 | OSMO_ASSERT(sizeof(buf) >= in_size + 12); |
| 261 | |
| 262 | out_size = mgcp_transcoding_get_frame_size(state, -1, 1); |
| 263 | OSMO_ASSERT(sizeof(buf) >= out_size + 12); |
| 264 | |
| 265 | buf[1] = src_end->payload_type; |
| 266 | *(uint16_t*)(buf+2) = htons(1); |
| 267 | *(uint32_t*)(buf+4) = htonl(0); |
| 268 | *(uint32_t*)(buf+8) = htonl(0xaabbccdd); |
| 269 | |
| 270 | for (in_cnt = 0; in_cnt < 16; in_cnt++) { |
| 271 | int cont; |
| 272 | int len; |
| 273 | |
| 274 | /* fake PCMA data */ |
| 275 | printf("generating %d %s input samples\n", in_samples, srcfmt); |
| 276 | for (cc = 0; cc < in_samples; cc++) |
| 277 | buf[12+cc] = cc; |
| 278 | |
| 279 | *(uint16_t*)(buf+2) = htonl(seq); |
| 280 | *(uint32_t*)(buf+4) = htonl(ts); |
| 281 | |
| 282 | seq += 1; |
| 283 | ts += in_samples; |
| 284 | |
| 285 | cc += 12; /* include RTP header */ |
| 286 | |
| 287 | len = cc; |
| 288 | |
| 289 | do { |
| 290 | cont = mgcp_transcoding_process_rtp(&endp, dst_end, |
| 291 | buf, &len, sizeof(buf)); |
| 292 | if (cont == -EAGAIN) { |
| 293 | fprintf(stderr, "Got EAGAIN\n"); |
| 294 | break; |
| 295 | } |
| 296 | |
| 297 | if (cont < 0) |
| 298 | errx(1, "processing failed: %s", strerror(-cont)); |
| 299 | |
| 300 | len -= 12; /* ignore RTP header */ |
| 301 | |
| 302 | printf("got %d %s output frames (%d octets)\n", |
| 303 | len / out_size, dstfmt, len); |
| 304 | |
| 305 | len = cont; |
| 306 | } while (len > 0); |
| 307 | } |
| 308 | return 0; |
| 309 | } |
| 310 | |
| 311 | int main(int argc, char **argv) |
| 312 | { |
| 313 | osmo_init_logging(&log_info); |
| 314 | |
| 315 | printf("=== Transcoding Good Cases ===\n"); |
| 316 | |
| 317 | transcode_test("l16", "l16", |
| 318 | (uint8_t *)audio_packets_l16[0].data, |
| 319 | audio_packets_l16[0].len); |
| 320 | transcode_test("l16", "gsm", |
| 321 | (uint8_t *)audio_packets_l16[0].data, |
| 322 | audio_packets_l16[0].len); |
| 323 | transcode_test("l16", "pcma", |
| 324 | (uint8_t *)audio_packets_l16[0].data, |
| 325 | audio_packets_l16[0].len); |
| 326 | transcode_test("gsm", "l16", |
| 327 | (uint8_t *)audio_packets_gsm[0].data, |
| 328 | audio_packets_gsm[0].len); |
| 329 | transcode_test("gsm", "gsm", |
| 330 | (uint8_t *)audio_packets_gsm[0].data, |
| 331 | audio_packets_gsm[0].len); |
| 332 | transcode_test("gsm", "pcma", |
| 333 | (uint8_t *)audio_packets_gsm[0].data, |
| 334 | audio_packets_gsm[0].len); |
| 335 | transcode_test("pcma", "l16", |
| 336 | (uint8_t *)audio_packets_pcma[0].data, |
| 337 | audio_packets_pcma[0].len); |
| 338 | transcode_test("pcma", "gsm", |
| 339 | (uint8_t *)audio_packets_pcma[0].data, |
| 340 | audio_packets_pcma[0].len); |
| 341 | transcode_test("pcma", "pcma", |
| 342 | (uint8_t *)audio_packets_pcma[0].data, |
| 343 | audio_packets_pcma[0].len); |
| 344 | |
| 345 | printf("=== Transcoding Bad Cases ===\n"); |
| 346 | |
| 347 | printf("Invalid size:\n"); |
| 348 | transcode_test("gsm", "pcma", |
| 349 | (uint8_t *)audio_packets_gsm_invalid_size[0].data, |
| 350 | audio_packets_gsm_invalid_size[0].len); |
| 351 | |
| 352 | printf("Invalid data:\n"); |
| 353 | transcode_test("gsm", "pcma", |
| 354 | (uint8_t *)audio_packets_gsm_invalid_data[0].data, |
| 355 | audio_packets_gsm_invalid_data[0].len); |
| 356 | |
| 357 | printf("Invalid payload type:\n"); |
| 358 | transcode_test("gsm", "pcma", |
| 359 | (uint8_t *)audio_packets_gsm_invalid_ptype[0].data, |
| 360 | audio_packets_gsm_invalid_ptype[0].len); |
| 361 | |
| 362 | printf("=== Repacking ===\n"); |
| 363 | |
| 364 | test_repacking(160, 160, 0); |
| 365 | test_repacking(160, 160, 1); |
| 366 | test_repacking(160, 80, 0); |
| 367 | test_repacking(160, 80, 1); |
| 368 | test_repacking(160, 320, 0); |
| 369 | test_repacking(160, 320, 1); |
| 370 | test_repacking(160, 240, 0); |
| 371 | test_repacking(160, 240, 1); |
| 372 | test_repacking(160, 100, 0); |
| 373 | test_repacking(160, 100, 1); |
| 374 | |
| 375 | return 0; |
| 376 | } |
| 377 | |