X-Git-Url: http://git.eversberg.eu/gitweb.cgi?p=lcr.git;a=blobdiff_plain;f=gsm.cpp;h=961c11f275a24b5751769745919f3abd4a87d0e8;hp=f9c9914c417c37653f81bf8c649379bd870ba99e;hb=e960c8cb522cb3d0b4086ad2e8ecdad50d1ec986;hpb=7239f7e28e0c566c2e9ce2cacc9c32e297dd17d7 diff --git a/gsm.cpp b/gsm.cpp index f9c9914..961c11f 100644 --- a/gsm.cpp +++ b/gsm.cpp @@ -11,26 +11,59 @@ #include "main.h" +#ifndef _GNU_SOURCE +#define _GNU_SOURCE +#endif extern "C" { -#include "openbsc/mncc.h" -#include "openbsc/trau_frame.h" -#include "openbsc/select.h" -#include "openbsc/debug.h" -#include "openbsc/e1_input.h" -#include "bootstrap.h" +#include + +#include +#include +#include +#include +#include +#include +#include +struct gsm_network *bsc_gsmnet = 0; +extern int ipacc_rtp_direct; +extern int bsc_bootstrap_network(int (*mmc_rev)(struct gsm_network *, int, void *), + const char *cfg_file); +extern int bsc_shutdown_net(struct gsm_network *net); +void talloc_ctx_init(void); +void on_dso_load_token(void); +void on_dso_load_rrlp(void); +void on_dso_load_ho_dec(void); +int bts_model_unknown_init(void); +int bts_model_bs11_init(void); +int bts_model_nanobts_init(void); +static struct debug_target *stderr_target; + +/* timer to store statistics */ +#define DB_SYNC_INTERVAL 60, 0 +static struct timer_list db_sync_timer; + #include "gsm_audio.h" -#undef AF_ISDN -#undef PF_ISDN -extern int AF_ISDN; -#define PF_ISDN AF_ISDN } +#include struct lcr_gsm *gsm = NULL; static unsigned int new_callref = 1; +/* timer handling */ +static int _db_store_counter(struct counter *counter, void *data) +{ + return db_store_counter(counter); +} + +static void db_sync_timer_cb(void *data) +{ + /* store counters to database and re-schedule */ + counters_for_each(_db_store_counter, NULL); + bsc_schedule_timer(&db_sync_timer, DB_SYNC_INTERVAL); +} /* * create and send mncc message @@ -54,6 +87,7 @@ static int send_and_free_mncc(struct gsm_network *net, unsigned int msg_type, vo return ret; } +static int delete_event(struct lcr_work *work, void *instance, int index); /* * constructor @@ -61,6 +95,8 @@ static int send_and_free_mncc(struct gsm_network *net, unsigned int msg_type, vo Pgsm::Pgsm(int type, struct mISDNport *mISDNport, char *portname, struct port_settings *settings, int channel, int exclusive, int mode) : PmISDN(type, mISDNport, portname, settings, channel, exclusive, mode) { p_callerinfo.itype = (mISDNport->ifport->interface->extension)?INFO_ITYPE_ISDN_EXTENSION:INFO_ITYPE_ISDN; + memset(&p_m_g_delete, 0, sizeof(p_m_g_delete)); + add_work(&p_m_g_delete, delete_event, this, 0); p_m_g_callref = 0; p_m_g_mode = 0; p_m_g_gsm_b_sock = -1; @@ -71,7 +107,7 @@ Pgsm::Pgsm(int type, struct mISDNport *mISDNport, char *portname, struct port_se p_m_g_encoder = gsm_audio_create(); if (!p_m_g_encoder || !p_m_g_decoder) { PERROR("Failed to create GSM audio codec instance\n"); - p_m_delete = 1; + trigger_work(&p_m_g_delete); } p_m_g_rxpos = 0; p_m_g_tch_connected = 0; @@ -86,6 +122,8 @@ Pgsm::~Pgsm() { PDEBUG(DEBUG_GSM, "Destroyed GSM process(%s).\n", p_name); + del_work(&p_m_g_delete); + /* remove queued message */ if (p_m_g_notify_pending) message_free(p_m_g_notify_pending); @@ -105,18 +143,21 @@ Pgsm::~Pgsm() /* close bsc side bchannel */ void Pgsm::bchannel_close(void) { - if (p_m_g_gsm_b_sock > -1) + if (p_m_g_gsm_b_sock > -1) { + unregister_fd(&p_m_g_gsm_b_fd); close(p_m_g_gsm_b_sock); + } p_m_g_gsm_b_sock = -1; p_m_g_gsm_b_index = -1; p_m_g_gsm_b_active = 0; } +static int b_handler(struct lcr_fd *fd, unsigned int what, void *instance, int index); + /* open bsc side bchannel */ int Pgsm::bchannel_open(int index) { int ret; - unsigned int on = 1; struct sockaddr_mISDN addr; struct mISDNhead act; @@ -132,14 +173,10 @@ int Pgsm::bchannel_open(int index) bchannel_close(); return(ret); } - - /* set nonblocking io */ - ret = ioctl(p_m_g_gsm_b_sock, FIONBIO, &on); - if (ret < 0) { - PERROR("Failed to set bchannel-socket index %d into nonblocking IO\n", index); - bchannel_close(); - return(ret); - } + memset(&p_m_g_gsm_b_fd, 0, sizeof(p_m_g_gsm_b_fd)); + p_m_g_gsm_b_fd.fd = p_m_g_gsm_b_sock; + register_fd(&p_m_g_gsm_b_fd, LCR_FD_READ, b_handler, this, 0); + /* bind socket to bchannel */ addr.family = AF_ISDN; @@ -170,9 +207,7 @@ int Pgsm::bchannel_open(int index) /* receive from bchannel */ void Pgsm::bchannel_receive(struct mISDNhead *hh, unsigned char *data, int len) { - int i, j, k; unsigned char frame[33]; - struct decoded_trau_frame tf; /* encoder init failed */ if (!p_m_g_encoder) @@ -190,31 +225,7 @@ void Pgsm::bchannel_receive(struct mISDNhead *hh, unsigned char *data, int len) /* encode data */ gsm_audio_encode(p_m_g_encoder, p_m_g_rxdata, frame); - - /* set c-bits and t-bits */ - tf.c_bits[0] = 1; - tf.c_bits[1] = 1; - tf.c_bits[2] = 1; - tf.c_bits[3] = 0; - tf.c_bits[4] = 0; - memset(&tf.c_bits[5], 0, 6); - memset(&tf.c_bits[11], 1, 10); - memset(&tf.t_bits[0], 1, 4); - - /* reassemble d-bits */ - i = 0; - j = 0; - k = 0; - while(i < 260) { - tf.d_bits[i] = (frame[j] >> k) & 1; - if (++k == 8) { - k = 0; - j++; - } - i++; - } - - trau_send(&tf); + frame_send(frame); } } } @@ -235,60 +246,36 @@ void Pgsm::bchannel_send(unsigned int prim, unsigned int id, unsigned char *data memcpy(buf+MISDN_HEADER_LEN, data, len); ret = sendto(p_m_g_gsm_b_sock, buf, MISDN_HEADER_LEN+len, 0, NULL, 0); if (ret <= 0) - PERROR("Failed to send to socket index %d\n", index); + PERROR("Failed to send to socket index %d\n", p_m_g_gsm_b_index); } -void Pgsm::trau_send(void *_tf) +void Pgsm::frame_send(void *_frame) { - struct decoded_trau_frame *tf = (struct decoded_trau_frame *)_tf; - unsigned char data[sizeof(struct gsm_trau_frame) + sizeof(struct decoded_trau_frame)]; - struct gsm_trau_frame *frame = (struct gsm_trau_frame *)data; + unsigned char buffer[sizeof(struct gsm_data_frame) + 33]; + struct gsm_data_frame *frame = (struct gsm_data_frame *)buffer; - frame->msg_type = GSM_TRAU_FRAME; + frame->msg_type = GSM_TCHF_FRAME; frame->callref = p_m_g_callref; - memcpy(frame->data, tf, sizeof(struct decoded_trau_frame)); + memcpy(frame->data, _frame, 33); mncc_send((struct gsm_network *)gsm->network, frame->msg_type, frame); } -void Pgsm::trau_receive(void *_frame) +void Pgsm::frame_receive(void *_frame) { - struct gsm_trau_frame *frm = (struct gsm_trau_frame *)_frame; - struct decoded_trau_frame *tf = (struct decoded_trau_frame *)frm->data; -//struct decoded_trau_frame *tf = (struct decoded_trau_frame *)_frame; - unsigned char frame[33]; + struct gsm_data_frame *frame = (struct gsm_data_frame *)_frame; signed short samples[160]; unsigned char data[160]; - int i, j, k; + int i; if (!p_m_g_decoder) return; -// printf("got trau %d %d %d %d %d\n", tf->c_bits[0], tf->c_bits[1], tf->c_bits[2], tf->c_bits[3], tf->c_bits[4]); - if (tf->c_bits[0]!=0 || tf->c_bits[1]!=0 || tf->c_bits[2]!=0 || tf->c_bits[3]!=1 || tf->c_bits[4]!=0) - PERROR("illegal trau (C1-C5) %d %d %d %d %d\n", tf->c_bits[0], tf->c_bits[1], tf->c_bits[2], tf->c_bits[3], tf->c_bits[4]); - - /* set GSM_MAGIC */ - memset(&frame, 0, sizeof(frame)); -// frame[0] = 0xd << 4; - - /* reassemble bits */ - i = 0; - j = 0; - k = 0; - while(i < 260) { - if (tf->d_bits[i] > 1) - PERROR("fix!\n"); - frame[j] |= (tf->d_bits[i] << k); - if (++k == 8) { - k = 0; - j++; - } - i++; - } + if ((frame->data[0]>>4) != 0xd) + PERROR("received GSM frame with wrong magig 0x%x\n", frame->data[0]>>4); /* decode */ - gsm_audio_decode(p_m_g_decoder, frame, samples); + gsm_audio_decode(p_m_g_decoder, frame->data, samples); for (i = 0; i < 160; i++) { data[i] = audio_s16_to_law[samples[i] & 0xffff]; } @@ -408,7 +395,7 @@ void Pgsm::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_mnc end_trace(); send_and_free_mncc((struct gsm_network *)gsm->network, mncc->msg_type, mncc); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } p_m_g_callref = callref; @@ -429,7 +416,7 @@ void Pgsm::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_mnc end_trace(); send_and_free_mncc((struct gsm_network *)gsm->network, mncc->msg_type, mncc); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } @@ -501,7 +488,7 @@ void Pgsm::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_mnc end_trace(); send_and_free_mncc((struct gsm_network *)gsm->network, mncc->msg_type, mncc); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } bchannel_event(p_m_mISDNport, p_m_b_index, B_EVENT_USE); @@ -759,7 +746,7 @@ void Pgsm::disc_ind(unsigned int msg_type, unsigned int callref, struct gsm_mncc free_epointlist(p_epointlist); } new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); } /* CC_RELEASE INDICATION */ @@ -788,14 +775,21 @@ void Pgsm::rel_ind(unsigned int msg_type, unsigned int callref, struct gsm_mncc free_epointlist(p_epointlist); } new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); } /* NOTIFY INDICATION */ void Pgsm::notify_ind(unsigned int msg_type, unsigned int callref, struct gsm_mncc *mncc) { + struct lcr_msg *message; + gsm_trace_header(p_m_mISDNport, this, msg_type, DIRECTION_IN); + add_trace("notify", NULL, "%d", mncc->notify); end_trace(); + + message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_NOTIFY); + message->param.notifyinfo.notify = mncc->notify; + message_put(message); } @@ -865,7 +859,7 @@ void Pgsm::retr_ind(unsigned int msg_type, unsigned int callref, struct gsm_mncc /* * BSC sends message to port */ -static int message_bcs(struct gsm_network *net, int msg_type, void *arg) +static int message_bsc(struct gsm_network *net, int msg_type, void *arg) { struct gsm_mncc *mncc = (struct gsm_mncc *)arg; unsigned int callref = mncc->callref; @@ -891,9 +885,9 @@ static int message_bcs(struct gsm_network *net, int msg_type, void *arg) port = port->next; } - if (msg_type == GSM_TRAU_FRAME) { + if (msg_type == GSM_TCHF_FRAME) { if (port) - pgsm->trau_receive((struct gsm_trau_frame *)arg); + pgsm->frame_receive((struct gsm_trau_frame *)arg); return 0; } @@ -1012,7 +1006,7 @@ void Pgsm::message_setup(unsigned int epoint_id, int message_id, union parameter message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL; message_put(message); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } @@ -1026,7 +1020,7 @@ void Pgsm::message_setup(unsigned int epoint_id, int message_id, union parameter message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL; message_put(message); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } @@ -1046,7 +1040,7 @@ void Pgsm::message_setup(unsigned int epoint_id, int message_id, union parameter message->param.disconnectinfo.location = LOCATION_PRIVATE_LOCAL; message_put(message); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } bchannel_event(p_m_mISDNport, p_m_b_index, B_EVENT_USE); @@ -1202,7 +1196,7 @@ void Pgsm::message_notify(unsigned int epoint_id, int message_id, union paramete struct gsm_mncc *mncc; int notify; - printf("if = %d\n", param->notifyinfo.notify); +// printf("if = %d\n", param->notifyinfo.notify); if (param->notifyinfo.notify>INFO_NOTIFY_NONE) { notify = param->notifyinfo.notify & 0x7f; if (p_state!=PORT_STATE_CONNECT /*&& p_state!=PORT_STATE_IN_PROCEEDING*/ && p_state!=PORT_STATE_IN_ALERTING) { @@ -1378,7 +1372,7 @@ void Pgsm::message_release(unsigned int epoint_id, int message_id, union paramet send_and_free_mncc((struct gsm_network *)gsm->network, mncc->msg_type, mncc); new_state(PORT_STATE_RELEASE); - p_m_delete = 1; + trigger_work(&p_m_g_delete); return; } @@ -1461,28 +1455,29 @@ int Pgsm::message_epoint(unsigned int epoint_id, int message_id, union parameter } +/* deletes only if l3id is release, otherwhise it will be triggered then */ +static int delete_event(struct lcr_work *work, void *instance, int index) +{ + class Pgsm *gsmport = (class Pgsm *)instance; + + delete gsmport; + + return 0; +} + /* - * handler + * handler of bchannel events */ -int Pgsm::handler(void) +static int b_handler(struct lcr_fd *fd, unsigned int what, void *instance, int index) { + class Pgsm *gsmport = (class Pgsm *)instance; int ret; - int work = 0; unsigned char buffer[2048+MISDN_HEADER_LEN]; struct mISDNhead *hh = (struct mISDNhead *)buffer; - if ((ret = PmISDN::handler())) - return(ret); - - /* handle destruction */ - if (p_m_delete) { - delete this; - return(-1); - } - /* handle message from bchannel */ - if (p_m_g_gsm_b_sock > -1) { - ret = recv(p_m_g_gsm_b_sock, buffer, sizeof(buffer), 0); + if (gsmport->p_m_g_gsm_b_sock > -1) { + ret = recv(gsmport->p_m_g_gsm_b_sock, buffer, sizeof(buffer), 0); if (ret >= (int)MISDN_HEADER_LEN) { switch(hh->prim) { /* we don't care about confirms, we use rx data to sync tx */ @@ -1490,37 +1485,21 @@ int Pgsm::handler(void) break; /* we receive audio data, we respond to it AND we send tones */ case PH_DATA_IND: - bchannel_receive(hh, buffer+MISDN_HEADER_LEN, ret-MISDN_HEADER_LEN); + gsmport->bchannel_receive(hh, buffer+MISDN_HEADER_LEN, ret-MISDN_HEADER_LEN); break; case PH_ACTIVATE_IND: - p_m_g_gsm_b_active = 1; + gsmport->p_m_g_gsm_b_active = 1; break; case PH_DEACTIVATE_IND: - p_m_g_gsm_b_active = 0; + gsmport->p_m_g_gsm_b_active = 0; break; } - work = 1; } else { if (ret < 0 && errno != EWOULDBLOCK) PERROR("Read from GSM port, index %d failed with return code %d\n", ret); } } - return(work); -} - - -/* - * handles bsc select function within LCR's main loop - */ -int handle_gsm(void) -{ - int ret1, ret2; - - ret1 = bsc_upqueue((struct gsm_network *)gsm->network); - ret2 = bsc_select_main(1); /* polling */ - if (ret1 || ret2) - return 1; return 0; } @@ -1574,7 +1553,7 @@ static int gsm_sock_open(char *portname) PERROR_RUNTIME("GSM port %d does not support TE PRI or TE BRI.\n", gsm->gsm_port); } /* open socket */ - if ((gsm->gsm_sock = socket(PF_ISDN, SOCK_DGRAM, ISDN_P_TE_S0)) < 0) { + if ((gsm->gsm_sock = socket(PF_ISDN, SOCK_DGRAM, (pri)?ISDN_P_TE_E1:ISDN_P_TE_S0)) < 0) { PERROR_RUNTIME("GSM port %d failed to open socket.\n", gsm->gsm_port); gsm_sock_close(); return gsm->gsm_sock; @@ -1608,7 +1587,7 @@ int gsm_exit(int rc) gsm_sock_close(); /* shutdown network */ if (gsm->network) - shutdown_net((struct gsm_network *)gsm->network); + bsc_shutdown_net((struct gsm_network *)gsm->network); /* free network */ // if (gsm->network) { // free((struct gsm_network *)gsm->network); /* TBD */ @@ -1622,61 +1601,115 @@ int gsm_exit(int rc) int gsm_init(void) { - char hlr[128], filename[128]; + char hlr[128], cfg[128], filename[128]; mode_t mode = S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH; - int pcapfd; + int pcapfd, rc; + char conf_error[128] = ""; + + + debug_init(); + tall_bsc_ctx = talloc_named_const(NULL, 1, "openbsc"); + talloc_ctx_init(); + on_dso_load_token(); + on_dso_load_rrlp(); + on_dso_load_ho_dec(); + stderr_target = debug_target_create_stderr(); + debug_add_target(stderr_target); + + bts_model_unknown_init(); + bts_model_bs11_init(); + bts_model_nanobts_init(); + + /* enable filters */ + debug_set_all_filter(stderr_target, 1); + + /* seed the PRNG */ + srand(time(NULL)); /* create gsm instance */ gsm = (struct lcr_gsm *)MALLOC(sizeof(struct lcr_gsm)); gsm->gsm_sock = -1; /* parse options */ - if (!gsm_conf(&gsm->conf)) { - PERROR("%s", gsm_conf_error); + if (!gsm_conf(&gsm->conf, conf_error)) { + PERROR("%s", conf_error); return gsm_exit(-EINVAL); } /* set debug */ - debug_parse_category_mask(gsm->conf.debug); + if (gsm->conf.debug[0]) + debug_parse_category_mask(stderr_target, gsm->conf.debug); + + /* open pcap file */ + if (gsm->conf.pcapfile[0]) { + if (gsm->conf.pcapfile[0] == '/') + SCPY(filename, gsm->conf.pcapfile); + else + SPRINT(filename, "%s/%s", CONFIG_DATA, gsm->conf.pcapfile); + pcapfd = open(filename, O_WRONLY|O_TRUNC|O_CREAT, mode); + if (pcapfd < 0) { + PERROR("Failed to open file for pcap\n"); + return gsm_exit(-1); + } + e1_set_pcap_fd(pcapfd); + } + + /* use RTP proxy for audio streaming */ + ipacc_rtp_direct = 0; /* init database */ if (gsm->conf.hlr[0] == '/') SCPY(hlr, gsm->conf.hlr); else SPRINT(hlr, "%s/%s", CONFIG_DATA, gsm->conf.hlr); - - // TODO multiple base stations - if (gsm->conf.numbts < 1 || gsm->conf.numbts > 1) { - PERROR("Expecting exactly one BTS. You defined %d.\n", gsm->conf.numbts); + if (db_init(hlr)) { + PERROR("GSM DB: Failed to init database '%s'. Please check the option settings.\n", hlr); return gsm_exit(-1); } + printf("DB: Database initialized.\n"); + if (db_prepare()) { + PERROR("GSM DB: Failed to prepare database.\n"); + return gsm_exit(-1); + } + printf("DB: Database prepared.\n"); + + /* setup the timer */ + db_sync_timer.cb = db_sync_timer_cb; + db_sync_timer.data = NULL; + bsc_schedule_timer(&db_sync_timer, DB_SYNC_INTERVAL); /* bootstrap network */ - gsm->network = bootstrap_network(&message_bcs, gsm->conf.bts[0].type, gsm->conf.mcc, gsm->conf.mnc, gsm->conf.lac, gsm->conf.bts[0].frequency[0], gsm->conf.bts[0].card, !gsm->conf.keep_l2, gsm->conf.short_name, gsm->conf.long_name, hlr, gsm->conf.allow_all); - if (!gsm->network) { + if (gsm->conf.openbsc_cfg[0] == '/') + SCPY(cfg, gsm->conf.openbsc_cfg); + else + SPRINT(cfg, "%s/%s", CONFIG_DATA, gsm->conf.openbsc_cfg); + rc = bsc_bootstrap_network(&message_bsc, cfg); + if (rc < 0) { PERROR("Failed to bootstrap GSM network.\n"); return gsm_exit(-1); } + gsm->network = bsc_gsmnet; /* open gsm loop interface */ if (gsm_sock_open(gsm->conf.interface_bsc)) { return gsm_exit(-1); } - /* open pcap file */ - if (gsm->conf.pcapfile[0]) { - if (gsm->conf.pcapfile[0] == '/') - SCPY(filename, gsm->conf.pcapfile); - else - SPRINT(filename, "%s/%s", CONFIG_DATA, gsm->conf.pcapfile); - pcapfd = open(filename, O_WRONLY|O_TRUNC|O_CREAT, mode); - if (pcapfd < 0) { - PERROR("Failed to open file for pcap\n"); - return gsm_exit(-1); - } - e1_set_pcap_fd(pcapfd); - } + return 0; +} +/* + * handles bsc select function within LCR's main loop + */ +int handle_gsm(void) +{ + int ret1, ret2; + + ret1 = bsc_upqueue((struct gsm_network *)gsm->network); + debug_reset_context(); + ret2 = bsc_select_main(1); /* polling */ + if (ret1 || ret2) + return 1; return 0; }