blob: 839bf6f18c73dd23ae41e6ad2f5cda83e1ca5ab0 [file] [log] [blame]
Alexander Couzens6a161492020-07-12 13:45:50 +02001/*! \file gprs_ns2_vc_fsm.c
2 * NS virtual circuit FSM implementation
3 * 3GPP TS 08.16 version 8.0.1 Release 1999 / ETSI TS 101 299 V8.0.1 (2002-05)
4 * as well as its successor 3GPP TS 48.016 */
5
6/* (C) 2020 sysmocom - s.f.m.c. GmbH
7 * Author: Alexander Couzens <lynxis@fe80.eu>
8 *
9 * All Rights Reserved
10 *
11 * SPDX-License-Identifier: GPL-2.0+
12 *
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License as published by
15 * the Free Software Foundation; either version 2 of the License, or
16 * (at your option) any later version.
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License
24 * along with this program. If not, see <http://www.gnu.org/licenses/>.
25 *
26 */
27
28/* The BSS NSE only has one SGSN IP address configured, and it will use the SNS procedures
29 * to communicated its local IPs/ports as well as all the SGSN side IPs/ports and
30 * associated weights. In theory, the BSS then uses this to establish a full mesh
31 * of NSVCs between all BSS-side IPs/ports and SGSN-side IPs/ports */
32
33#include <errno.h>
34
35#include <netinet/in.h>
36#include <arpa/inet.h>
37
38#include <osmocom/core/fsm.h>
39#include <osmocom/core/msgb.h>
40#include <osmocom/core/rate_ctr.h>
41#include <osmocom/core/socket.h>
42#include <osmocom/core/stat_item.h>
43#include <osmocom/gsm/prim.h>
44#include <osmocom/gsm/tlv.h>
45#include <osmocom/gprs/gprs_msgb.h>
46#include <osmocom/gprs/protocol/gsm_08_16.h>
47
48#include "gprs_ns2_internal.h"
49
50#define S(x) (1 << (x))
51
52#define DNS 10
53
54struct gprs_ns2_vc_priv {
55 struct gprs_ns2_vc *nsvc;
56 /* how often the timer was triggered */
57 int N;
Daniel Willmannf5b2e282020-11-18 18:51:25 +010058 /* The initiator is responsible to UNBLOCK the VC. The BSS is usually the initiator.
59 * It can change during runtime. The side which blocks an unblocked side.*/
Alexander Couzensea01bf22021-01-18 14:01:01 +010060 bool initiator;
Daniel Willmannf5b2e282020-11-18 18:51:25 +010061 bool initiate_block;
62 bool initiate_reset;
Alexander Couzens47afc422021-01-17 20:12:46 +010063 /* if blocked by O&M/vty */
64 bool om_blocked;
65 /* if unitdata is forwarded to the user */
66 bool accept_unitdata;
Alexander Couzens6a161492020-07-12 13:45:50 +020067
68 /* the alive counter is present in all states */
69 struct {
70 struct osmo_timer_list timer;
71 enum ns2_timeout mode;
72 int N;
73 struct timeval timer_started;
74 } alive;
75};
76
77
78/* The FSM covers both the VC with RESET/BLOCK and without RESET/BLOCK procedure..
79 *
80 * With RESET/BLOCK, the state should follow:
81 * - UNCONFIGURED -> RESET -> BLOCK -> UNBLOCKED
82 *
83 * Without RESET/BLOCK, the state should follow:
84 * - UNCONFIGURED -> ALIVE -> UNBLOCKED
85 *
86 * The UNBLOCKED and TEST states are used to send ALIVE PDU using the timeout Tns-test and Tns-alive.
87 * UNBLOCKED -> TEST: on expire of Tns-Test, send Alive PDU.
88 * TEST -> UNBLOCKED: on receive of Alive_Ack PDU, go into UNBLOCKED.
89 *
90 * The ALIVE state is used as intermediate, because a VC is only valid if it received an Alive ACK when
91 * not using RESET/BLOCK procedure.
92 */
93
94enum gprs_ns2_vc_state {
95 GPRS_NS2_ST_UNCONFIGURED,
96 GPRS_NS2_ST_RESET,
97 GPRS_NS2_ST_BLOCKED,
98 GPRS_NS2_ST_UNBLOCKED, /* allows sending NS_UNITDATA */
99
100 GPRS_NS2_ST_ALIVE, /* only used when not using RESET/BLOCK procedure */
101};
102
103enum gprs_ns2_vc_event {
Alexander Couzensf5775432021-01-18 13:49:00 +0100104 GPRS_NS2_EV_REQ_START,
Alexander Couzens6a161492020-07-12 13:45:50 +0200105
106 /* received messages */
Alexander Couzensf5775432021-01-18 13:49:00 +0100107 GPRS_NS2_EV_RX_RESET,
108 GPRS_NS2_EV_RX_RESET_ACK,
109 GPRS_NS2_EV_RX_UNBLOCK,
110 GPRS_NS2_EV_RX_UNBLOCK_ACK,
111 GPRS_NS2_EV_RX_BLOCK,
112 GPRS_NS2_EV_RX_BLOCK_ACK,
113 GPRS_NS2_EV_RX_ALIVE,
114 GPRS_NS2_EV_RX_ALIVE_ACK,
115 GPRS_NS2_EV_RX_STATUS,
Alexander Couzens6a161492020-07-12 13:45:50 +0200116
Alexander Couzensf5775432021-01-18 13:49:00 +0100117 GPRS_NS2_EV_RX_UNITDATA,
Daniel Willmanned0c9822020-11-18 14:08:07 +0100118
Alexander Couzensf5775432021-01-18 13:49:00 +0100119 GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED, /* called via vty for tests */
120 GPRS_NS2_EV_REQ_OM_BLOCK, /* vty cmd: block */
121 GPRS_NS2_EV_REQ_OM_UNBLOCK, /* vty cmd: unblock*/
Alexander Couzens6a161492020-07-12 13:45:50 +0200122};
123
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100124static const struct value_string ns2_vc_event_names[] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100125 { GPRS_NS2_EV_REQ_START, "START" },
126 { GPRS_NS2_EV_RX_RESET, "RESET" },
127 { GPRS_NS2_EV_RX_RESET_ACK, "RESET_ACK" },
128 { GPRS_NS2_EV_RX_UNBLOCK, "UNBLOCK" },
129 { GPRS_NS2_EV_RX_UNBLOCK_ACK, "UNBLOCK_ACK" },
130 { GPRS_NS2_EV_RX_BLOCK, "BLOCK" },
131 { GPRS_NS2_EV_RX_BLOCK_ACK, "BLOCK_ACK" },
132 { GPRS_NS2_EV_RX_ALIVE, "ALIVE" },
133 { GPRS_NS2_EV_RX_ALIVE_ACK, "ALIVE_ACK" },
134 { GPRS_NS2_EV_RX_STATUS, "STATUS" },
135 { GPRS_NS2_EV_RX_UNITDATA, "UNITDATA" },
136 { GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED, "FORCE_UNCONFIGURED" },
Alexander Couzens47afc422021-01-17 20:12:46 +0100137 { GPRS_NS2_EV_REQ_OM_BLOCK, "REQ-O&M-BLOCK"},
138 { GPRS_NS2_EV_REQ_OM_UNBLOCK, "REQ-O&M-UNBLOCK"},
Alexander Couzens6a161492020-07-12 13:45:50 +0200139 { 0, NULL }
140};
141
142static inline struct gprs_ns2_inst *ns_inst_from_fi(struct osmo_fsm_inst *fi)
143{
144 struct gprs_ns2_vc_priv *priv = fi->priv;
145 return priv->nsvc->nse->nsi;
146}
147
148static void start_test_procedure(struct gprs_ns2_vc_priv *priv)
149{
150 struct gprs_ns2_inst *nsi = priv->nsvc->nse->nsi;
151
152 if (osmo_timer_pending(&priv->alive.timer))
153 return;
154
155 priv->alive.mode = NS_TOUT_TNS_ALIVE;
156 priv->alive.N = 0;
157
158 osmo_gettimeofday(&priv->alive.timer_started, NULL);
159 ns2_tx_alive(priv->nsvc);
160 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
161}
162
163static void stop_test_procedure(struct gprs_ns2_vc_priv *priv)
164{
165 osmo_timer_del(&priv->alive.timer);
166}
167
168static int alive_timer_elapsed_ms(struct gprs_ns2_vc_priv *priv)
169{
170 struct timeval now, elapsed;
171 osmo_gettimeofday(&now, NULL);
172 timersub(&now, &priv->alive.timer_started, &elapsed);
173
174 return 1000 * elapsed.tv_sec + elapsed.tv_usec / 1000;
175}
176
177static void recv_test_procedure(struct osmo_fsm_inst *fi)
178{
179 struct gprs_ns2_vc_priv *priv = fi->priv;
180 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
181 struct gprs_ns2_vc *nsvc = priv->nsvc;
182
183 /* ignoring ACKs without sending an ALIVE */
184 if (priv->alive.mode != NS_TOUT_TNS_ALIVE)
185 return;
186
187 priv->alive.mode = NS_TOUT_TNS_TEST;
188 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
189 osmo_stat_item_set(nsvc->statg->items[NS_STAT_ALIVE_DELAY],
190 alive_timer_elapsed_ms(priv));
191}
192
193
194static void alive_timeout_handler(void *data)
195{
196 struct osmo_fsm_inst *fi = data;
197 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
198 struct gprs_ns2_vc_priv *priv = fi->priv;
199
200 switch (priv->alive.mode) {
201 case NS_TOUT_TNS_TEST:
202 priv->alive.mode = NS_TOUT_TNS_ALIVE;
203 ns2_tx_alive(priv->nsvc);
204 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
205 break;
206 case NS_TOUT_TNS_ALIVE:
Harald Welte4c54f592021-01-30 22:42:15 +0100207 rate_ctr_inc(&priv->nsvc->ctrg->ctr[NS_CTR_LOST_ALIVE]);
Alexander Couzens6a161492020-07-12 13:45:50 +0200208 priv->alive.N++;
209
210 if (priv->alive.N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
211 /* retransmission */
212 ns2_tx_alive(priv->nsvc);
213 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
214 } else {
215 /* lost connection */
Alexander Couzens138b96f2021-01-25 16:23:29 +0100216 if (priv->nsvc->mode == GPRS_NS2_VC_MODE_BLOCKRESET) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200217 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
218 } else {
219 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
220 }
221 }
222 break;
223 default:
224 break;
225 }
226}
227
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100228static void ns2_st_unconfigured(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200229{
230 struct gprs_ns2_vc_priv *priv = fi->priv;
231 struct gprs_ns2_inst *nsi = priv->nsvc->nse->nsi;
232
Alexander Couzensea01bf22021-01-18 14:01:01 +0100233 priv->initiate_reset = priv->initiate_block = priv->initiator;
234 priv->om_blocked = false;
235
Alexander Couzens6a161492020-07-12 13:45:50 +0200236 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100237 case GPRS_NS2_EV_REQ_START:
Alexander Couzens6a161492020-07-12 13:45:50 +0200238 switch (priv->nsvc->mode) {
Alexander Couzens138b96f2021-01-25 16:23:29 +0100239 case GPRS_NS2_VC_MODE_ALIVE:
Alexander Couzens6a161492020-07-12 13:45:50 +0200240 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, nsi->timeout[NS_TOUT_TNS_ALIVE], NS_TOUT_TNS_ALIVE);
241 break;
Alexander Couzens138b96f2021-01-25 16:23:29 +0100242 case GPRS_NS2_VC_MODE_BLOCKRESET:
Alexander Couzens6a161492020-07-12 13:45:50 +0200243 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
244 break;
245 }
246
247 break;
248 default:
249 OSMO_ASSERT(0);
250 }
251}
252
253
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100254static void ns2_st_reset_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200255{
256 struct gprs_ns2_vc_priv *priv = fi->priv;
257
258 if (old_state != GPRS_NS2_ST_RESET)
259 priv->N = 0;
260
Alexander Couzens47afc422021-01-17 20:12:46 +0100261 priv->accept_unitdata = false;
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100262 if (priv->initiate_reset)
Alexander Couzens6a161492020-07-12 13:45:50 +0200263 ns2_tx_reset(priv->nsvc, NS_CAUSE_OM_INTERVENTION);
264
265 stop_test_procedure(priv);
266 ns2_nse_notify_unblocked(priv->nsvc, false);
267}
268
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100269static void ns2_st_reset(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200270{
271 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
272 struct gprs_ns2_vc_priv *priv = fi->priv;
273
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100274 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200275 switch (event) {
Alexander Couzens273f0632021-01-20 13:11:26 +0100276 case GPRS_NS2_EV_RX_RESET:
277 ns2_tx_reset_ack(priv->nsvc);
278 /* fall-through */
Alexander Couzensf5775432021-01-18 13:49:00 +0100279 case GPRS_NS2_EV_RX_RESET_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200280 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
281 nsi->timeout[NS_TOUT_TNS_BLOCK], NS_TOUT_TNS_BLOCK);
282 break;
283 }
284 } else {
285 /* we are on the receiving end */
286 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100287 case GPRS_NS2_EV_RX_RESET:
Alexander Couzens6a161492020-07-12 13:45:50 +0200288 ns2_tx_reset_ack(priv->nsvc);
289 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
290 0, 0);
291 break;
292 }
293 }
294}
295
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100296static void ns2_st_blocked_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200297{
298 struct gprs_ns2_vc_priv *priv = fi->priv;
299
Harald Welte4c54f592021-01-30 22:42:15 +0100300 if (old_state != GPRS_NS2_ST_BLOCKED) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200301 priv->N = 0;
Harald Welte4c54f592021-01-30 22:42:15 +0100302 rate_ctr_inc(&priv->nsvc->ctrg->ctr[NS_CTR_BLOCKED]);
303 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200304
Alexander Couzens47afc422021-01-17 20:12:46 +0100305 if (priv->om_blocked) {
306 /* we are already blocked after a RESET */
307 if (old_state == GPRS_NS2_ST_RESET) {
308 osmo_timer_del(&fi->timer);
309 } else {
310 ns2_tx_block(priv->nsvc, NS_CAUSE_OM_INTERVENTION);
311 }
312 } else if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200313 ns2_tx_unblock(priv->nsvc);
Alexander Couzens47afc422021-01-17 20:12:46 +0100314 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200315
316 start_test_procedure(priv);
317}
318
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100319static void ns2_st_blocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200320{
321 struct gprs_ns2_vc_priv *priv = fi->priv;
322
Alexander Couzens47afc422021-01-17 20:12:46 +0100323 if (priv->om_blocked) {
324 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100325 case GPRS_NS2_EV_RX_BLOCK_ACK:
Alexander Couzens47afc422021-01-17 20:12:46 +0100326 priv->accept_unitdata = false;
327 osmo_timer_del(&fi->timer);
328 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100329 case GPRS_NS2_EV_RX_BLOCK:
Alexander Couzens47afc422021-01-17 20:12:46 +0100330 priv->accept_unitdata = false;
331 ns2_tx_block_ack(priv->nsvc);
332 osmo_timer_del(&fi->timer);
333 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100334 case GPRS_NS2_EV_RX_UNBLOCK:
Alexander Couzens47afc422021-01-17 20:12:46 +0100335 priv->accept_unitdata = false;
336 ns2_tx_block(priv->nsvc, NS_CAUSE_OM_INTERVENTION);
337 osmo_timer_add(&fi->timer);
338 break;
339 }
340 } else if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200341 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100342 case GPRS_NS2_EV_RX_BLOCK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200343 /* TODO: BLOCK is a UNBLOCK_NACK */
344 ns2_tx_block_ack(priv->nsvc);
345 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100346 case GPRS_NS2_EV_RX_UNBLOCK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200347 ns2_tx_unblock_ack(priv->nsvc);
348 /* fall through */
Alexander Couzensf5775432021-01-18 13:49:00 +0100349 case GPRS_NS2_EV_RX_UNBLOCK_ACK:
Alexander Couzens47afc422021-01-17 20:12:46 +0100350 priv->accept_unitdata = true;
Alexander Couzens6a161492020-07-12 13:45:50 +0200351 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED,
352 0, NS_TOUT_TNS_TEST);
353 break;
354 }
355 } else {
356 /* we are on the receiving end. The initiator who sent RESET is responsible to UNBLOCK! */
357 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100358 case GPRS_NS2_EV_RX_BLOCK:
Alexander Couzens856b94c2021-01-19 19:42:17 +0100359 ns2_tx_block_ack(priv->nsvc);
360 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100361 case GPRS_NS2_EV_RX_UNBLOCK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200362 ns2_tx_unblock_ack(priv->nsvc);
363 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED,
364 0, 0);
365 break;
366 }
367 }
368}
369
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100370static void ns2_st_unblocked_on_enter(struct osmo_fsm_inst *fi, uint32_t old_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200371{
372 struct gprs_ns2_vc_priv *priv = fi->priv;
Daniel Willmann15c09a82020-11-03 23:05:43 +0100373 struct gprs_ns2_vc *nsvc = priv->nsvc;
374 struct gprs_ns2_nse *nse = nsvc->nse;
Alexander Couzens6a161492020-07-12 13:45:50 +0200375
Harald Welteb40bf8b2021-01-30 22:43:01 +0100376 if (old_state != GPRS_NS2_ST_UNBLOCKED)
377 rate_ctr_inc(&nsvc->ctrg->ctr[NS_CTR_UNBLOCKED]);
378
Alexander Couzens47afc422021-01-17 20:12:46 +0100379 priv->accept_unitdata = true;
Daniel Willmann15c09a82020-11-03 23:05:43 +0100380 ns2_nse_notify_unblocked(nsvc, true);
Alexander Couzens138b96f2021-01-25 16:23:29 +0100381 ns2_prim_status_ind(nse, nsvc, 0, GPRS_NS2_AFF_CAUSE_VC_RECOVERY);
Alexander Couzens6a161492020-07-12 13:45:50 +0200382}
383
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100384static void ns2_st_unblocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200385{
386 struct gprs_ns2_vc_priv *priv = fi->priv;
387
388 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100389 case GPRS_NS2_EV_RX_UNBLOCK:
Alexander Couzensc4b74622021-01-10 20:44:26 +0100390 ns2_tx_unblock_ack(priv->nsvc);
391 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100392 case GPRS_NS2_EV_RX_BLOCK:
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100393 priv->initiate_block = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200394 ns2_tx_block_ack(priv->nsvc);
395 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
396 0, 2);
397 break;
398 }
399}
400
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100401static void ns2_st_alive(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200402{
403 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100404 case GPRS_NS2_EV_RX_ALIVE_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200405 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED, 0, 0);
406 break;
407 }
408}
409
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100410static void ns2_st_alive_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200411{
412 struct gprs_ns2_vc_priv *priv = fi->priv;
413 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
414
415 priv->alive.mode = NS_TOUT_TNS_TEST;
416 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
417
418 if (old_state != GPRS_NS2_ST_ALIVE)
419 priv->N = 0;
420
421 ns2_tx_alive(priv->nsvc);
422 ns2_nse_notify_unblocked(priv->nsvc, false);
423}
424
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100425static void ns2_st_alive_onleave(struct osmo_fsm_inst *fi, uint32_t next_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200426{
427 start_test_procedure(fi->priv);
428}
429
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100430static const struct osmo_fsm_state ns2_vc_states[] = {
Alexander Couzens6a161492020-07-12 13:45:50 +0200431 [GPRS_NS2_ST_UNCONFIGURED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100432 .in_event_mask = S(GPRS_NS2_EV_REQ_START),
Alexander Couzens6a161492020-07-12 13:45:50 +0200433 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE),
434 .name = "UNCONFIGURED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100435 .action = ns2_st_unconfigured,
Alexander Couzens6a161492020-07-12 13:45:50 +0200436 },
437 [GPRS_NS2_ST_RESET] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100438 .in_event_mask = S(GPRS_NS2_EV_RX_RESET_ACK) | S(GPRS_NS2_EV_RX_RESET),
Alexander Couzens6a161492020-07-12 13:45:50 +0200439 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100440 S(GPRS_NS2_ST_BLOCKED) |
441 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200442 .name = "RESET",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100443 .action = ns2_st_reset,
444 .onenter = ns2_st_reset_onenter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200445 },
446 [GPRS_NS2_ST_BLOCKED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100447 .in_event_mask = S(GPRS_NS2_EV_RX_BLOCK) | S(GPRS_NS2_EV_RX_BLOCK_ACK) |
448 S(GPRS_NS2_EV_RX_UNBLOCK) | S(GPRS_NS2_EV_RX_UNBLOCK_ACK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200449 .out_state_mask = S(GPRS_NS2_ST_RESET) |
450 S(GPRS_NS2_ST_UNBLOCKED) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100451 S(GPRS_NS2_ST_BLOCKED) |
452 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200453 .name = "BLOCKED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100454 .action = ns2_st_blocked,
455 .onenter = ns2_st_blocked_onenter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200456 },
457 [GPRS_NS2_ST_UNBLOCKED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100458 .in_event_mask = S(GPRS_NS2_EV_RX_BLOCK) | S(GPRS_NS2_EV_RX_UNBLOCK_ACK) |
459 S(GPRS_NS2_EV_RX_UNBLOCK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200460 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100461 S(GPRS_NS2_ST_BLOCKED) |
462 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200463 .name = "UNBLOCKED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100464 .action = ns2_st_unblocked,
465 .onenter = ns2_st_unblocked_on_enter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200466 },
467
468 /* ST_ALIVE is only used on VC without RESET/BLOCK */
469 [GPRS_NS2_ST_ALIVE] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100470 .in_event_mask = S(GPRS_NS2_EV_RX_ALIVE_ACK),
Alexander Couzens191c2d72021-01-19 17:59:45 +0100471 .out_state_mask = S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100472 S(GPRS_NS2_ST_UNBLOCKED) |
473 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200474 .name = "ALIVE",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100475 .action = ns2_st_alive,
476 .onenter = ns2_st_alive_onenter,
477 .onleave = ns2_st_alive_onleave,
Alexander Couzens6a161492020-07-12 13:45:50 +0200478 },
479};
480
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100481static int ns2_vc_fsm_timer_cb(struct osmo_fsm_inst *fi)
Alexander Couzens6a161492020-07-12 13:45:50 +0200482{
483 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
484 struct gprs_ns2_vc_priv *priv = fi->priv;
485
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100486 switch (fi->state) {
487 case GPRS_NS2_ST_RESET:
488 if (priv->initiate_reset) {
Harald Welte4c54f592021-01-30 22:42:15 +0100489 rate_ctr_inc(&priv->nsvc->ctrg->ctr[NS_CTR_LOST_RESET]);
Alexander Couzens6a161492020-07-12 13:45:50 +0200490 priv->N++;
491 if (priv->N <= nsi->timeout[NS_TOUT_TNS_RESET_RETRIES]) {
492 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
493 } else {
494 priv->N = 0;
495 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
496 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100497 }
498 break;
499 case GPRS_NS2_ST_BLOCKED:
500 if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200501 priv->N++;
Alexander Couzens47afc422021-01-17 20:12:46 +0100502 if (priv->om_blocked) {
503 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
504 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
505 } else {
506 /* 7.2 stop accepting data when BLOCK PDU not responded */
507 priv->accept_unitdata = false;
508 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200509 } else {
Alexander Couzens47afc422021-01-17 20:12:46 +0100510 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
511 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
512 } else {
513 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
514 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200515 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100516 }
517 break;
518 case GPRS_NS2_ST_ALIVE:
519 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200520 priv->N++;
521 if (priv->N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
522 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
523 } else {
524 priv->N = 0;
525 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
526 }
527 break;
528 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100529 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200530 }
531 return 0;
532}
533
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100534static void ns2_recv_unitdata(struct osmo_fsm_inst *fi,
Alexander Couzens6a161492020-07-12 13:45:50 +0200535 struct msgb *msg)
536{
537 struct gprs_ns2_vc_priv *priv = fi->priv;
538 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
539 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
540 struct osmo_gprs_ns2_prim nsp = {};
541 uint16_t bvci;
542
Alexander Couzenscce88282020-10-26 00:25:50 +0100543 if (msgb_l2len(msg) < sizeof(*nsh) + 3) {
544 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200545 return;
Alexander Couzenscce88282020-10-26 00:25:50 +0100546 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200547
548 /* TODO: 7.1: For an IP sub-network, an NS-UNITDATA PDU
549 * for a PTP BVC may indicate a request to change the IP endpoint
550 * and/or a response to a change in the IP endpoint. */
551
552 /* TODO: nsh->data[0] -> C/R only valid in IP SNS */
553 bvci = nsh->data[1] << 8 | nsh->data[2];
554
Alexander Couzens89acdef2020-09-23 18:22:31 +0200555 msg->l3h = &nsh->data[3];
556 nsp.bvci = bvci;
557 nsp.nsei = priv->nsvc->nse->nsei;
Alexander Couzens6a161492020-07-12 13:45:50 +0200558
Alexander Couzensc1cd3332020-09-23 23:24:02 +0200559 /* 10.3.9 NS SDU Control Bits */
560 if (nsh->data[0] & 0x1)
Alexander Couzens138b96f2021-01-25 16:23:29 +0100561 nsp.u.unitdata.change = GPRS_NS2_ENDPOINT_REQUEST_CHANGE;
Alexander Couzens6a161492020-07-12 13:45:50 +0200562
Alexander Couzens138b96f2021-01-25 16:23:29 +0100563 osmo_prim_init(&nsp.oph, SAP_NS, GPRS_NS2_PRIM_UNIT_DATA,
Alexander Couzens6a161492020-07-12 13:45:50 +0200564 PRIM_OP_INDICATION, msg);
565 nsi->cb(&nsp.oph, nsi->cb_data);
566}
567
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100568static void ns2_vc_fsm_allstate_action(struct osmo_fsm_inst *fi,
Alexander Couzens6a161492020-07-12 13:45:50 +0200569 uint32_t event,
570 void *data)
571{
572 struct gprs_ns2_vc_priv *priv = fi->priv;
573 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
Alexander Couzenscce88282020-10-26 00:25:50 +0100574 struct msgb *msg = data;
Alexander Couzens6a161492020-07-12 13:45:50 +0200575
576 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100577 case GPRS_NS2_EV_RX_RESET:
Alexander Couzens138b96f2021-01-25 16:23:29 +0100578 if (priv->nsvc->mode != GPRS_NS2_VC_MODE_BLOCKRESET)
Alexander Couzens6a161492020-07-12 13:45:50 +0200579 break;
580
581 /* move the FSM into reset */
582 if (fi->state != GPRS_NS2_ST_RESET) {
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100583 priv->initiate_reset = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200584 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
585 }
586 /* pass the event down into FSM action */
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100587 ns2_st_reset(fi, event, data);
Alexander Couzens6a161492020-07-12 13:45:50 +0200588 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100589 case GPRS_NS2_EV_RX_ALIVE:
Alexander Couzens6a161492020-07-12 13:45:50 +0200590 switch (fi->state) {
591 case GPRS_NS2_ST_UNCONFIGURED:
592 case GPRS_NS2_ST_RESET:
593 /* ignore ALIVE */
594 break;
595 default:
596 ns2_tx_alive_ack(priv->nsvc);
597 }
598 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100599 case GPRS_NS2_EV_RX_ALIVE_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200600 /* for VCs without RESET/BLOCK/UNBLOCK, the connections comes after ALIVE_ACK unblocked */
601 if (fi->state == GPRS_NS2_ST_ALIVE)
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100602 ns2_st_alive(fi, event, data);
Alexander Couzens6a161492020-07-12 13:45:50 +0200603 else
604 recv_test_procedure(fi);
605 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100606 case GPRS_NS2_EV_RX_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100607 /* UNITDATA has to handle the release of msg.
608 * If send upwards (gprs_ns2_recv_unitdata) it must NOT free
609 * the msg, the upper layer has to do it.
610 * Otherwise the msg must be freed.
611 */
Alexander Couzens6a161492020-07-12 13:45:50 +0200612 switch (fi->state) {
613 case GPRS_NS2_ST_BLOCKED:
614 /* 7.2.1: the BLOCKED_ACK might be lost */
Alexander Couzens47afc422021-01-17 20:12:46 +0100615 if (priv->accept_unitdata) {
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100616 ns2_recv_unitdata(fi, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100617 return;
618 }
619
620 ns2_tx_status(priv->nsvc,
621 NS_CAUSE_NSVC_BLOCKED,
622 0, msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200623 break;
624 /* ALIVE can receive UNITDATA if the ALIVE_ACK is lost */
625 case GPRS_NS2_ST_ALIVE:
626 case GPRS_NS2_ST_UNBLOCKED:
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100627 ns2_recv_unitdata(fi, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100628 return;
Alexander Couzens6a161492020-07-12 13:45:50 +0200629 }
Alexander Couzenscce88282020-10-26 00:25:50 +0100630
631 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200632 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100633 case GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED:
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100634 if (fi->state != GPRS_NS2_ST_UNCONFIGURED) {
635 /* Force the NSVC back to its initial state */
636 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNCONFIGURED, 0, 0);
Alexander Couzensf5775432021-01-18 13:49:00 +0100637 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_REQ_START, NULL);
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100638 return;
639 }
Daniel Willmanned0c9822020-11-18 14:08:07 +0100640 break;
Alexander Couzens47afc422021-01-17 20:12:46 +0100641 case GPRS_NS2_EV_REQ_OM_BLOCK:
642 /* vty cmd: block */
643 priv->initiate_block = true;
644 priv->om_blocked = true;
645 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
646 break;
647 case GPRS_NS2_EV_REQ_OM_UNBLOCK:
648 /* vty cmd: unblock*/
649 if (!priv->om_blocked)
650 return;
651 priv->om_blocked = false;
652 if (fi->state == GPRS_NS2_ST_BLOCKED)
653 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
654 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200655 }
656}
657
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100658static void ns2_vc_fsm_clean(struct osmo_fsm_inst *fi,
Alexander Couzens0346b642020-10-27 13:05:56 +0100659 enum osmo_fsm_term_cause cause)
660{
661 struct gprs_ns2_vc_priv *priv = fi->priv;
662
663 osmo_timer_del(&priv->alive.timer);
664}
665
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100666static struct osmo_fsm ns2_vc_fsm = {
Alexander Couzens6a161492020-07-12 13:45:50 +0200667 .name = "GPRS-NS2-VC",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100668 .states = ns2_vc_states,
669 .num_states = ARRAY_SIZE(ns2_vc_states),
Alexander Couzensf5775432021-01-18 13:49:00 +0100670 .allstate_event_mask = S(GPRS_NS2_EV_RX_UNITDATA) |
671 S(GPRS_NS2_EV_RX_RESET) |
672 S(GPRS_NS2_EV_RX_ALIVE) |
673 S(GPRS_NS2_EV_RX_ALIVE_ACK) |
674 S(GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED) |
Alexander Couzens47afc422021-01-17 20:12:46 +0100675 S(GPRS_NS2_EV_REQ_OM_BLOCK) |
676 S(GPRS_NS2_EV_REQ_OM_UNBLOCK),
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100677 .allstate_action = ns2_vc_fsm_allstate_action,
678 .cleanup = ns2_vc_fsm_clean,
679 .timer_cb = ns2_vc_fsm_timer_cb,
Alexander Couzens6a161492020-07-12 13:45:50 +0200680 /* .log_subsys = DNS, "is not constant" */
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100681 .event_names = ns2_vc_event_names,
Alexander Couzens6a161492020-07-12 13:45:50 +0200682 .pre_term = NULL,
683 .log_subsys = DLNS,
684};
685
686/*!
687 * \brief gprs_ns2_vc_fsm_alloc
688 * \param ctx
689 * \param vc
690 * \param id a char representation of the virtual curcuit
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100691 * \param initiator initiator is the site which starts the connection. Usually the BSS.
Alexander Couzens6a161492020-07-12 13:45:50 +0200692 * \return NULL on error, otherwise the fsm
693 */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100694struct osmo_fsm_inst *ns2_vc_fsm_alloc(struct gprs_ns2_vc *nsvc,
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100695 const char *id, bool initiator)
Alexander Couzens6a161492020-07-12 13:45:50 +0200696{
697 struct osmo_fsm_inst *fi;
698 struct gprs_ns2_vc_priv *priv;
699
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100700 fi = osmo_fsm_inst_alloc(&ns2_vc_fsm, nsvc, NULL, LOGL_DEBUG, id);
Alexander Couzens6a161492020-07-12 13:45:50 +0200701 if (!fi)
702 return fi;
703
704 nsvc->fi = fi;
705 priv = fi->priv = talloc_zero(fi, struct gprs_ns2_vc_priv);
706 priv->nsvc = nsvc;
Alexander Couzensea01bf22021-01-18 14:01:01 +0100707 priv->initiator = initiator;
Alexander Couzens6a161492020-07-12 13:45:50 +0200708
709 osmo_timer_setup(&priv->alive.timer, alive_timeout_handler, fi);
710
711 return fi;
712}
713
Harald Welte5bef2cc2020-09-18 22:33:24 +0200714/*! Start a NS-VC FSM.
715 * \param nsvc the virtual circuit
716 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100717int ns2_vc_fsm_start(struct gprs_ns2_vc *nsvc)
Alexander Couzens6a161492020-07-12 13:45:50 +0200718{
719 /* allows to call this function even for started nsvc by gprs_ns2_start_alive_all_nsvcs */
720 if (nsvc->fi->state == GPRS_NS2_ST_UNCONFIGURED)
Alexander Couzensf5775432021-01-18 13:49:00 +0100721 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_START, NULL);
Alexander Couzens6a161492020-07-12 13:45:50 +0200722 return 0;
723}
724
Daniel Willmanned0c9822020-11-18 14:08:07 +0100725/*! Reset a NS-VC FSM.
726 * \param nsvc the virtual circuit
727 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100728int ns2_vc_force_unconfigured(struct gprs_ns2_vc *nsvc)
Daniel Willmanned0c9822020-11-18 14:08:07 +0100729{
Alexander Couzensf5775432021-01-18 13:49:00 +0100730 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED, NULL);
Daniel Willmanned0c9822020-11-18 14:08:07 +0100731}
732
Alexander Couzens47afc422021-01-17 20:12:46 +0100733/*! Block a NS-VC.
734 * \param nsvc the virtual circuit
735 * \return 0 on success; negative on error */
736int ns2_vc_block(struct gprs_ns2_vc *nsvc)
737{
738 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_OM_BLOCK, NULL);
739}
740
741/*! Unblock a NS-VC.
742 * \param nsvc the virtual circuit
743 * \return 0 on success; negative on error */
744int ns2_vc_unblock(struct gprs_ns2_vc *nsvc)
745{
746 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_OM_UNBLOCK, NULL);
747}
748
Harald Welte5bef2cc2020-09-18 22:33:24 +0200749/*! entry point for messages from the driver/VL
750 * \param nsvc virtual circuit on which the message was received
751 * \param msg message that was received
752 * \param tp parsed TLVs of the received message
753 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100754int ns2_vc_rx(struct gprs_ns2_vc *nsvc, struct msgb *msg, struct tlv_parsed *tp)
Alexander Couzens6a161492020-07-12 13:45:50 +0200755{
756 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
757 struct osmo_fsm_inst *fi = nsvc->fi;
Alexander Couzenscce88282020-10-26 00:25:50 +0100758 int rc = 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200759 uint8_t cause;
Alexander Couzens3f576ab2021-01-20 14:50:31 +0100760 uint16_t nsei, nsvci;
Alexander Couzens6a161492020-07-12 13:45:50 +0200761
762 /* TODO: 7.2: on UNBLOCK/BLOCK: check if NS-VCI is correct,
763 * if not answer STATUS with "NS-VC unknown" */
Alexander Couzens6a161492020-07-12 13:45:50 +0200764 /* TODO: handle BLOCK/UNBLOCK/ALIVE with different VCI */
765
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100766 if (ns2_validate(nsvc, nsh->pdu_type, msg, tp, &cause)) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200767 if (nsh->pdu_type != NS_PDUT_STATUS) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100768 rc = ns2_tx_status(nsvc, cause, 0, msg);
769 goto out;
Alexander Couzens6a161492020-07-12 13:45:50 +0200770 }
771 }
772
Alexander Couzens43771df2021-01-20 13:03:03 +0100773 if (TLVP_PRESENT(tp, NS_IE_NSEI)) {
774 nsei = tlvp_val16be(tp, NS_IE_NSEI);
775 if (nsei != nsvc->nse->nsei) {
776 /* 48.016 § 7.3.1 send, RESET_ACK to wrong NSVCI + ignore */
777 if (nsh->pdu_type == NS_PDUT_RESET)
778 ns2_tx_reset_ack(nsvc);
779
780 LOGNSVC(nsvc, LOGL_ERROR, "Rx %s with wrong NSEI=%05u. Ignoring PDU.\n",
781 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type), nsei);
782 goto out;
783 }
784 }
785
Alexander Couzens3f576ab2021-01-20 14:50:31 +0100786 if (nsvc->nsvci_is_valid && TLVP_PRESENT(tp, NS_IE_VCI)) {
787 nsvci = tlvp_val16be(tp, NS_IE_VCI);
788 if (nsvci != nsvc->nsvci) {
789 /* 48.016 § 7.3.1 send RESET_ACK to wrong NSVCI + ignore */
790 if (nsh->pdu_type == NS_PDUT_RESET)
791 ns2_tx_reset_ack(nsvc);
792
793 LOGNSVC(nsvc, LOGL_ERROR, "Rx %s with wrong NSVCI=%05u. Ignoring PDU.\n",
794 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type), nsvci);
795 goto out;
796 }
797 }
798
Alexander Couzens6a161492020-07-12 13:45:50 +0200799 switch (nsh->pdu_type) {
800 case NS_PDUT_RESET:
Alexander Couzensf5775432021-01-18 13:49:00 +0100801 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_RESET, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200802 break;
803 case NS_PDUT_RESET_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100804 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_RESET_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200805 break;
806 case NS_PDUT_BLOCK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100807 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_BLOCK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200808 break;
809 case NS_PDUT_BLOCK_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100810 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_BLOCK_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200811 break;
812 case NS_PDUT_UNBLOCK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100813 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNBLOCK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200814 break;
815 case NS_PDUT_UNBLOCK_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100816 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNBLOCK_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200817 break;
818 case NS_PDUT_ALIVE:
Alexander Couzensf5775432021-01-18 13:49:00 +0100819 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_ALIVE, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200820 break;
821 case NS_PDUT_ALIVE_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100822 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_ALIVE_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200823 break;
824 case NS_PDUT_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100825 /* UNITDATA have to free msg because it might send the msg layer upwards */
Alexander Couzensf5775432021-01-18 13:49:00 +0100826 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNITDATA, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100827 return 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200828 default:
Harald Weltef2949742021-01-20 14:54:14 +0100829 LOGPFSML(fi, LOGL_ERROR, "NSEI=%u Rx unknown NS PDU type %s\n", nsvc->nse->nsei,
830 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));
Alexander Couzens6a161492020-07-12 13:45:50 +0200831 return -EINVAL;
832 }
833
Alexander Couzenscce88282020-10-26 00:25:50 +0100834out:
835 msgb_free(msg);
836
837 return rc;
Alexander Couzens6a161492020-07-12 13:45:50 +0200838}
839
Harald Welte5bef2cc2020-09-18 22:33:24 +0200840/*! is the given NS-VC unblocked? */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100841int ns2_vc_is_unblocked(struct gprs_ns2_vc *nsvc)
Alexander Couzens6a161492020-07-12 13:45:50 +0200842{
843 return (nsvc->fi->state == GPRS_NS2_ST_UNBLOCKED);
844}
845
846/* initialize osmo_ctx on main tread */
847static __attribute__((constructor)) void on_dso_load_ctx(void)
848{
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100849 OSMO_ASSERT(osmo_fsm_register(&ns2_vc_fsm) == 0);
Alexander Couzens6a161492020-07-12 13:45:50 +0200850}