Minor fix for GSM HR codec negotiation: Add missing 'break'.
[lcr.git] / gsm_bs.cpp
index 3a9ab7d..e8c9b58 100644 (file)
@@ -14,6 +14,9 @@
 
 struct lcr_gsm *gsm_bs = NULL;
 
+// use holdMPTY to transfer call
+#define TRANSFER_HACK
+
 #define PAYLOAD_TYPE_GSM 3
 
 /*
@@ -90,7 +93,7 @@ void Pgsm_bs::call_conf_ind(unsigned int msg_type, unsigned int callref, struct
        unsigned char payload_types[8];
        int payloads = 0;
 
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        if (mncc->fields & MNCC_F_CAUSE) {
                add_trace("cause", "coding", "%d", mncc->cause.coding);
                add_trace("cause", "location", "%", mncc->cause.location);
@@ -98,16 +101,29 @@ void Pgsm_bs::call_conf_ind(unsigned int msg_type, unsigned int callref, struct
        }
        end_trace();
 
+       SCPY(p_g_imsi, mncc->imsi);
+
        new_state(PORT_STATE_OUT_PROCEEDING);
 
-       /* get list of offered payload types
-        * if list ist empty, the FR V1 is selected */
+       /* get list of offered payload types */
        select_payload_type(mncc, payload_types, media_types, &payloads, sizeof(payload_types));
-       /* if no given payload type is supported, we assume  */
+       /* if no given payload type is supported, we must release */
        if (!payloads) {
-               media_types[0] = MEDIA_TYPE_GSM;
-               payload_types[0] = PAYLOAD_TYPE_GSM;
-               payloads = 1;
+               mncc = create_mncc(MNCC_REL_REQ, callref);
+               gsm_trace_header(p_interface_name, this, MNCC_REL_REQ, DIRECTION_OUT);
+               mncc->fields |= MNCC_F_CAUSE;
+               mncc->cause.coding = 3;
+               mncc->cause.location = 1;
+               mncc->cause.value = 65;
+               add_trace("cause", "coding", "%d", mncc->cause.coding);
+               add_trace("cause", "location", "%d", mncc->cause.location);
+               add_trace("cause", "value", "%d", mncc->cause.value);
+               add_trace("reason", NULL, "Given lchan not supported");
+               end_trace();
+               send_and_free_mncc(p_g_lcr_gsm, mncc->msg_type, mncc);
+               new_state(PORT_STATE_RELEASE);
+               trigger_work(&p_g_delete);
+               return;
        }
 
        /* select first payload type that matches the rtp list */
