diff options
author | Ivan Kluchnikov <kluchnikovi@gmail.com> | 2012-07-12 14:49:15 +0400 |
---|---|---|
committer | Ivan Kluchnikov <kluchnikovi@gmail.com> | 2012-07-12 14:49:15 +0400 |
commit | ef7f28cc7fe67e353821c5f88bc80d5120fec3ca (patch) | |
tree | ca1b24fafa82862b1d5cd38ce1434973033588f0 /src/gprs_bssgp_pcu.cpp | |
parent | c7e7f6868b6f24346424dee904f4e76d3f216ff4 (diff) | |
parent | e13fa2d56936d6bed8febcc41508a30e4a1038f0 (diff) |
Merge branch 'jolly_new'
Merge is based on jolly_new branch with two modifications.
1. Modified PCU L1 interface.
pcu_l1_if.cpp - common functions for tx and rx messages on L1 interface.
sysmo_sock.cpp - SYSMO-PCU socket functions.
openbts_sock.cpp - OpenBTS-PCU socket functions.
pcuif_proto.h - L1 interface's primitives.
2. Modified encoding of RLC/MAC Control messages, now we use structures and encode_gsm_rlcmac_downlink() function for encode control blocks (without hand-coding).
Diffstat (limited to 'src/gprs_bssgp_pcu.cpp')
-rw-r--r-- | src/gprs_bssgp_pcu.cpp | 291 |
1 files changed, 239 insertions, 52 deletions
diff --git a/src/gprs_bssgp_pcu.cpp b/src/gprs_bssgp_pcu.cpp index 2dfaba38..f9a421a5 100644 --- a/src/gprs_bssgp_pcu.cpp +++ b/src/gprs_bssgp_pcu.cpp @@ -23,19 +23,24 @@ struct sgsn_instance *sgsn; void *tall_bsc_ctx; -struct bssgp_bvc_ctx *bctx = btsctx_alloc(BVCI, NSEI); +struct bssgp_bvc_ctx *bctx = NULL; +struct gprs_nsvc *nsvc = NULL; +extern uint16_t spoof_mcc, spoof_mnc; int gprs_bssgp_pcu_rx_dl_ud(struct msgb *msg, struct tlv_parsed *tp) { struct bssgp_ud_hdr *budh; - int i = 0; - uint8_t trx, ts; - budh = (struct bssgp_ud_hdr *)msgb_bssgph(msg); - + int tfi; + uint32_t tlli; + int i, j; + uint8_t trx, ts; + uint8_t *data; + uint16_t len; struct gprs_rlcmac_tbf *tbf; - tbf = tbf_alloc(GPRS_RLCMAC_DL_TBF, ntohl(budh->tlli)); + budh = (struct bssgp_ud_hdr *)msgb_bssgph(msg); + tlli = ntohl(budh->tlli); if (!tbf) { @@ -44,31 +49,88 @@ int gprs_bssgp_pcu_rx_dl_ud(struct msgb *msg, struct tlv_parsed *tp) /* LLC_PDU is mandatory IE */ if (!TLVP_PRESENT(tp, BSSGP_IE_LLC_PDU)) { - LOGP(DBSSGP, LOGL_ERROR, "BSSGP TLLI=0x%08x Rx UL-UD missing mandatory IE\n", tbf->tlli); + LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD missing mandatory IE\n", tlli); return bssgp_tx_status(BSSGP_CAUSE_MISSING_MAND_IE, NULL, msg); } - tbf_dl_establish(tbf); + data = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_LLC_PDU); + len = TLVP_LEN(tp, BSSGP_IE_LLC_PDU); + if (len > sizeof(tbf->llc_frame)) + { + LOGP(DBSSGP, LOGL_NOTICE, "BSSGP TLLI=0x%08x Rx UL-UD IE_LLC_PDU too large\n", tlli); + return bssgp_tx_status(BSSGP_CAUSE_COND_IE_ERR, NULL, msg); + } - uint8_t *llc_pdu = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_LLC_PDU); - uint16_t llc_pdu_len = TLVP_LEN(tp, BSSGP_IE_LLC_PDU); - - tbf_dl_data_transfer(tbf, llc_pdu, llc_pdu_len); -} + /* read IMSI. if no IMSI exists, use first paging block (any paging), + * because during attachment the IMSI might not be known, so the MS + * will listen to all paging blocks. */ + char imsi[16] = "000"; + if (TLVP_PRESENT(tp, BSSGP_IE_IMSI)) + { + uint8_t imsi_len = TLVP_LEN(tp, BSSGP_IE_IMSI); + uint8_t *bcd_imsi = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_IMSI); + if ((bcd_imsi[0] & 0x08)) + imsi_len = imsi_len * 2 - 1; + else + imsi_len = (imsi_len - 1) * 2; + for (i = 0, j = 0; j < imsi_len && j < 16; j++) + { + if (!(j & 1)) { + imsi[j] = (bcd_imsi[i] >> 4) + '0'; + i++; + } else + imsi[j] = (bcd_imsi[i] & 0xf) + '0'; + } + imsi[j] = '\0'; + } + LOGP(DBSSGP, LOGL_INFO, "LLC [SGSN -> PCU] = TLLI: 0x%08x IMSI: %s len: %d\n", tlli, imsi, len); -int gprs_bssgp_pcu_rx_paging_ps(struct msgb *msg, struct tlv_parsed *tp) -{ - uint8_t *ptmsi = (uint8_t *) TLVP_VAL(tp, BSSGP_IE_TMSI); - uint16_t ptmsi_len = TLVP_LEN(tp, BSSGP_IE_TMSI); + /* check for existing TBF */ + if ((tbf = tbf_by_tlli(tlli, GPRS_RLCMAC_DL_TBF))) { + LOGP(DRLCMAC, LOGL_INFO, "TBF: APPEND TFI: %u TLLI: 0x%08x\n", tbf->tfi, tbf->tlli); + if (tbf->state == GPRS_RLCMAC_WAIT_RELEASE) { + LOGP(DRLCMAC, LOGL_DEBUG, "TBF in WAIT RELEASE state " + "(T3193), so reuse TBF\n"); + memcpy(tbf->llc_frame, data, len); + tbf->llc_length = len; + memset(&tbf->dir.dl, 0, sizeof(tbf->dir.dl)); /* reset + rlc states */ + gprs_rlcmac_trigger_downlink_assignment(tbf, 1, NULL); + } else { + /* the TBF exists, so we must write it in the queue */ + struct msgb *llc_msg = msgb_alloc(len, "llc_pdu_queue"); + if (!llc_msg) + return -ENOMEM; + memcpy(msgb_put(llc_msg, len), data, len); + msgb_enqueue(&tbf->llc_queue, llc_msg); + } + } else { + // Create new TBF + tfi = tfi_alloc(&trx, &ts); + if (tfi < 0) { + LOGP(DRLCMAC, LOGL_NOTICE, "No PDCH ressource\n"); + /* FIXME: send reject */ + return -EBUSY; + } + tbf = tbf_alloc(tfi, trx, ts); + tbf->direction = GPRS_RLCMAC_DL_TBF; + tbf->tlli = tlli; + tbf->tlli_valid = 1; - LOGP(DBSSGP, LOGL_NOTICE, " P-TMSI = "); - for (int i = 0; i < ptmsi_len; i++) - { - LOGPC(DBSSGP, LOGL_NOTICE, "%02x", ptmsi[i]); + LOGP(DRLCMAC, LOGL_DEBUG, "TBF: [DOWNLINK] START TFI: %u TLLI: 0x%08x \n", tbf->tfi, tbf->tlli); + + /* new TBF, so put first frame */ + memcpy(tbf->llc_frame, data, len); + tbf->llc_length = len; + + /* trigger downlink assignment and set state to ASSIGN. + * we don't use old_downlink, so the possible uplink is used + * to trigger downlink assignment. if there is no uplink, + * AGCH is used. */ + gprs_rlcmac_trigger_downlink_assignment(tbf, 0, imsi); } - LOGPC(DBSSGP, LOGL_NOTICE, "\n"); - gprs_rlcmac_paging_request(ptmsi, ptmsi_len); + return 0; } /* Receive a BSSGP PDU from a BSS on a PTP BVCI */ @@ -90,26 +152,26 @@ int gprs_bssgp_pcu_rx_ptp(struct msgb *msg, struct tlv_parsed *tp, struct bssgp_ switch (pdu_type) { case BSSGP_PDUT_DL_UNITDATA: - LOGP(DBSSGP, LOGL_NOTICE, "RX: [SGSN->PCU] BSSGP_PDUT_DL_UNITDATA\n"); + LOGP(DBSSGP, LOGL_DEBUG, "RX: [SGSN->PCU] BSSGP_PDUT_DL_UNITDATA\n"); gprs_bssgp_pcu_rx_dl_ud(msg, tp); break; case BSSGP_PDUT_PAGING_PS: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_PAGING_PS\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_PS\n"); break; case BSSGP_PDUT_PAGING_CS: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_PAGING_CS\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_CS\n"); break; case BSSGP_PDUT_RA_CAPA_UPDATE_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_RA_CAPA_UPDATE_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RA_CAPA_UPDATE_ACK\n"); break; case BSSGP_PDUT_FLOW_CONTROL_BVC_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_FLOW_CONTROL_BVC_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLOW_CONTROL_BVC_ACK\n"); break; case BSSGP_PDUT_FLOW_CONTROL_MS_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_FLOW_CONTROL_MS_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLOW_CONTROL_MS_ACK\n"); break; default: - DEBUGP(DBSSGP, "BSSGP BVCI=%u PDU type 0x%02x unknown\n", bctx->bvci, pdu_type); + LOGP(DBSSGP, LOGL_NOTICE, "BSSGP BVCI=%u PDU type 0x%02x unknown\n", bctx->bvci, pdu_type); rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg); break; } @@ -128,41 +190,40 @@ int gprs_bssgp_pcu_rx_sign(struct msgb *msg, struct tlv_parsed *tp, struct bssgp /* FIXME: send NM_STATUS.ind to NM */ break; case BSSGP_PDUT_SUSPEND_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_SUSPEND_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_ACK\n"); break; case BSSGP_PDUT_SUSPEND_NACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_SUSPEND_NACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_NACK\n"); break; case BSSGP_PDUT_BVC_RESET_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_BVC_RESET_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_BVC_RESET_ACK\n"); break; case BSSGP_PDUT_PAGING_PS: - LOGP(DBSSGP, LOGL_NOTICE, "RX: [SGSN->PCU] BSSGP_PDUT_PAGING_PS\n"); - gprs_bssgp_pcu_rx_paging_ps(msg, tp); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_PS\n"); break; case BSSGP_PDUT_PAGING_CS: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_PAGING_CS\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_PAGING_CS\n"); break; case BSSGP_PDUT_RESUME_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_RESUME_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RESUME_ACK\n"); break; case BSSGP_PDUT_RESUME_NACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_RESUME_NACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_RESUME_NACK\n"); break; case BSSGP_PDUT_FLUSH_LL: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_FLUSH_LL\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_FLUSH_LL\n"); break; case BSSGP_PDUT_BVC_BLOCK_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_SUSPEND_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SUSPEND_ACK\n"); break; case BSSGP_PDUT_BVC_UNBLOCK_ACK: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_BVC_UNBLOCK_ACK\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_BVC_UNBLOCK_ACK\n"); break; case BSSGP_PDUT_SGSN_INVOKE_TRACE: - LOGP(DBSSGP, LOGL_NOTICE, "rx BSSGP_PDUT_SGSN_INVOKE_TRACE\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BSSGP_PDUT_SGSN_INVOKE_TRACE\n"); break; default: - DEBUGP(DBSSGP, "BSSGP BVCI=%u Rx PDU type 0x%02x unknown\n", bctx->bvci, bgph->pdu_type); + LOGP(DBSSGP, LOGL_NOTICE, "BSSGP BVCI=%u Rx PDU type 0x%02x unknown\n", bctx->bvci, bgph->pdu_type); rc = bssgp_tx_status(BSSGP_CAUSE_PROTO_ERR_UNSPEC, NULL, msg); break; } @@ -178,6 +239,13 @@ int gprs_bssgp_pcu_rcvmsg(struct msgb *msg) uint16_t ns_bvci = msgb_bvci(msg); int data_len; int rc = 0; + struct bssgp_bvc_ctx *bctx; + + if (pdu_type == BSSGP_PDUT_STATUS) { + LOGP(DBSSGP, LOGL_NOTICE, "NSEI=%u/BVCI=%u received STATUS\n", + msgb_nsei(msg), ns_bvci); + return 0; + } /* Identifiers from DOWN: NSEI, BVCI (both in msg->cb) */ @@ -196,12 +264,6 @@ int gprs_bssgp_pcu_rcvmsg(struct msgb *msg) /* look-up or create the BTS context for this BVC */ bctx = btsctx_by_bvci_nsei(ns_bvci, msgb_nsei(msg)); - /* Only a RESET PDU can create a new BVC context */ - if (!bctx) - { - bctx = btsctx_alloc(ns_bvci, msgb_nsei(msg)); - } - if (!bctx && pdu_type != BSSGP_PDUT_BVC_RESET_ACK) { LOGP(DBSSGP, LOGL_NOTICE, "NSEI=%u/BVCI=%u Rejecting PDU " @@ -219,17 +281,17 @@ int gprs_bssgp_pcu_rcvmsg(struct msgb *msg) if (ns_bvci == BVCI_SIGNALLING) { - LOGP(DBSSGP, LOGL_NOTICE, "rx BVCI_SIGNALLING gprs_bssgp_rx_sign\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_SIGNALLING gprs_bssgp_rx_sign\n"); rc = gprs_bssgp_pcu_rx_sign(msg, &tp, bctx); } else if (ns_bvci == BVCI_PTM) { - LOGP(DBSSGP, LOGL_NOTICE, "rx BVCI_PTM bssgp_tx_status\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTM bssgp_tx_status\n"); rc = bssgp_tx_status(BSSGP_CAUSE_PDU_INCOMP_FEAT, NULL, msg); } else { - LOGP(DBSSGP, LOGL_NOTICE, "rx BVCI_PTP gprs_bssgp_rx_ptp\n"); + LOGP(DBSSGP, LOGL_DEBUG, "rx BVCI_PTP gprs_bssgp_rx_ptp\n"); rc = gprs_bssgp_pcu_rx_ptp(msg, &tp, bctx); } return rc; @@ -239,3 +301,128 @@ int bssgp_prim_cb(struct osmo_prim_hdr *oph, void *ctx) { return 0; } + +static int sgsn_ns_cb(enum gprs_ns_evt event, struct gprs_nsvc *nsvc, struct msgb *msg, uint16_t bvci) +{ + int rc = 0; + switch (event) { + case GPRS_NS_EVT_UNIT_DATA: + /* hand the message into the BSSGP implementation */ + rc = gprs_bssgp_pcu_rcvmsg(msg); + break; + default: + LOGP(DPCU, LOGL_NOTICE, "RLCMAC: Unknown event %u from NS\n", event); + if (msg) + talloc_free(msg); + rc = -EIO; + break; + } + return rc; +} + +static int nsvc_unblocked = 0; + +static int nsvc_signal_cb(unsigned int subsys, unsigned int signal, + void *handler_data, void *signal_data) +{ + struct ns_signal_data *nssd; + + if (subsys != SS_L_NS) + return -EINVAL; + + nssd = (struct ns_signal_data *)signal_data; + if (nssd->nsvc != nsvc) { + LOGP(DPCU, LOGL_ERROR, "Signal received of unknown NSVC\n"); + return -EINVAL; + } + + switch (signal) { + case S_NS_UNBLOCK: + if (!nsvc_unblocked) { + nsvc_unblocked = 1; + LOGP(DPCU, LOGL_NOTICE, "NS-VC is unblocked.\n"); + bssgp_tx_bvc_reset(bctx, bctx->bvci, + BSSGP_CAUSE_PROTO_ERR_UNSPEC); + } + break; + case S_NS_BLOCK: + if (nsvc_unblocked) { + nsvc_unblocked = 0; + LOGP(DPCU, LOGL_NOTICE, "NS-VC is blocked.\n"); + } + break; + } + + return 0; +} + +/* create BSSGP/NS layer instances */ +int gprs_bssgp_create(uint32_t sgsn_ip, uint16_t sgsn_port, uint16_t nsei, + uint16_t nsvci, uint16_t bvci, uint16_t mcc, uint16_t mnc, uint16_t lac, + uint16_t rac, uint16_t cell_id) +{ + struct sockaddr_in dest; + + if (bctx) + return 0; /* if already created, must return 0: no error */ + + bssgp_nsi = gprs_ns_instantiate(&sgsn_ns_cb, NULL); + if (!bssgp_nsi) { + LOGP(DBSSGP, LOGL_ERROR, "Failed to create NS instance\n"); + return -EINVAL; + } + gprs_ns_nsip_listen(bssgp_nsi); + + dest.sin_family = AF_INET; + dest.sin_port = htons(sgsn_port); + dest.sin_addr.s_addr = htonl(sgsn_ip); + + nsvc = gprs_ns_nsip_connect(bssgp_nsi, &dest, nsei, nsvci); + if (!nsvc) { + LOGP(DBSSGP, LOGL_ERROR, "Failed to create NSVCt\n"); + gprs_ns_destroy(bssgp_nsi); + bssgp_nsi = NULL; + return -EINVAL; + } + + bctx = btsctx_alloc(bvci, nsei); + if (!bctx) { + LOGP(DBSSGP, LOGL_ERROR, "Failed to create BSSGP context\n"); + nsvc = NULL; + gprs_ns_destroy(bssgp_nsi); + bssgp_nsi = NULL; + return -EINVAL; + } + bctx->ra_id.mcc = spoof_mcc ? : mcc; + bctx->ra_id.mnc = spoof_mnc ? : mnc; + bctx->ra_id.lac = lac; + bctx->ra_id.rac = rac; + bctx->cell_id = cell_id; + + osmo_signal_register_handler(SS_L_NS, nsvc_signal_cb, NULL); + +// bssgp_tx_bvc_reset(bctx, bctx->bvci, BSSGP_CAUSE_PROTO_ERR_UNSPEC); + + return 0; +} + +void gprs_bssgp_destroy(void) +{ + if (!bssgp_nsi) + return; + + osmo_signal_unregister_handler(SS_L_NS, nsvc_signal_cb, NULL); + + nsvc = NULL; + + /* FIXME: move this to libgb: btsctx_free() */ + llist_del(&bctx->list); + talloc_free(bctx); + bctx = NULL; + + /* FIXME: blocking... */ + + gprs_ns_destroy(bssgp_nsi); + bssgp_nsi = NULL; +} + |