bssgp_bvc_fsm: Add basic BVC flow control rx/tx support

The FSM doesn't actually implement the flow control logic,
it only decodes / dispatches and encodes messages.

Related: OS#4891
Change-Id: Ie59be6761177c43456898be9148727f15861a622
This commit is contained in:
Harald Welte 2020-12-08 21:15:45 +01:00
parent 4394bb9629
commit 1fcfce86cb
3 changed files with 44 additions and 2 deletions

View File

@ -4,6 +4,7 @@
struct gprs_ns2_inst;
struct osmo_fsm_inst;
struct gprs_ra_id;
struct bssgp2_flow_ctrl;
enum bssp_ptp_bvc_fsm_state {
BSSGP_BVCFSM_S_NULL,
@ -22,10 +23,13 @@ enum bssgp_ptp_bvc_fsm_event {
BSSGP_BVCFSM_E_RX_UNBLOCK_ACK,
BSSGP_BVCFSM_E_RX_RESET,
BSSGP_BVCFSM_E_RX_RESET_ACK,
BSSGP_BVCFSM_E_RX_FC_BVC,
BSSGP_BVCFSM_E_RX_FC_BVC_ACK,
/* Requests of the local user */
BSSGP_BVCFSM_E_REQ_BLOCK, /* data: uint8_t *cause */
BSSGP_BVCFSM_E_REQ_UNBLOCK,
BSSGP_BVCFSM_E_REQ_RESET, /* data: uint8_t *cause */
BSSGP_BVCFSM_E_REQ_FC_BVC, /* data: struct bssgp2_flow_ctrl */
};
struct bssgp_bvc_fsm_ops {
@ -35,6 +39,7 @@ struct bssgp_bvc_fsm_ops {
/* call-back notifying the user of a BVC-RESET event */
void (*reset_notification)(uint16_t nsei, uint16_t bvci, const struct gprs_ra_id *ra_id,
uint16_t cell_id, uint8_t cause, void *priv);
void (*rx_fc_bvc)(uint16_t nsei, uint16_t bvci, const struct bssgp2_flow_ctrl *fc, void *priv);
};
struct osmo_fsm_inst *

View File

@ -101,9 +101,12 @@ static const struct value_string ptp_bvc_event_names[] = {
{ BSSGP_BVCFSM_E_RX_UNBLOCK_ACK, "RX-BVC-UNBLOCK-ACK" },
{ BSSGP_BVCFSM_E_RX_RESET, "RX-BVC-RESET" },
{ BSSGP_BVCFSM_E_RX_RESET_ACK, "RX-BVC-RESET-ACK" },
{ BSSGP_BVCFSM_E_RX_FC_BVC, "RX-FLOW-CONTROL-BVC" },
{ BSSGP_BVCFSM_E_RX_FC_BVC_ACK, "RX-FLOW-CONTROL-BVC-ACK" },
{ BSSGP_BVCFSM_E_REQ_BLOCK, "REQ-BLOCK" },
{ BSSGP_BVCFSM_E_REQ_UNBLOCK, "REQ-UNBLOCK" },
{ BSSGP_BVCFSM_E_REQ_RESET, "REQ-RESET" },
{ BSSGP_BVCFSM_E_REQ_FC_BVC, "REQ-FLOW-CONTROL-BVC" },
{ 0, NULL }
};
@ -132,6 +135,8 @@ struct bvc_fsm_priv {
uint32_t advertised;
uint32_t received;
uint32_t negotiated;
/* only used if BSSGP_XFEAT_GBIT is negotiated */
enum bssgp_fc_granularity fc_granularity;
} features;
/* Cell Identification used by BSS when
@ -391,9 +396,11 @@ static void bssgp_bvc_fsm_wait_reset_ack(struct osmo_fsm_inst *fi, uint32_t even
static void bssgp_bvc_fsm_unblocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
{
struct bssgp2_flow_ctrl rx_fc, *tx_fc;
struct bvc_fsm_priv *bfp = fi->priv;
const struct tlv_parsed *tp = NULL;
struct msgb *rx = NULL, *tx;
int rc;
switch (event) {
case BSSGP_BVCFSM_E_RX_UNBLOCK_ACK:
@ -459,6 +466,33 @@ static void bssgp_bvc_fsm_unblocked(struct osmo_fsm_inst *fi, uint32_t event, vo
fi_tx_sig(fi, tx);
osmo_fsm_inst_state_chg(fi, BSSGP_BVCFSM_S_BLOCKED, T1_SECS, T1);
break;
case BSSGP_BVCFSM_E_RX_FC_BVC:
rx = data;
tp = (const struct tlv_parsed *) msgb_bcid(rx);
/* we assume osmo_tlv_prot_* has been used before calling here to ensure this */
OSMO_ASSERT(bfp->role_sgsn);
rc = bssgp2_dec_fc_bvc(&rx_fc, tp);
if (rc < 0) {
_tx_status(fi, BSSGP_CAUSE_SEM_INCORR_PDU, rx);
break;
}
if (bfp->ops->rx_fc_bvc)
bfp->ops->rx_fc_bvc(bfp->nsei, bfp->bvci, &rx_fc, bfp->ops_priv);
tx = bssgp2_enc_fc_bvc_ack(rx_fc.tag);
fi_tx_ptp(fi, tx);
break;
case BSSGP_BVCFSM_E_RX_FC_BVC_ACK:
rx = data;
tp = (const struct tlv_parsed *) msgb_bcid(rx);
/* we assume osmo_tlv_prot_* has been used before calling here to ensure this */
OSMO_ASSERT(!bfp->role_sgsn);
break;
case BSSGP_BVCFSM_E_REQ_FC_BVC:
tx_fc = data;
tx = bssgp2_enc_fc_bvc(tx_fc, bfp->features.negotiated & (BSSGP_XFEAT_GBIT << 8) ?
&bfp->features.fc_granularity : NULL);
fi_tx_ptp(fi, tx);
break;
}
}
@ -580,7 +614,10 @@ static const struct osmo_fsm_state bssgp_bvc_fsm_states[] = {
.in_event_mask = S(BSSGP_BVCFSM_E_RX_BLOCK) |
S(BSSGP_BVCFSM_E_RX_UNBLOCK) |
S(BSSGP_BVCFSM_E_RX_UNBLOCK_ACK) |
S(BSSGP_BVCFSM_E_REQ_BLOCK),
S(BSSGP_BVCFSM_E_REQ_BLOCK) |
S(BSSGP_BVCFSM_E_RX_FC_BVC) |
S(BSSGP_BVCFSM_E_RX_FC_BVC_ACK) |
S(BSSGP_BVCFSM_E_REQ_FC_BVC),
.out_state_mask = S(BSSGP_BVCFSM_S_BLOCKED) |
S(BSSGP_BVCFSM_S_WAIT_RESET_ACK) |
S(BSSGP_BVCFSM_S_UNBLOCKED),

View File

@ -437,7 +437,7 @@ struct msgb *bssgp2_enc_fc_ms_ack(uint32_t tlli, uint8_t tag)
return NULL;
bgph = (struct bssgp_normal_hdr *) msgb_put(msg, sizeof(*bgph));
bgph->pdu_type = BSSGP_PDUT_FLOW_CONTROL_BVC_ACK;
bgph->pdu_type = BSSGP_PDUT_FLOW_CONTROL_MS_ACK;
msgb_tvlv_put_32be(msg, BSSGP_IE_TLLI, tlli);
msgb_tvlv_put(msg, BSSGP_IE_TAG, 1, &tag);