blob: 641fcc319b924a854317eb3bf57a89c9ee663160 [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.*/
60 bool initiate_block;
61 bool initiate_reset;
Alexander Couzens6a161492020-07-12 13:45:50 +020062
63 /* the alive counter is present in all states */
64 struct {
65 struct osmo_timer_list timer;
66 enum ns2_timeout mode;
67 int N;
68 struct timeval timer_started;
69 } alive;
70};
71
72
73/* The FSM covers both the VC with RESET/BLOCK and without RESET/BLOCK procedure..
74 *
75 * With RESET/BLOCK, the state should follow:
76 * - UNCONFIGURED -> RESET -> BLOCK -> UNBLOCKED
77 *
78 * Without RESET/BLOCK, the state should follow:
79 * - UNCONFIGURED -> ALIVE -> UNBLOCKED
80 *
81 * The UNBLOCKED and TEST states are used to send ALIVE PDU using the timeout Tns-test and Tns-alive.
82 * UNBLOCKED -> TEST: on expire of Tns-Test, send Alive PDU.
83 * TEST -> UNBLOCKED: on receive of Alive_Ack PDU, go into UNBLOCKED.
84 *
85 * The ALIVE state is used as intermediate, because a VC is only valid if it received an Alive ACK when
86 * not using RESET/BLOCK procedure.
87 */
88
89enum gprs_ns2_vc_state {
90 GPRS_NS2_ST_UNCONFIGURED,
91 GPRS_NS2_ST_RESET,
92 GPRS_NS2_ST_BLOCKED,
93 GPRS_NS2_ST_UNBLOCKED, /* allows sending NS_UNITDATA */
94
95 GPRS_NS2_ST_ALIVE, /* only used when not using RESET/BLOCK procedure */
96};
97
98enum gprs_ns2_vc_event {
99 GPRS_NS2_EV_START,
100
101 /* received messages */
102 GPRS_NS2_EV_RESET,
103 GPRS_NS2_EV_RESET_ACK,
104 GPRS_NS2_EV_UNBLOCK,
105 GPRS_NS2_EV_UNBLOCK_ACK,
106 GPRS_NS2_EV_BLOCK,
107 GPRS_NS2_EV_BLOCK_ACK,
108 GPRS_NS2_EV_ALIVE,
109 GPRS_NS2_EV_ALIVE_ACK,
110 GPRS_NS2_EV_STATUS,
111
112 GPRS_NS2_EV_UNITDATA,
Daniel Willmanned0c9822020-11-18 14:08:07 +0100113
Alexander Couzens5443ff82021-01-15 04:36:05 +0100114 GPRS_NS2_EV_FORCE_UNCONFIGURED, /* called via vty for tests */
Alexander Couzens6a161492020-07-12 13:45:50 +0200115};
116
117static const struct value_string gprs_ns2_vc_event_names[] = {
Daniel Willmanned0c9822020-11-18 14:08:07 +0100118 { GPRS_NS2_EV_START, "START" },
119 { GPRS_NS2_EV_RESET, "RESET" },
120 { GPRS_NS2_EV_RESET_ACK, "RESET_ACK" },
121 { GPRS_NS2_EV_UNBLOCK, "UNBLOCK" },
122 { GPRS_NS2_EV_UNBLOCK_ACK, "UNBLOCK_ACK" },
123 { GPRS_NS2_EV_BLOCK, "BLOCK" },
124 { GPRS_NS2_EV_BLOCK_ACK, "BLOCK_ACK" },
125 { GPRS_NS2_EV_ALIVE, "ALIVE" },
126 { GPRS_NS2_EV_ALIVE_ACK, "ALIVE_ACK" },
127 { GPRS_NS2_EV_STATUS, "STATUS" },
128 { GPRS_NS2_EV_UNITDATA, "UNITDATA" },
Alexander Couzens5443ff82021-01-15 04:36:05 +0100129 { GPRS_NS2_EV_FORCE_UNCONFIGURED, "FORCE_UNCONFIGURED" },
Alexander Couzens6a161492020-07-12 13:45:50 +0200130 { 0, NULL }
131};
132
133static inline struct gprs_ns2_inst *ns_inst_from_fi(struct osmo_fsm_inst *fi)
134{
135 struct gprs_ns2_vc_priv *priv = fi->priv;
136 return priv->nsvc->nse->nsi;
137}
138
139static void start_test_procedure(struct gprs_ns2_vc_priv *priv)
140{
141 struct gprs_ns2_inst *nsi = priv->nsvc->nse->nsi;
142
143 if (osmo_timer_pending(&priv->alive.timer))
144 return;
145
146 priv->alive.mode = NS_TOUT_TNS_ALIVE;
147 priv->alive.N = 0;
148
149 osmo_gettimeofday(&priv->alive.timer_started, NULL);
150 ns2_tx_alive(priv->nsvc);
151 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
152}
153
154static void stop_test_procedure(struct gprs_ns2_vc_priv *priv)
155{
156 osmo_timer_del(&priv->alive.timer);
157}
158
159static int alive_timer_elapsed_ms(struct gprs_ns2_vc_priv *priv)
160{
161 struct timeval now, elapsed;
162 osmo_gettimeofday(&now, NULL);
163 timersub(&now, &priv->alive.timer_started, &elapsed);
164
165 return 1000 * elapsed.tv_sec + elapsed.tv_usec / 1000;
166}
167
168static void recv_test_procedure(struct osmo_fsm_inst *fi)
169{
170 struct gprs_ns2_vc_priv *priv = fi->priv;
171 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
172 struct gprs_ns2_vc *nsvc = priv->nsvc;
173
174 /* ignoring ACKs without sending an ALIVE */
175 if (priv->alive.mode != NS_TOUT_TNS_ALIVE)
176 return;
177
178 priv->alive.mode = NS_TOUT_TNS_TEST;
179 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
180 osmo_stat_item_set(nsvc->statg->items[NS_STAT_ALIVE_DELAY],
181 alive_timer_elapsed_ms(priv));
182}
183
184
185static void alive_timeout_handler(void *data)
186{
187 struct osmo_fsm_inst *fi = data;
188 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
189 struct gprs_ns2_vc_priv *priv = fi->priv;
190
191 switch (priv->alive.mode) {
192 case NS_TOUT_TNS_TEST:
193 priv->alive.mode = NS_TOUT_TNS_ALIVE;
194 ns2_tx_alive(priv->nsvc);
195 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
196 break;
197 case NS_TOUT_TNS_ALIVE:
198 priv->alive.N++;
199
200 if (priv->alive.N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
201 /* retransmission */
202 ns2_tx_alive(priv->nsvc);
203 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
204 } else {
205 /* lost connection */
206 if (priv->nsvc->mode == NS2_VC_MODE_BLOCKRESET) {
207 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
208 } else {
209 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, nsi->timeout[NS_TOUT_TNS_ALIVE], 0);
210 }
211 }
212 break;
213 default:
214 break;
215 }
216}
217
218static void gprs_ns2_st_unconfigured(struct osmo_fsm_inst *fi, uint32_t event, void *data)
219{
220 struct gprs_ns2_vc_priv *priv = fi->priv;
221 struct gprs_ns2_inst *nsi = priv->nsvc->nse->nsi;
222
223 switch (event) {
224 case GPRS_NS2_EV_START:
225 switch (priv->nsvc->mode) {
226 case NS2_VC_MODE_ALIVE:
227 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, nsi->timeout[NS_TOUT_TNS_ALIVE], NS_TOUT_TNS_ALIVE);
228 break;
229 case NS2_VC_MODE_BLOCKRESET:
230 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
231 break;
232 }
233
234 break;
235 default:
236 OSMO_ASSERT(0);
237 }
238}
239
240
241static void gprs_ns2_st_reset_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
242{
243 struct gprs_ns2_vc_priv *priv = fi->priv;
244
245 if (old_state != GPRS_NS2_ST_RESET)
246 priv->N = 0;
247
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100248 if (priv->initiate_reset)
Alexander Couzens6a161492020-07-12 13:45:50 +0200249 ns2_tx_reset(priv->nsvc, NS_CAUSE_OM_INTERVENTION);
250
251 stop_test_procedure(priv);
252 ns2_nse_notify_unblocked(priv->nsvc, false);
253}
254
255static void gprs_ns2_st_reset(struct osmo_fsm_inst *fi, uint32_t event, void *data)
256{
257 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
258 struct gprs_ns2_vc_priv *priv = fi->priv;
259
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100260 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200261 switch (event) {
262 case GPRS_NS2_EV_RESET_ACK:
263 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
264 nsi->timeout[NS_TOUT_TNS_BLOCK], NS_TOUT_TNS_BLOCK);
265 break;
266 }
267 } else {
268 /* we are on the receiving end */
269 switch (event) {
270 case GPRS_NS2_EV_RESET:
271 ns2_tx_reset_ack(priv->nsvc);
272 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
273 0, 0);
274 break;
275 }
276 }
277}
278
279static void gprs_ns2_st_blocked_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
280{
281 struct gprs_ns2_vc_priv *priv = fi->priv;
282
283 if (old_state != GPRS_NS2_ST_BLOCKED)
284 priv->N = 0;
285
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100286 if (priv->initiate_block)
Alexander Couzens6a161492020-07-12 13:45:50 +0200287 ns2_tx_unblock(priv->nsvc);
288
289 start_test_procedure(priv);
290}
291
292static void gprs_ns2_st_blocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
293{
294 struct gprs_ns2_vc_priv *priv = fi->priv;
295
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100296 if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200297 switch (event) {
298 case GPRS_NS2_EV_BLOCK:
299 /* TODO: BLOCK is a UNBLOCK_NACK */
300 ns2_tx_block_ack(priv->nsvc);
301 break;
302 case GPRS_NS2_EV_UNBLOCK:
303 ns2_tx_unblock_ack(priv->nsvc);
304 /* fall through */
305 case GPRS_NS2_EV_UNBLOCK_ACK:
306 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED,
307 0, NS_TOUT_TNS_TEST);
308 break;
309 }
310 } else {
311 /* we are on the receiving end. The initiator who sent RESET is responsible to UNBLOCK! */
312 switch (event) {
313 case GPRS_NS2_EV_UNBLOCK:
314 ns2_tx_unblock_ack(priv->nsvc);
315 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED,
316 0, 0);
317 break;
318 }
319 }
320}
321
322static void gprs_ns2_st_unblocked_on_enter(struct osmo_fsm_inst *fi, uint32_t old_state)
323{
324 struct gprs_ns2_vc_priv *priv = fi->priv;
Daniel Willmann15c09a82020-11-03 23:05:43 +0100325 struct gprs_ns2_vc *nsvc = priv->nsvc;
326 struct gprs_ns2_nse *nse = nsvc->nse;
Alexander Couzens6a161492020-07-12 13:45:50 +0200327
Daniel Willmann15c09a82020-11-03 23:05:43 +0100328 ns2_nse_notify_unblocked(nsvc, true);
329 ns2_prim_status_ind(nse, nsvc, 0, NS_AFF_CAUSE_VC_RECOVERY);
Alexander Couzens6a161492020-07-12 13:45:50 +0200330}
331
332static void gprs_ns2_st_unblocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
333{
334 struct gprs_ns2_vc_priv *priv = fi->priv;
335
336 switch (event) {
Alexander Couzensc4b74622021-01-10 20:44:26 +0100337 case GPRS_NS2_EV_UNBLOCK:
338 ns2_tx_unblock_ack(priv->nsvc);
339 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200340 case GPRS_NS2_EV_BLOCK:
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100341 priv->initiate_block = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200342 ns2_tx_block_ack(priv->nsvc);
343 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
344 0, 2);
345 break;
346 }
347}
348
349static void gprs_ns2_st_alive(struct osmo_fsm_inst *fi, uint32_t event, void *data)
350{
351 switch (event) {
352 case GPRS_NS2_EV_ALIVE_ACK:
353 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED, 0, 0);
354 break;
355 }
356}
357
358static void gprs_ns2_st_alive_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
359{
360 struct gprs_ns2_vc_priv *priv = fi->priv;
361 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
362
363 priv->alive.mode = NS_TOUT_TNS_TEST;
364 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
365
366 if (old_state != GPRS_NS2_ST_ALIVE)
367 priv->N = 0;
368
369 ns2_tx_alive(priv->nsvc);
370 ns2_nse_notify_unblocked(priv->nsvc, false);
371}
372
373static void gprs_ns2_st_alive_onleave(struct osmo_fsm_inst *fi, uint32_t next_state)
374{
375 start_test_procedure(fi->priv);
376}
377
378static const struct osmo_fsm_state gprs_ns2_vc_states[] = {
379 [GPRS_NS2_ST_UNCONFIGURED] = {
380 .in_event_mask = S(GPRS_NS2_EV_START),
381 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE),
382 .name = "UNCONFIGURED",
383 .action = gprs_ns2_st_unconfigured,
384 },
385 [GPRS_NS2_ST_RESET] = {
386 .in_event_mask = S(GPRS_NS2_EV_RESET_ACK) | S(GPRS_NS2_EV_RESET),
387 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100388 S(GPRS_NS2_ST_BLOCKED) |
389 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200390 .name = "RESET",
391 .action = gprs_ns2_st_reset,
392 .onenter = gprs_ns2_st_reset_onenter,
393 },
394 [GPRS_NS2_ST_BLOCKED] = {
395 .in_event_mask = S(GPRS_NS2_EV_BLOCK) | S(GPRS_NS2_EV_BLOCK_ACK) |
396 S(GPRS_NS2_EV_UNBLOCK) | S(GPRS_NS2_EV_UNBLOCK_ACK),
397 .out_state_mask = S(GPRS_NS2_ST_RESET) |
398 S(GPRS_NS2_ST_UNBLOCKED) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100399 S(GPRS_NS2_ST_BLOCKED) |
400 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200401 .name = "BLOCKED",
402 .action = gprs_ns2_st_blocked,
403 .onenter = gprs_ns2_st_blocked_onenter,
404 },
405 [GPRS_NS2_ST_UNBLOCKED] = {
Alexander Couzensc4b74622021-01-10 20:44:26 +0100406 .in_event_mask = S(GPRS_NS2_EV_BLOCK) | S(GPRS_NS2_EV_UNBLOCK_ACK) |
407 S(GPRS_NS2_EV_UNBLOCK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200408 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100409 S(GPRS_NS2_ST_BLOCKED) |
410 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200411 .name = "UNBLOCKED",
412 .action = gprs_ns2_st_unblocked,
413 .onenter = gprs_ns2_st_unblocked_on_enter,
414 },
415
416 /* ST_ALIVE is only used on VC without RESET/BLOCK */
417 [GPRS_NS2_ST_ALIVE] = {
418 .in_event_mask = S(GPRS_NS2_EV_ALIVE_ACK),
419 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100420 S(GPRS_NS2_ST_UNBLOCKED) |
421 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200422 .name = "ALIVE",
423 .action = gprs_ns2_st_alive,
424 .onenter = gprs_ns2_st_alive_onenter,
425 .onleave = gprs_ns2_st_alive_onleave,
426 },
427};
428
429static int gprs_ns2_vc_fsm_timer_cb(struct osmo_fsm_inst *fi)
430{
431 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
432 struct gprs_ns2_vc_priv *priv = fi->priv;
433
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100434 switch (fi->state) {
435 case GPRS_NS2_ST_RESET:
436 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200437 priv->N++;
438 if (priv->N <= nsi->timeout[NS_TOUT_TNS_RESET_RETRIES]) {
439 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
440 } else {
441 priv->N = 0;
442 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
443 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100444 }
445 break;
446 case GPRS_NS2_ST_BLOCKED:
447 if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200448 priv->N++;
449 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
450 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
451 } else {
452 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
453 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100454 }
455 break;
456 case GPRS_NS2_ST_ALIVE:
457 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200458 priv->N++;
459 if (priv->N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
460 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
461 } else {
462 priv->N = 0;
463 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
464 }
465 break;
466 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100467 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200468 }
469 return 0;
470}
471
472static void gprs_ns2_recv_unitdata(struct osmo_fsm_inst *fi,
473 struct msgb *msg)
474{
475 struct gprs_ns2_vc_priv *priv = fi->priv;
476 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
477 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
478 struct osmo_gprs_ns2_prim nsp = {};
479 uint16_t bvci;
480
Alexander Couzenscce88282020-10-26 00:25:50 +0100481 if (msgb_l2len(msg) < sizeof(*nsh) + 3) {
482 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200483 return;
Alexander Couzenscce88282020-10-26 00:25:50 +0100484 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200485
486 /* TODO: 7.1: For an IP sub-network, an NS-UNITDATA PDU
487 * for a PTP BVC may indicate a request to change the IP endpoint
488 * and/or a response to a change in the IP endpoint. */
489
490 /* TODO: nsh->data[0] -> C/R only valid in IP SNS */
491 bvci = nsh->data[1] << 8 | nsh->data[2];
492
Alexander Couzens89acdef2020-09-23 18:22:31 +0200493 msg->l3h = &nsh->data[3];
494 nsp.bvci = bvci;
495 nsp.nsei = priv->nsvc->nse->nsei;
Alexander Couzens6a161492020-07-12 13:45:50 +0200496
Alexander Couzensc1cd3332020-09-23 23:24:02 +0200497 /* 10.3.9 NS SDU Control Bits */
498 if (nsh->data[0] & 0x1)
Alexander Couzens6a161492020-07-12 13:45:50 +0200499 nsp.u.unitdata.change = NS_ENDPOINT_REQUEST_CHANGE;
500
501 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA,
502 PRIM_OP_INDICATION, msg);
503 nsi->cb(&nsp.oph, nsi->cb_data);
504}
505
506static void gprs_ns2_vc_fsm_allstate_action(struct osmo_fsm_inst *fi,
507 uint32_t event,
508 void *data)
509{
510 struct gprs_ns2_vc_priv *priv = fi->priv;
511 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
Alexander Couzenscce88282020-10-26 00:25:50 +0100512 struct msgb *msg = data;
Alexander Couzens6a161492020-07-12 13:45:50 +0200513
514 switch (event) {
515 case GPRS_NS2_EV_RESET:
516 if (priv->nsvc->mode != NS2_VC_MODE_BLOCKRESET)
517 break;
518
519 /* move the FSM into reset */
520 if (fi->state != GPRS_NS2_ST_RESET) {
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100521 priv->initiate_reset = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200522 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
523 }
524 /* pass the event down into FSM action */
525 gprs_ns2_st_reset(fi, event, data);
526 break;
527 case GPRS_NS2_EV_ALIVE:
528 switch (fi->state) {
529 case GPRS_NS2_ST_UNCONFIGURED:
530 case GPRS_NS2_ST_RESET:
531 /* ignore ALIVE */
532 break;
533 default:
534 ns2_tx_alive_ack(priv->nsvc);
535 }
536 break;
537 case GPRS_NS2_EV_ALIVE_ACK:
538 /* for VCs without RESET/BLOCK/UNBLOCK, the connections comes after ALIVE_ACK unblocked */
539 if (fi->state == GPRS_NS2_ST_ALIVE)
540 gprs_ns2_st_alive(fi, event, data);
541 else
542 recv_test_procedure(fi);
543 break;
544 case GPRS_NS2_EV_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100545 /* UNITDATA has to handle the release of msg.
546 * If send upwards (gprs_ns2_recv_unitdata) it must NOT free
547 * the msg, the upper layer has to do it.
548 * Otherwise the msg must be freed.
549 */
Alexander Couzens6a161492020-07-12 13:45:50 +0200550 switch (fi->state) {
551 case GPRS_NS2_ST_BLOCKED:
552 /* 7.2.1: the BLOCKED_ACK might be lost */
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100553 if (priv->initiate_block) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100554 gprs_ns2_recv_unitdata(fi, msg);
555 return;
556 }
557
558 ns2_tx_status(priv->nsvc,
559 NS_CAUSE_NSVC_BLOCKED,
560 0, msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200561 break;
562 /* ALIVE can receive UNITDATA if the ALIVE_ACK is lost */
563 case GPRS_NS2_ST_ALIVE:
564 case GPRS_NS2_ST_UNBLOCKED:
Alexander Couzenscce88282020-10-26 00:25:50 +0100565 gprs_ns2_recv_unitdata(fi, msg);
566 return;
Alexander Couzens6a161492020-07-12 13:45:50 +0200567 }
Alexander Couzenscce88282020-10-26 00:25:50 +0100568
569 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200570 break;
Daniel Willmanned0c9822020-11-18 14:08:07 +0100571 case GPRS_NS2_EV_FORCE_UNCONFIGURED:
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100572 if (fi->state != GPRS_NS2_ST_UNCONFIGURED) {
573 /* Force the NSVC back to its initial state */
574 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNCONFIGURED, 0, 0);
575 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_START, NULL);
576 return;
577 }
Daniel Willmanned0c9822020-11-18 14:08:07 +0100578 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200579 }
580}
581
Alexander Couzens0346b642020-10-27 13:05:56 +0100582static void gprs_ns2_vc_fsm_clean(struct osmo_fsm_inst *fi,
583 enum osmo_fsm_term_cause cause)
584{
585 struct gprs_ns2_vc_priv *priv = fi->priv;
586
587 osmo_timer_del(&priv->alive.timer);
588}
589
Alexander Couzens6a161492020-07-12 13:45:50 +0200590static struct osmo_fsm gprs_ns2_vc_fsm = {
591 .name = "GPRS-NS2-VC",
592 .states = gprs_ns2_vc_states,
593 .num_states = ARRAY_SIZE(gprs_ns2_vc_states),
594 .allstate_event_mask = S(GPRS_NS2_EV_UNITDATA) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100595 S(GPRS_NS2_EV_RESET) |
Alexander Couzens6a161492020-07-12 13:45:50 +0200596 S(GPRS_NS2_EV_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100597 S(GPRS_NS2_EV_ALIVE_ACK) |
598 S(GPRS_NS2_EV_FORCE_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200599 .allstate_action = gprs_ns2_vc_fsm_allstate_action,
Alexander Couzens0346b642020-10-27 13:05:56 +0100600 .cleanup = gprs_ns2_vc_fsm_clean,
Alexander Couzens6a161492020-07-12 13:45:50 +0200601 .timer_cb = gprs_ns2_vc_fsm_timer_cb,
602 /* .log_subsys = DNS, "is not constant" */
603 .event_names = gprs_ns2_vc_event_names,
604 .pre_term = NULL,
605 .log_subsys = DLNS,
606};
607
608/*!
609 * \brief gprs_ns2_vc_fsm_alloc
610 * \param ctx
611 * \param vc
612 * \param id a char representation of the virtual curcuit
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100613 * \param initiator initiator is the site which starts the connection. Usually the BSS.
Alexander Couzens6a161492020-07-12 13:45:50 +0200614 * \return NULL on error, otherwise the fsm
615 */
616struct osmo_fsm_inst *gprs_ns2_vc_fsm_alloc(struct gprs_ns2_vc *nsvc,
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100617 const char *id, bool initiator)
Alexander Couzens6a161492020-07-12 13:45:50 +0200618{
619 struct osmo_fsm_inst *fi;
620 struct gprs_ns2_vc_priv *priv;
621
622 fi = osmo_fsm_inst_alloc(&gprs_ns2_vc_fsm, nsvc, NULL, LOGL_DEBUG, id);
623 if (!fi)
624 return fi;
625
626 nsvc->fi = fi;
627 priv = fi->priv = talloc_zero(fi, struct gprs_ns2_vc_priv);
628 priv->nsvc = nsvc;
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100629 priv->initiate_reset = initiator;
630 priv->initiate_block = initiator;
Alexander Couzens6a161492020-07-12 13:45:50 +0200631
632 osmo_timer_setup(&priv->alive.timer, alive_timeout_handler, fi);
633
634 return fi;
635}
636
Harald Welte5bef2cc2020-09-18 22:33:24 +0200637/*! Start a NS-VC FSM.
638 * \param nsvc the virtual circuit
639 * \return 0 on success; negative on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200640int gprs_ns2_vc_fsm_start(struct gprs_ns2_vc *nsvc)
641{
642 /* allows to call this function even for started nsvc by gprs_ns2_start_alive_all_nsvcs */
643 if (nsvc->fi->state == GPRS_NS2_ST_UNCONFIGURED)
644 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_START, NULL);
645 return 0;
646}
647
Daniel Willmanned0c9822020-11-18 14:08:07 +0100648/*! Reset a NS-VC FSM.
649 * \param nsvc the virtual circuit
650 * \return 0 on success; negative on error */
651int gprs_ns2_vc_force_unconfigured(struct gprs_ns2_vc *nsvc)
652{
653 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_FORCE_UNCONFIGURED, NULL);
654}
655
Harald Welte5bef2cc2020-09-18 22:33:24 +0200656/*! entry point for messages from the driver/VL
657 * \param nsvc virtual circuit on which the message was received
658 * \param msg message that was received
659 * \param tp parsed TLVs of the received message
660 * \return 0 on success; negative on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200661int gprs_ns2_vc_rx(struct gprs_ns2_vc *nsvc, struct msgb *msg, struct tlv_parsed *tp)
662{
663 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
664 struct osmo_fsm_inst *fi = nsvc->fi;
Alexander Couzenscce88282020-10-26 00:25:50 +0100665 int rc = 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200666 uint8_t cause;
667
668 /* TODO: 7.2: on UNBLOCK/BLOCK: check if NS-VCI is correct,
669 * if not answer STATUS with "NS-VC unknown" */
670 /* TODO: handle RESET with different VCI */
671 /* TODO: handle BLOCK/UNBLOCK/ALIVE with different VCI */
672
673 if (gprs_ns2_validate(nsvc, nsh->pdu_type, msg, tp, &cause)) {
674 if (nsh->pdu_type != NS_PDUT_STATUS) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100675 rc = ns2_tx_status(nsvc, cause, 0, msg);
676 goto out;
Alexander Couzens6a161492020-07-12 13:45:50 +0200677 }
678 }
679
680 switch (nsh->pdu_type) {
681 case NS_PDUT_RESET:
682 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RESET, tp);
683 break;
684 case NS_PDUT_RESET_ACK:
685 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RESET_ACK, tp);
686 break;
687 case NS_PDUT_BLOCK:
688 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_BLOCK, tp);
689 break;
690 case NS_PDUT_BLOCK_ACK:
691 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_BLOCK_ACK, tp);
692 break;
693 case NS_PDUT_UNBLOCK:
694 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNBLOCK, tp);
695 break;
696 case NS_PDUT_UNBLOCK_ACK:
697 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNBLOCK_ACK, tp);
698 break;
699 case NS_PDUT_ALIVE:
700 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_ALIVE, tp);
701 break;
702 case NS_PDUT_ALIVE_ACK:
703 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_ALIVE_ACK, tp);
704 break;
705 case NS_PDUT_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100706 /* UNITDATA have to free msg because it might send the msg layer upwards */
Alexander Couzens6a161492020-07-12 13:45:50 +0200707 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNITDATA, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100708 return 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200709 default:
710 LOGP(DLNS, LOGL_ERROR, "NSEI=%u Rx unknown NS PDU type %s\n", nsvc->nse->nsei,
711 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));
712 return -EINVAL;
713 }
714
Alexander Couzenscce88282020-10-26 00:25:50 +0100715out:
716 msgb_free(msg);
717
718 return rc;
Alexander Couzens6a161492020-07-12 13:45:50 +0200719}
720
Harald Welte5bef2cc2020-09-18 22:33:24 +0200721/*! is the given NS-VC unblocked? */
Alexander Couzens6a161492020-07-12 13:45:50 +0200722int gprs_ns2_vc_is_unblocked(struct gprs_ns2_vc *nsvc)
723{
724 return (nsvc->fi->state == GPRS_NS2_ST_UNBLOCKED);
725}
726
727/* initialize osmo_ctx on main tread */
728static __attribute__((constructor)) void on_dso_load_ctx(void)
729{
730 OSMO_ASSERT(osmo_fsm_register(&gprs_ns2_vc_fsm) == 0);
731}