@@ -132,7 +148,7 @@ void Pgsm_bs::call_conf_ind(unsigned int msg_type, unsigned int callref, struct
                        message_put(message);
                        /* send release */
                        mncc = create_mncc(MNCC_REL_REQ, p_g_callref);
-                       gsm_trace_header(p_g_interface_name, this, MNCC_REL_REQ, DIRECTION_OUT);
+                       gsm_trace_header(p_interface_name, this, MNCC_REL_REQ, DIRECTION_OUT);
                        mncc->fields |= MNCC_F_CAUSE;
                        mncc->cause.coding = 3;
                        mncc->cause.location = LOCATION_PRIVATE_LOCAL;
@@ -163,14 +179,14 @@ void Pgsm_bs::start_dtmf_ind(unsigned int msg_type, unsigned int callref, struct
 {
        struct gsm_mncc *resp;
 
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        add_trace("keypad", NULL, "%c", mncc->keypad);
        end_trace();
        SPRINT(p_dialinginfo.id, "%c", mncc->keypad);
        p_dialinginfo.ntype = INFO_NTYPE_UNKNOWN;
 
        /* send resp */
-       gsm_trace_header(p_g_interface_name, this, MNCC_START_DTMF_RSP, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_START_DTMF_RSP, DIRECTION_OUT);
        add_trace("keypad", NULL, "%c", mncc->keypad);
        end_trace();
        resp = create_mncc(MNCC_START_DTMF_RSP, p_g_callref);
@@ -179,15 +195,24 @@ void Pgsm_bs::start_dtmf_ind(unsigned int msg_type, unsigned int callref, struct
        send_and_free_mncc(p_g_lcr_gsm, resp->msg_type, resp);
 
        if (p_g_rtp_bridge) {
-               class Port *remote = bridge_remote();
-
-               if (remote) {
-                       struct lcr_msg *message;
-
-                       /* send dtmf information, because we bridge RTP directly */
-                       message = message_create(0, remote->p_serial, EPOINT_TO_PORT, MESSAGE_DTMF);
-                       message->param.dtmf = mncc->keypad;
-                       message_put(message);
+               /* if two members are bridged */
+               if (p_bridge && p_bridge->first && p_bridge->first->next && !p_bridge->first->next->next) {
+                       class Port *remote = NULL;
+
+                       /* select other member */
+                       if (p_bridge->first->port == this)
+                               remote = p_bridge->first->next->port;
+                       if (p_bridge->first->next->port == this)
+                               remote = p_bridge->first->port;
+
+                       if (remote) {
+                               struct lcr_msg *message;
+
+                               /* send dtmf information, because we bridge RTP directly */
+                               message = message_create(0, remote->p_serial, EPOINT_TO_PORT, MESSAGE_DTMF);
+                               message->param.dtmf = mncc->keypad;
+                               message_put(message);
+                       }
                }
        } else {
                /* generate DTMF tones, since we do audio forwarding inside LCR */
@@ -220,12 +245,12 @@ void Pgsm_bs::stop_dtmf_ind(unsigned int msg_type, unsigned int callref, struct
 {
        struct gsm_mncc *resp;
 
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        add_trace("keypad", NULL, "%c", mncc->keypad);
        end_trace();
 
        /* send resp */
-       gsm_trace_header(p_g_interface_name, this, MNCC_STOP_DTMF_RSP, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_STOP_DTMF_RSP, DIRECTION_OUT);
        add_trace("keypad", NULL, "%c", mncc->keypad);
        end_trace();
        resp = create_mncc(MNCC_STOP_DTMF_RSP, p_g_callref);
@@ -242,7 +267,7 @@ void Pgsm_bs::hold_ind(unsigned int msg_type, unsigned int callref, struct gsm_m
        struct lcr_msg *message;
        struct gsm_mncc *resp, *frame;
 
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        end_trace();
 
        /* notify the hold of call */
@@ -251,15 +276,17 @@ void Pgsm_bs::hold_ind(unsigned int msg_type, unsigned int callref, struct gsm_m
        message->param.notifyinfo.local = 1; /* call is held by supplementary service */
        message_put(message);
 
+       p_hold = 1;
+
        /* acknowledge hold */
-       gsm_trace_header(p_g_interface_name, this, MNCC_HOLD_CNF, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_HOLD_CNF, DIRECTION_OUT);
        end_trace();
        resp = create_mncc(MNCC_HOLD_CNF, p_g_callref);
        send_and_free_mncc(p_g_lcr_gsm, resp->msg_type, resp);
 
        /* disable audio */
        if (p_g_tch_connected) { /* it should be true */
-               gsm_trace_header(p_g_interface_name, this, MNCC_FRAME_DROP, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_FRAME_DROP, DIRECTION_OUT);
                end_trace();
                frame = create_mncc(MNCC_FRAME_DROP, p_g_callref);
                send_and_free_mncc(p_g_lcr_gsm, frame->msg_type, frame);
@@ -274,7 +301,7 @@ void Pgsm_bs::retr_ind(unsigned int msg_type, unsigned int callref, struct gsm_m
        struct lcr_msg *message;
        struct gsm_mncc *resp, *frame;
 
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        end_trace();
 
        /* notify the retrieve of call */
@@ -283,15 +310,17 @@ void Pgsm_bs::retr_ind(unsigned int msg_type, unsigned int callref, struct gsm_m
        message->param.notifyinfo.local = 1; /* call is retrieved by supplementary service */
        message_put(message);
 
+       p_hold = 0;
+
        /* acknowledge retr */
-       gsm_trace_header(p_g_interface_name, this, MNCC_RETRIEVE_CNF, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_RETRIEVE_CNF, DIRECTION_OUT);
        end_trace();
        resp = create_mncc(MNCC_RETRIEVE_CNF, p_g_callref);
        send_and_free_mncc(p_g_lcr_gsm, resp->msg_type, resp);
 
        /* enable audio */
        if (!p_g_tch_connected) { /* it should be true */
-               gsm_trace_header(p_g_interface_name, this, MNCC_FRAME_RECV, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_FRAME_RECV, DIRECTION_OUT);
                end_trace();
                frame = create_mncc(MNCC_FRAME_RECV, p_g_callref);
                send_and_free_mncc(p_g_lcr_gsm, frame->msg_type, frame);
@@ -308,10 +337,11 @@ void Pgsm_bs::select_payload_type(struct gsm_mncc *mncc, unsigned char *payload_
 {
        int media_type;
        unsigned char payload_type;
+       void *encoder, *decoder;
 
        *payloads = 0;
 
-       gsm_trace_header(p_g_interface_name, this, 1 /* codec negotioation */, DIRECTION_NONE);
+       gsm_trace_header(p_interface_name, this, 1 /* codec negotioation */, DIRECTION_NONE);
        if ((mncc->fields & MNCC_F_BEARER_CAP)) {
                /* select preferred payload type from list */
                int i;
@@ -325,26 +355,36 @@ void Pgsm_bs::select_payload_type(struct gsm_mncc *mncc, unsigned char *payload_
                                add_trace("speech", "version", "Full Rate given");
                                media_type = MEDIA_TYPE_GSM;
                                payload_type = PAYLOAD_TYPE_GSM;
+                               encoder = p_g_fr_encoder;
+                               decoder = p_g_fr_decoder;
                                break;
                        case 2:
                                add_trace("speech", "version", "EFR given");
                                media_type = MEDIA_TYPE_GSM_EFR;
                                payload_type = dynamic_type++;
+                               encoder = p_g_amr_encoder;
+                               decoder = p_g_amr_decoder;
                                break;
                        case 4:
                                add_trace("speech", "version", "AMR given");
                                media_type = MEDIA_TYPE_AMR;
                                payload_type = dynamic_type++;
+                               encoder = p_g_amr_encoder;
+                               decoder = p_g_amr_decoder;
                                break;
                        case 1:
                                add_trace("speech", "version", "Half Rate given");
                                media_type = MEDIA_TYPE_GSM_HR;
                                payload_type = dynamic_type++;
+                               encoder = p_g_hr_encoder;
+                               decoder = p_g_hr_decoder;
                                break;
                        case 5:
                                add_trace("speech", "version", "AMR Half Rate given");
                                media_type = MEDIA_TYPE_AMR;
                                payload_type = dynamic_type++;
+                               encoder = p_g_amr_encoder;
+                               decoder = p_g_amr_decoder;
                                break;
                        default:
                                add_trace("speech", "version", "%d given", mncc->bearer_cap.speech_ver[i]);
@@ -357,8 +397,8 @@ void Pgsm_bs::select_payload_type(struct gsm_mncc *mncc, unsigned char *payload_
                                continue;
                        }
                        if (!p_g_rtp_bridge) {
-                               if (media_type != MEDIA_TYPE_GSM) {
-                                       add_trace("speech", "ignored", "Not suitable for LCR");
+                               if (!encoder || !decoder) {
+                                       add_trace("speech", "ignored", "Codec not supported");
                                        continue;
                                }
                        }
@@ -380,6 +420,248 @@ void Pgsm_bs::select_payload_type(struct gsm_mncc *mncc, unsigned char *payload_
        end_trace();
 }
 
+void gsm_trace_facility(unsigned char *fac_ie, unsigned char fac_len)
+{
+       char debug[GSM_MAX_FACILITY * 3 + 1];
+       int i;
+
+       i = 0;
+       while(i < fac_len) {
+               UPRINT(debug+(i*3), " %02x", fac_ie[i]);
+               i++;
+       }
+       debug[i*3] = '\0';
+       add_trace("facility", NULL, "%s", debug[0]?debug+1:"<none>");
+}
+
+/* encode facility IE */
+void Pgsm_bs::enc_ie_facility(struct gsm_mncc *mncc, int operation_code, int error_code, unsigned char invoke_id)
+{
+       unsigned char *fac_ie, fac_len;
+
+       fac_ie = (unsigned char *)mncc->facility.info;
+
+       mncc->fields |= MNCC_F_FACILITY;
+       if (operation_code >= 0) {
+               fac_len = 8;
+               fac_ie[0] = 0xa2;
+               fac_ie[1] = 6;
+               fac_ie[2] = 0x02; /* invoke ID */
+               fac_ie[3] = 1;
+               fac_ie[4] = invoke_id;
+               fac_ie[5] = 0x02; /* Operation Code */
+               fac_ie[6] = 1;
+               fac_ie[7] = 124; /* buildMPTY */
+               fac_ie[7] = operation_code;
+       }
+       if (error_code >= 0) {
+               fac_len = 8;
+               fac_ie[0] = 0xa3;
+               fac_ie[1] = 6;
+               fac_ie[2] = 0x02; /* invoke ID */
+               fac_ie[3] = 1;
+               fac_ie[4] = invoke_id;
+               fac_ie[5] = 0x02; /* Error Code */
+               fac_ie[6] = 1;
+               fac_ie[7] = error_code;
+       }
+       mncc->facility.len = fac_len;
+}
+
+/* send facility request */
+void Pgsm_bs::facility_req(int operation_code, int error_code, unsigned char invoke_id)
+{
+       struct gsm_mncc *mncc;
+
+       gsm_trace_header(p_interface_name, this, MNCC_FACILITY_REQ, DIRECTION_OUT);
+       mncc = create_mncc(MNCC_FACILITY_REQ, p_g_callref);
+
+       enc_ie_facility(mncc, operation_code, error_code, invoke_id);
+
+       gsm_trace_facility((unsigned char *)mncc->facility.info, mncc->facility.len);
+       end_trace();
+       send_and_free_mncc(p_g_lcr_gsm, mncc->msg_type, mncc);
+}
+
+/* FACILITY INDICATION */
+void Pgsm_bs::facility_ind(unsigned int msg_type, unsigned int callref, struct gsm_mncc *mncc)
+{
+       unsigned char *fac_ie, fac_len;
+       unsigned char comp_type, comp_len, *comp_val;
+       unsigned char invoke = 0, invoke_id = 0;
+       unsigned char operation = 0, operation_code = 0;
+       struct lcr_msg *message;
+       int i;
+
+       if (mncc->fields & MNCC_F_FACILITY) {
+               fac_ie = (unsigned char *)mncc->facility.info;
+               fac_len = mncc->facility.len;
+
+               gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
+               gsm_trace_facility(fac_ie, fac_len);
+               end_trace();
+       } else
+               return;
+
+       /* facility */
+       if (fac_len<=2)
+               return;
+       /* component tag */
+       if (fac_ie[1] > fac_len - 2) {
+               PDEBUG(DEBUG_GSM, "Component Tag in facility message greater than message length\n");
+               return;
+       }
+       comp_type = fac_ie[0];
+       comp_len = fac_ie[1];
+       comp_val = fac_ie + 2;
+       PDEBUG(DEBUG_GSM, "Component Tag type 0x%02x\n", comp_type);
+       /* tags inside component */
+       for (i = 0; i != comp_len;) {
+               if (comp_val[1 + i] > comp_len - i - 2) {
+                       PDEBUG(DEBUG_GSM, "Tag inside Component TAG greater than Component length\n");
+                       break;
+               }
+               PDEBUG(DEBUG_GSM, "Tag inside Component Tag (type 0x%02x)\n", comp_val[0 + i]);
+               if (comp_val[0 + i] == 0x02 && ! invoke) { /* Invoke ID Tag */
+                       if (comp_val[1 + i] != 1) {
+                               PDEBUG(DEBUG_GSM, "Invoke ID Tag has invalid length\n");
+                               break;
+                       }
+                       invoke = 1;
+                       invoke_id = comp_val[2 + i];
+                       PDEBUG(DEBUG_GSM, "Invoke ID Tag inside Component TAG with ID=%d\n", invoke_id);
+               } else if (comp_val[0 + i] == 0x02 && !operation) { /* Operation Code Tag */
+                       if (comp_val[1 + i] != 1) {
+                               PDEBUG(DEBUG_GSM, "Operation Code Tag has invalid length\n");
+                               break;
+                       }
+                       operation = 1;
+                       operation_code = comp_val[2 + i];
+                       PDEBUG(DEBUG_GSM, "Operation Code Tag inside Component TAG with Code=%d\n", operation_code);
+               } else
+                       PDEBUG(DEBUG_GSM, "Unknown Tag (0x%02x) inside Component TAG, ignoring\n", comp_val[0 + i]);
+
+               i += comp_val[1 + i] + 2;
+       }
+
+       /* check component type */
+       switch (comp_type) {
+       case 0xa1: /* Invoke */
+               if (!invoke) {
+                       PDEBUG(DEBUG_GSM, "error: Invoke without Invoke ID\n");
+                       break;
+               }
+               if (!operation) {
+                       PDEBUG(DEBUG_GSM, "error: Invoke without Operation Tag\n");
+                       break;
+               }
+               switch(operation_code) {
+               case 124: /* buildMTPY */
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_3PTY);
+                       message->param.threepty.begin = 1;
+                       message->param.threepty.invoke = 1;
+                       message->param.threepty.invoke_id = invoke_id;
+                       message_put(message);
+                       return;
+
+               case 121: /* splitMTPY */
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_3PTY);
+                       message->param.threepty.end = 1;
+                       message->param.threepty.invoke = 1;
+                       message->param.threepty.invoke_id = invoke_id;
+                       message_put(message);
+                       return;
+
+               case 122: /* holdMTPY */
+#ifdef TRANSFER_HACK
+                       facility_req(-1, 122, invoke_id); /* rejected by network */
+
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_TRANSFER);
+                       message->param.transfer.invoke = 1;
+                       message->param.transfer.invoke_id = invoke_id;
+                       message_put(message);
+#else
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_3PTY);
+                       message->param.threepty.hold = 1;
+                       message->param.threepty.invoke = 1;
+                       message->param.threepty.invoke_id = invoke_id;
+                       message_put(message);
+#endif
+                       return;
+
+               case 123: /* retrieveMTPY */
+#ifdef TRANSFER_HACK
+                       facility_req(-1, 122, invoke_id); /* rejected by network */
+
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_TRANSFER);
+                       message->param.transfer.invoke = 1;
+                       message->param.transfer.invoke_id = invoke_id;
+                       message_put(message);
+#else
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_3PTY);
+                       message->param.threepty.retrieve = 1;
+                       message->param.threepty.invoke = 1;
+                       message->param.threepty.invoke_id = invoke_id;
+                       message_put(message);
+#endif
+                       return;
+
+               case 126: /* explicitCT */
+                       message = message_create(p_serial, ACTIVE_EPOINT(p_epointlist), PORT_TO_EPOINT, MESSAGE_TRANSFER);
+                       message->param.transfer.invoke = 1;
+                       message->param.transfer.invoke_id = invoke_id;
+                       message_put(message);
+                       return;
+               default:
+                       PDEBUG(DEBUG_GSM, "error: Unsupported Operation\n");
+                       facility_req(-1, 122, invoke_id); /* rejected by network */
+                       return;
+               }
+               break;
+       }
+}
+
+
+/* MESSAGE_3PTY */
+void Pgsm_bs::message_3pty(unsigned int epoint_id, int message_id, union parameter *param)
+{
+       if (param->threepty.result) {
+               if (param->threepty.begin)
+                       facility_req(124, -1, param->threepty.invoke_id); /* buildMPTY */
+               if (param->threepty.end)
+                       facility_req(121, -1, param->threepty.invoke_id); /* splitMPTY */
+       }
+       if (param->threepty.error) {
+               facility_req(-1, 122, param->threepty.invoke_id); /* rejected by network */
+       }
+}
+
+void Pgsm_bs::enc_ie_facility_ect(struct gsm_mncc *mncc, struct param_transfer *transfer)
+{
+       if (transfer->result) {
+               enc_ie_facility(mncc, 126, -1, transfer->invoke_id); /* explicitCT */
+       }
+       if (transfer->error) {
+               enc_ie_facility(mncc, -1, 122, transfer->invoke_id); /* rejected by network */
+       }
+}
+
+/* MESSAGE_TRANSFER */
+void Pgsm_bs::message_transfer(unsigned int epoint_id, int message_id, union parameter *param)
+{
+#ifdef TRANSFER_HACK
+       struct gsm_mncc *mncc;
+
+       /* sending facility */
+       gsm_trace_header(p_interface_name, this, MNCC_FACILITY_REQ, DIRECTION_OUT);
+       mncc = create_mncc(MNCC_FACILITY_REQ, p_g_callref);
+       enc_ie_facility_ect(mncc, &param->transfer);
+       gsm_trace_facility((unsigned char *)mncc->facility.info, mncc->facility.len);
+       end_trace();
+       send_and_free_mncc(p_g_lcr_gsm, mncc->msg_type, mncc);
+#endif
+}
+
 /*
  * handles all indications
  */
@@ -394,21 +676,21 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
        unsigned char payload_types[8];
        int payloads = 0;
 
-       interface = getinterfacebyname(p_g_interface_name);
+       interface = getinterfacebyname(p_interface_name);
        if (!interface) {
-               PERROR("Cannot find interface %s.\n", p_g_interface_name);
+               PERROR("Cannot find interface %s.\n", p_interface_name);
                return;
        }
 
        /* process given callref */
-       gsm_trace_header(p_g_interface_name, this, 0, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, 0, DIRECTION_IN);
        add_trace("callref", "new", "0x%x", callref);
        if (p_g_callref) {
                /* release in case the ID is already in use */
                add_trace("error", NULL, "callref already in use");
                end_trace();
                mncc = create_mncc(MNCC_REJ_REQ, callref);
-               gsm_trace_header(p_g_interface_name, this, MNCC_REJ_REQ, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_REJ_REQ, DIRECTION_OUT);
                mncc->fields |= MNCC_F_CAUSE;
                mncc->cause.coding = 3;
                mncc->cause.location = 1;
@@ -426,6 +708,8 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
        p_g_callref = callref;
        end_trace();
 
+       SCPY(p_g_imsi, mncc->imsi);
+
        /* caller info */
        if (mncc->clir.inv)
                p_callerinfo.present = INFO_PRESENT_RESTRICTED;
@@ -438,7 +722,7 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
        SCPY(p_callerinfo.imsi, mncc->imsi);
        p_callerinfo.screen = INFO_SCREEN_NETWORK;
        p_callerinfo.ntype = INFO_NTYPE_UNKNOWN;
-       SCPY(p_callerinfo.interface, p_g_interface_name);
+       SCPY(p_callerinfo.interface, p_interface_name);
 
        /* dialing information */
        SCAT(p_dialinginfo.id, mncc->called.number);
@@ -468,20 +752,12 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
        p_capainfo.source_mode = B_MODE_TRANSPARENT;
        p_g_mode = p_capainfo.source_mode;
 
-       /* get list of offered payload types
-        * if list ist empty, the FR V1 is selected */
+       /* get list of offered payload types */
        select_payload_type(mncc, payload_types, media_types, &payloads, sizeof(payload_types));
-       /* if no given payload type is supported, we assume  */
-       if (!payloads) {
-               media_types[0] = MEDIA_TYPE_GSM;
-               payload_types[0] = PAYLOAD_TYPE_GSM;
-               payloads = 1;
-       }
-#if 0
-       /* if no given payload type is supported, we reject the call */
+       /* if no given payload type is supported, we must release */
        if (!payloads) {
                mncc = create_mncc(MNCC_REJ_REQ, callref);
-               gsm_trace_header(p_g_interface_name, this, MNCC_REJ_REQ, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_REJ_REQ, DIRECTION_OUT);
                mncc->fields |= MNCC_F_CAUSE;
                mncc->cause.coding = 3;
                mncc->cause.location = 1;
@@ -489,19 +765,23 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
                add_trace("cause", "coding", "%d", mncc->cause.coding);
                add_trace("cause", "location", "%d", mncc->cause.location);
                add_trace("cause", "value", "%d", mncc->cause.value);
-               add_trace("reason", NULL, "Given speech codec(s) not supported");
+               add_trace("reason", NULL, "Given lchan not supported");
                end_trace();
                send_and_free_mncc(p_g_lcr_gsm, mncc->msg_type, mncc);
                new_state(PORT_STATE_RELEASE);
                trigger_work(&p_g_delete);
                return;
        }
+#if 0
+       /* if no given payload type is supported, we reject the call */
+       if (!payloads) {
+       }
 #endif
 
        /* useruser */
 
        /* what infos did we got ... */
-       gsm_trace_header(p_g_interface_name, this, msg_type, DIRECTION_IN);
+       gsm_trace_header(p_interface_name, this, msg_type, DIRECTION_IN);
        if (p_callerinfo.id[0])
                add_trace("calling", "number", "%s", p_callerinfo.id);
        else
@@ -523,7 +803,7 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
                modify_lchan(media_types[0]);
 
        /* send call proceeding */
-       gsm_trace_header(p_g_interface_name, this, MNCC_CALL_PROC_REQ, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_CALL_PROC_REQ, DIRECTION_OUT);
        proceeding = create_mncc(MNCC_CALL_PROC_REQ, p_g_callref);
        if (p_g_tones) {
                proceeding->fields |= MNCC_F_PROGRESS;
@@ -540,7 +820,7 @@ void Pgsm_bs::setup_ind(unsigned int msg_type, unsigned int callref, struct gsm_
        new_state(PORT_STATE_IN_PROCEEDING);
 
        if (p_g_tones && !p_g_tch_connected) { /* only if ... */
-               gsm_trace_header(p_g_interface_name, this, MNCC_FRAME_RECV, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_FRAME_RECV, DIRECTION_OUT);
                end_trace();
                frame = create_mncc(MNCC_FRAME_RECV, p_g_callref);
                send_and_free_mncc(p_g_lcr_gsm, frame->msg_type, frame);
@@ -607,6 +887,9 @@ int message_bsc(struct lcr_gsm *lcr_gsm, int msg_type, void *arg)
        }
 
        if (msg_type == GSM_TCHF_FRAME
+        || msg_type == GSM_TCHF_FRAME_EFR
+        || msg_type == GSM_TCHH_FRAME
+        || msg_type == GSM_TCH_FRAME_AMR
         || msg_type == GSM_BAD_FRAME) {
                if (port) {
                        /* inject DTMF, if enabled */
@@ -725,6 +1008,10 @@ int message_bsc(struct lcr_gsm *lcr_gsm, int msg_type, void *arg)
                pgsm_bs->retr_ind(msg_type, callref, mncc);
                break;
 
+               case MNCC_FACILITY_IND:
+               pgsm_bs->facility_ind(msg_type, callref, mncc);
+               break;
+
                default:
                PDEBUG(DEBUG_GSM, "Pgsm_bs(%s) gsm port with (caller id %s) received unhandled nessage: 0x%x\n", pgsm_bs->p_name, pgsm_bs->p_callerinfo.id, msg_type);
        }
@@ -737,6 +1024,14 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
        struct lcr_msg *message;
        struct epoint_list *epointlist;
        struct gsm_mncc *mncc;
+       struct interface *interface;
+       int page_with_tchh = 0;
+
+       interface = getinterfacebyname(p_interface_name);
+       if (!interface) {
+               PERROR("Cannot find interface %s.\n", p_interface_name);
+               return;
+       }
 
        /* copy setup infos to port */
        memcpy(&p_callerinfo, &param->setup.callerinfo, sizeof(p_callerinfo));
@@ -746,7 +1041,7 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
 
        /* no GSM MNCC connection */
        if (p_g_lcr_gsm->mncc_lfd.fd < 0) {
-               gsm_trace_header(p_g_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
                add_trace("failure", NULL, "No MNCC connection.");
                end_trace();
                message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
@@ -760,7 +1055,7 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
 
        /* no number */
        if (!p_dialinginfo.id[0]) {
-               gsm_trace_header(p_g_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
+               gsm_trace_header(p_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
                add_trace("failure", NULL, "No dialed subscriber given.");
                end_trace();
                message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
@@ -777,13 +1072,16 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
                int i;
 
                p_g_rtp_payloads = 0;
-               gsm_trace_header(p_g_interface_name, this, 1 /* codec negotioation */, DIRECTION_NONE);
+               gsm_trace_header(p_interface_name, this, 1 /* codec negotioation */, DIRECTION_NONE);
                for (i = 0; i < param->setup.rtpinfo.payloads; i++) {
                        switch (param->setup.rtpinfo.media_types[i]) {
-                       case MEDIA_TYPE_GSM:
-                       case MEDIA_TYPE_GSM_EFR:
                        case MEDIA_TYPE_AMR:
                        case MEDIA_TYPE_GSM_HR:
+                               /* because offered codecs are compatible with half rate, we can page with tchh */
+                               page_with_tchh = 1;
+                               // Fall through!
+                       case MEDIA_TYPE_GSM:
+                       case MEDIA_TYPE_GSM_EFR:
                                add_trace("rtp", "payload", "%s:%d supported", media_type2name(param->setup.rtpinfo.media_types[i]), param->setup.rtpinfo.payload_types[i]);
                                if (p_g_rtp_payloads < (int)sizeof(p_g_rtp_payload_types)) {
                                        p_g_rtp_media_types[p_g_rtp_payloads] = param->setup.rtpinfo.media_types[i];
@@ -797,7 +1095,7 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
                }
                end_trace();
                if (!p_g_rtp_payloads) {
-                       gsm_trace_header(p_g_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
+                       gsm_trace_header(p_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
                        add_trace("failure", NULL, "No payload given that is supported by GSM");
                        end_trace();
                        message = message_create(p_serial, epoint_id, PORT_TO_EPOINT, MESSAGE_RELEASE);
@@ -808,11 +1106,15 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
                        trigger_work(&p_g_delete);
                        return;
                }
+       } else {
+               /* since we support half rate compatible codecss, we can page with tchh */
+               if (p_g_hr_encoder || p_g_amr_encoder)
+                       page_with_tchh = 1;
        }
 
 //             SCPY(&p_m_tones_dir, param->setup.ext.tones_dir);
        /* screen outgoing caller id */
-       do_screen(1, p_callerinfo.id, sizeof(p_callerinfo.id), &p_callerinfo.ntype, &p_callerinfo.present, p_g_interface_name);
+       do_screen(1, p_callerinfo.id, sizeof(p_callerinfo.id), &p_callerinfo.ntype, &p_callerinfo.present, p_interface_name);
 
        /* attach only if not already */
        epointlist = p_epointlist;
@@ -825,12 +1127,12 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
                epointlist_new(epoint_id);
 
        /* creating l3id */
-       gsm_trace_header(p_g_interface_name, this, 0, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, 0, DIRECTION_OUT);
        p_g_callref = new_callref++;
        add_trace("callref", "new", "0x%x", p_g_callref);
        end_trace();
 
-       gsm_trace_header(p_g_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
+       gsm_trace_header(p_interface_name, this, MNCC_SETUP_REQ, DIRECTION_OUT);
        mncc = create_mncc(MNCC_SETUP_REQ, p_g_callref);
        /* caller information */
        mncc->fields |= MNCC_F_CALLING;
@@ -940,6 +1242,19 @@ void Pgsm_bs::message_setup(unsigned int epoint_id, int message_id, union parame
                add_trace("redir", "number", "%s", mncc->redirecting.number);
        }
 
+       /* if we support any half rate codec we page the mobile with TCH/H
+        * support indication. the mobile will reply paging with a channel
+        * request that indicates half rate support. if no SDCCH and TCH/F
+        * channel is available, BSC can assign a TCH/H channel, because it
+        * knows that the phone supports it. */
+       if (page_with_tchh) {
+               add_trace("lchan", "type", "TCH/H or TCH/F");
+               mncc->lchan_type = GSM_LCHAN_TCH_H;
+       } else {
+               add_trace("lchan", "type", "TCH/F");
+               mncc->lchan_type = GSM_LCHAN_TCH_F;
+       }
+
        end_trace();
        send_and_free_mncc(p_g_lcr_gsm, mncc->msg_type, mncc);
 
@@ -972,6 +1287,14 @@ int Pgsm_bs::message_epoint(unsigned int epoint_id, int message_id, union parame
                message_setup(epoint_id, message_id, param);
                break;
 
+               case MESSAGE_3PTY:
+               message_3pty(epoint_id, message_id, param);
+               break;
+
+               case MESSAGE_TRANSFER:
+               message_transfer(epoint_id, message_id, param);
+               break;
+
                default:
                PDEBUG(DEBUG_GSM, "Pgsm_bs(%s) gsm port with (caller id %s) received unhandled nessage: %d\n", p_name, p_callerinfo.id, message_id);
        }