Harald Welte | 283c7fd | 2015-12-21 23:35:56 +0100 | [diff] [blame] | 1 | #include "sua_test_common.h" |
| 2 | |
| 3 | struct osmo_prim_hdr *make_conn_resp(struct osmo_scu_connect_param *param) |
| 4 | { |
| 5 | struct msgb *msg = msgb_alloc(1024, "conn_resp"); |
| 6 | struct osmo_scu_prim *prim; |
| 7 | |
| 8 | prim = (struct osmo_scu_prim *) msgb_put(msg, sizeof(*prim)); |
| 9 | osmo_prim_init(&prim->oph, SCCP_SAP_USER, |
| 10 | OSMO_SCU_PRIM_N_CONNECT, |
| 11 | PRIM_OP_RESPONSE, msg); |
| 12 | memcpy(&prim->u.connect, param, sizeof(prim->u.connect)); |
| 13 | return &prim->oph; |
| 14 | } |
| 15 | |
| 16 | static int sccp_sap_up(struct osmo_prim_hdr *oph, void *link) |
| 17 | { |
| 18 | struct osmo_scu_prim *prim = (struct osmo_scu_prim *) oph; |
| 19 | struct osmo_prim_hdr *resp = NULL; |
| 20 | const uint8_t payload[] = { 0xb1, 0xb2, 0xb3 }; |
| 21 | |
| 22 | printf("sccp_sap_up(%s)\n", osmo_sccp_prim_name(oph)); |
| 23 | |
| 24 | switch (OSMO_PRIM_HDR(oph)) { |
| 25 | case OSMO_PRIM(OSMO_SCU_PRIM_N_CONNECT, PRIM_OP_CONFIRM): |
| 26 | /* confirmation of outbound connection */ |
| 27 | break; |
| 28 | case OSMO_PRIM(OSMO_SCU_PRIM_N_CONNECT, PRIM_OP_INDICATION): |
| 29 | /* indication of new inbound connection request*/ |
| 30 | printf("N-CONNECT.ind(X->%u)\n", prim->u.connect.conn_id); |
| 31 | resp = make_conn_resp(&prim->u.connect); |
| 32 | break; |
| 33 | case OSMO_PRIM(OSMO_SCU_PRIM_N_DISCONNECT, PRIM_OP_INDICATION): |
| 34 | /* indication of disconnect */ |
| 35 | printf("N-DISCONNECT.ind(%u)\n", prim->u.disconnect.conn_id); |
| 36 | break; |
| 37 | case OSMO_PRIM(OSMO_SCU_PRIM_N_DATA, PRIM_OP_INDICATION): |
| 38 | /* connection-oriented data received */ |
| 39 | printf("N-DATA.ind(%u, %s)\n", prim->u.data.conn_id, |
| 40 | osmo_hexdump(msgb_l2(oph->msg), msgb_l2len(oph->msg))); |
| 41 | resp = make_dt1_req(prim->u.data.conn_id, payload, sizeof(payload)); |
| 42 | break; |
| 43 | case OSMO_PRIM(OSMO_SCU_PRIM_N_UNITDATA, PRIM_OP_INDICATION): |
| 44 | /* connection-oriented data received */ |
| 45 | printf("N-UNITDATA.ind(%s)\n", |
| 46 | osmo_hexdump(msgb_l2(oph->msg), msgb_l2len(oph->msg))); |
| 47 | tx_unitdata(link); |
| 48 | break; |
| 49 | } |
| 50 | |
| 51 | if (resp) |
| 52 | osmo_osmo_sua_user_link_down(link, resp); |
| 53 | |
| 54 | msgb_free(oph->msg); |
| 55 | return 0; |
| 56 | } |
| 57 | |
| 58 | int main(int argc, char **argv) |
| 59 | { |
| 60 | struct osmo_sua_user *user; |
| 61 | void *ctx = talloc_named_const(NULL, 1, "root"); |
| 62 | int rc; |
| 63 | |
| 64 | osmo_sua_set_log_area(DSUA); |
| 65 | xua_set_log_area(DXUA); |
| 66 | |
| 67 | osmo_init_logging(&test_log_info); |
| 68 | |
| 69 | user = osmo_sua_user_create(ctx, sccp_sap_up); |
| 70 | |
| 71 | rc = sua_server_listen(user, "127.0.0.1", 2342); |
| 72 | if (rc < 0) { |
| 73 | exit(1); |
| 74 | } |
| 75 | |
| 76 | while (1) { |
| 77 | osmo_select_main(0); |
| 78 | } |
| 79 | } |