blob: d5f134e10536f5dfdb87521b7e057052d448cbd2 [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
114 GPRS_NS2_EV_FORCE_UNCONFIGURED,
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" },
129 {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) {
337 case GPRS_NS2_EV_BLOCK:
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100338 priv->initiate_block = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200339 ns2_tx_block_ack(priv->nsvc);
340 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
341 0, 2);
342 break;
343 }
344}
345
346static void gprs_ns2_st_alive(struct osmo_fsm_inst *fi, uint32_t event, void *data)
347{
348 switch (event) {
349 case GPRS_NS2_EV_ALIVE_ACK:
350 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED, 0, 0);
351 break;
352 }
353}
354
355static void gprs_ns2_st_alive_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
356{
357 struct gprs_ns2_vc_priv *priv = fi->priv;
358 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
359
360 priv->alive.mode = NS_TOUT_TNS_TEST;
361 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
362
363 if (old_state != GPRS_NS2_ST_ALIVE)
364 priv->N = 0;
365
366 ns2_tx_alive(priv->nsvc);
367 ns2_nse_notify_unblocked(priv->nsvc, false);
368}
369
370static void gprs_ns2_st_alive_onleave(struct osmo_fsm_inst *fi, uint32_t next_state)
371{
372 start_test_procedure(fi->priv);
373}
374
375static const struct osmo_fsm_state gprs_ns2_vc_states[] = {
376 [GPRS_NS2_ST_UNCONFIGURED] = {
377 .in_event_mask = S(GPRS_NS2_EV_START),
378 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE),
379 .name = "UNCONFIGURED",
380 .action = gprs_ns2_st_unconfigured,
381 },
382 [GPRS_NS2_ST_RESET] = {
383 .in_event_mask = S(GPRS_NS2_EV_RESET_ACK) | S(GPRS_NS2_EV_RESET),
384 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100385 S(GPRS_NS2_ST_BLOCKED) |
386 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200387 .name = "RESET",
388 .action = gprs_ns2_st_reset,
389 .onenter = gprs_ns2_st_reset_onenter,
390 },
391 [GPRS_NS2_ST_BLOCKED] = {
392 .in_event_mask = S(GPRS_NS2_EV_BLOCK) | S(GPRS_NS2_EV_BLOCK_ACK) |
393 S(GPRS_NS2_EV_UNBLOCK) | S(GPRS_NS2_EV_UNBLOCK_ACK),
394 .out_state_mask = S(GPRS_NS2_ST_RESET) |
395 S(GPRS_NS2_ST_UNBLOCKED) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100396 S(GPRS_NS2_ST_BLOCKED) |
397 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200398 .name = "BLOCKED",
399 .action = gprs_ns2_st_blocked,
400 .onenter = gprs_ns2_st_blocked_onenter,
401 },
402 [GPRS_NS2_ST_UNBLOCKED] = {
Harald Weltee24a5b52020-12-07 15:39:13 +0100403 .in_event_mask = S(GPRS_NS2_EV_BLOCK) | S(GPRS_NS2_EV_UNBLOCK_ACK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200404 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100405 S(GPRS_NS2_ST_BLOCKED) |
406 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200407 .name = "UNBLOCKED",
408 .action = gprs_ns2_st_unblocked,
409 .onenter = gprs_ns2_st_unblocked_on_enter,
410 },
411
412 /* ST_ALIVE is only used on VC without RESET/BLOCK */
413 [GPRS_NS2_ST_ALIVE] = {
414 .in_event_mask = S(GPRS_NS2_EV_ALIVE_ACK),
415 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100416 S(GPRS_NS2_ST_UNBLOCKED) |
417 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200418 .name = "ALIVE",
419 .action = gprs_ns2_st_alive,
420 .onenter = gprs_ns2_st_alive_onenter,
421 .onleave = gprs_ns2_st_alive_onleave,
422 },
423};
424
425static int gprs_ns2_vc_fsm_timer_cb(struct osmo_fsm_inst *fi)
426{
427 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
428 struct gprs_ns2_vc_priv *priv = fi->priv;
429
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100430 /* PCU timeouts */
431 switch (fi->state) {
432 case GPRS_NS2_ST_RESET:
433 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200434 priv->N++;
435 if (priv->N <= nsi->timeout[NS_TOUT_TNS_RESET_RETRIES]) {
436 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
437 } else {
438 priv->N = 0;
439 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
440 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100441 }
442 break;
443 case GPRS_NS2_ST_BLOCKED:
444 if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200445 priv->N++;
446 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
447 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
448 } else {
449 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
450 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100451 }
452 break;
453 case GPRS_NS2_ST_ALIVE:
454 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200455 priv->N++;
456 if (priv->N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
457 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
458 } else {
459 priv->N = 0;
460 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
461 }
462 break;
463 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100464 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200465 }
466 return 0;
467}
468
469static void gprs_ns2_recv_unitdata(struct osmo_fsm_inst *fi,
470 struct msgb *msg)
471{
472 struct gprs_ns2_vc_priv *priv = fi->priv;
473 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
474 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
475 struct osmo_gprs_ns2_prim nsp = {};
476 uint16_t bvci;
477
Alexander Couzenscce88282020-10-26 00:25:50 +0100478 if (msgb_l2len(msg) < sizeof(*nsh) + 3) {
479 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200480 return;
Alexander Couzenscce88282020-10-26 00:25:50 +0100481 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200482
483 /* TODO: 7.1: For an IP sub-network, an NS-UNITDATA PDU
484 * for a PTP BVC may indicate a request to change the IP endpoint
485 * and/or a response to a change in the IP endpoint. */
486
487 /* TODO: nsh->data[0] -> C/R only valid in IP SNS */
488 bvci = nsh->data[1] << 8 | nsh->data[2];
489
Alexander Couzens89acdef2020-09-23 18:22:31 +0200490 msg->l3h = &nsh->data[3];
491 nsp.bvci = bvci;
492 nsp.nsei = priv->nsvc->nse->nsei;
Alexander Couzens6a161492020-07-12 13:45:50 +0200493
Alexander Couzensc1cd3332020-09-23 23:24:02 +0200494 /* 10.3.9 NS SDU Control Bits */
495 if (nsh->data[0] & 0x1)
Alexander Couzens6a161492020-07-12 13:45:50 +0200496 nsp.u.unitdata.change = NS_ENDPOINT_REQUEST_CHANGE;
497
498 osmo_prim_init(&nsp.oph, SAP_NS, PRIM_NS_UNIT_DATA,
499 PRIM_OP_INDICATION, msg);
500 nsi->cb(&nsp.oph, nsi->cb_data);
501}
502
503static void gprs_ns2_vc_fsm_allstate_action(struct osmo_fsm_inst *fi,
504 uint32_t event,
505 void *data)
506{
507 struct gprs_ns2_vc_priv *priv = fi->priv;
508 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
Alexander Couzenscce88282020-10-26 00:25:50 +0100509 struct msgb *msg = data;
Alexander Couzens6a161492020-07-12 13:45:50 +0200510
511 switch (event) {
512 case GPRS_NS2_EV_RESET:
513 if (priv->nsvc->mode != NS2_VC_MODE_BLOCKRESET)
514 break;
515
516 /* move the FSM into reset */
517 if (fi->state != GPRS_NS2_ST_RESET) {
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100518 priv->initiate_reset = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200519 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
520 }
521 /* pass the event down into FSM action */
522 gprs_ns2_st_reset(fi, event, data);
523 break;
524 case GPRS_NS2_EV_ALIVE:
525 switch (fi->state) {
526 case GPRS_NS2_ST_UNCONFIGURED:
527 case GPRS_NS2_ST_RESET:
528 /* ignore ALIVE */
529 break;
530 default:
531 ns2_tx_alive_ack(priv->nsvc);
532 }
533 break;
534 case GPRS_NS2_EV_ALIVE_ACK:
535 /* for VCs without RESET/BLOCK/UNBLOCK, the connections comes after ALIVE_ACK unblocked */
536 if (fi->state == GPRS_NS2_ST_ALIVE)
537 gprs_ns2_st_alive(fi, event, data);
538 else
539 recv_test_procedure(fi);
540 break;
541 case GPRS_NS2_EV_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100542 /* UNITDATA has to handle the release of msg.
543 * If send upwards (gprs_ns2_recv_unitdata) it must NOT free
544 * the msg, the upper layer has to do it.
545 * Otherwise the msg must be freed.
546 */
Alexander Couzens6a161492020-07-12 13:45:50 +0200547 switch (fi->state) {
548 case GPRS_NS2_ST_BLOCKED:
549 /* 7.2.1: the BLOCKED_ACK might be lost */
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100550 if (priv->initiate_block) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100551 gprs_ns2_recv_unitdata(fi, msg);
552 return;
553 }
554
555 ns2_tx_status(priv->nsvc,
556 NS_CAUSE_NSVC_BLOCKED,
557 0, msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200558 break;
559 /* ALIVE can receive UNITDATA if the ALIVE_ACK is lost */
560 case GPRS_NS2_ST_ALIVE:
561 case GPRS_NS2_ST_UNBLOCKED:
Alexander Couzenscce88282020-10-26 00:25:50 +0100562 gprs_ns2_recv_unitdata(fi, msg);
563 return;
Alexander Couzens6a161492020-07-12 13:45:50 +0200564 }
Alexander Couzenscce88282020-10-26 00:25:50 +0100565
566 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200567 break;
Daniel Willmanned0c9822020-11-18 14:08:07 +0100568 case GPRS_NS2_EV_FORCE_UNCONFIGURED:
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100569 if (fi->state != GPRS_NS2_ST_UNCONFIGURED) {
570 /* Force the NSVC back to its initial state */
571 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNCONFIGURED, 0, 0);
572 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_START, NULL);
573 return;
574 }
Daniel Willmanned0c9822020-11-18 14:08:07 +0100575 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200576 }
577}
578
Alexander Couzens0346b642020-10-27 13:05:56 +0100579static void gprs_ns2_vc_fsm_clean(struct osmo_fsm_inst *fi,
580 enum osmo_fsm_term_cause cause)
581{
582 struct gprs_ns2_vc_priv *priv = fi->priv;
583
584 osmo_timer_del(&priv->alive.timer);
585}
586
Alexander Couzens6a161492020-07-12 13:45:50 +0200587static struct osmo_fsm gprs_ns2_vc_fsm = {
588 .name = "GPRS-NS2-VC",
589 .states = gprs_ns2_vc_states,
590 .num_states = ARRAY_SIZE(gprs_ns2_vc_states),
591 .allstate_event_mask = S(GPRS_NS2_EV_UNITDATA) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100592 S(GPRS_NS2_EV_RESET) |
Alexander Couzens6a161492020-07-12 13:45:50 +0200593 S(GPRS_NS2_EV_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100594 S(GPRS_NS2_EV_ALIVE_ACK) |
595 S(GPRS_NS2_EV_FORCE_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200596 .allstate_action = gprs_ns2_vc_fsm_allstate_action,
Alexander Couzens0346b642020-10-27 13:05:56 +0100597 .cleanup = gprs_ns2_vc_fsm_clean,
Alexander Couzens6a161492020-07-12 13:45:50 +0200598 .timer_cb = gprs_ns2_vc_fsm_timer_cb,
599 /* .log_subsys = DNS, "is not constant" */
600 .event_names = gprs_ns2_vc_event_names,
601 .pre_term = NULL,
602 .log_subsys = DLNS,
603};
604
605/*!
606 * \brief gprs_ns2_vc_fsm_alloc
607 * \param ctx
608 * \param vc
609 * \param id a char representation of the virtual curcuit
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100610 * \param initiator initiator is the site which starts the connection. Usually the BSS.
Alexander Couzens6a161492020-07-12 13:45:50 +0200611 * \return NULL on error, otherwise the fsm
612 */
613struct osmo_fsm_inst *gprs_ns2_vc_fsm_alloc(struct gprs_ns2_vc *nsvc,
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100614 const char *id, bool initiator)
Alexander Couzens6a161492020-07-12 13:45:50 +0200615{
616 struct osmo_fsm_inst *fi;
617 struct gprs_ns2_vc_priv *priv;
618
619 fi = osmo_fsm_inst_alloc(&gprs_ns2_vc_fsm, nsvc, NULL, LOGL_DEBUG, id);
620 if (!fi)
621 return fi;
622
623 nsvc->fi = fi;
624 priv = fi->priv = talloc_zero(fi, struct gprs_ns2_vc_priv);
625 priv->nsvc = nsvc;
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100626 priv->initiate_reset = initiator;
627 priv->initiate_block = initiator;
Alexander Couzens6a161492020-07-12 13:45:50 +0200628
629 osmo_timer_setup(&priv->alive.timer, alive_timeout_handler, fi);
630
631 return fi;
632}
633
Harald Welte5bef2cc2020-09-18 22:33:24 +0200634/*! Start a NS-VC FSM.
635 * \param nsvc the virtual circuit
636 * \return 0 on success; negative on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200637int gprs_ns2_vc_fsm_start(struct gprs_ns2_vc *nsvc)
638{
639 /* allows to call this function even for started nsvc by gprs_ns2_start_alive_all_nsvcs */
640 if (nsvc->fi->state == GPRS_NS2_ST_UNCONFIGURED)
641 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_START, NULL);
642 return 0;
643}
644
Daniel Willmanned0c9822020-11-18 14:08:07 +0100645/*! Reset a NS-VC FSM.
646 * \param nsvc the virtual circuit
647 * \return 0 on success; negative on error */
648int gprs_ns2_vc_force_unconfigured(struct gprs_ns2_vc *nsvc)
649{
650 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_FORCE_UNCONFIGURED, NULL);
651}
652
Harald Welte5bef2cc2020-09-18 22:33:24 +0200653/*! entry point for messages from the driver/VL
654 * \param nsvc virtual circuit on which the message was received
655 * \param msg message that was received
656 * \param tp parsed TLVs of the received message
657 * \return 0 on success; negative on error */
Alexander Couzens6a161492020-07-12 13:45:50 +0200658int gprs_ns2_vc_rx(struct gprs_ns2_vc *nsvc, struct msgb *msg, struct tlv_parsed *tp)
659{
660 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
661 struct osmo_fsm_inst *fi = nsvc->fi;
Alexander Couzenscce88282020-10-26 00:25:50 +0100662 int rc = 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200663 uint8_t cause;
664
665 /* TODO: 7.2: on UNBLOCK/BLOCK: check if NS-VCI is correct,
666 * if not answer STATUS with "NS-VC unknown" */
667 /* TODO: handle RESET with different VCI */
668 /* TODO: handle BLOCK/UNBLOCK/ALIVE with different VCI */
669
670 if (gprs_ns2_validate(nsvc, nsh->pdu_type, msg, tp, &cause)) {
671 if (nsh->pdu_type != NS_PDUT_STATUS) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100672 rc = ns2_tx_status(nsvc, cause, 0, msg);
673 goto out;
Alexander Couzens6a161492020-07-12 13:45:50 +0200674 }
675 }
676
677 switch (nsh->pdu_type) {
678 case NS_PDUT_RESET:
679 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RESET, tp);
680 break;
681 case NS_PDUT_RESET_ACK:
682 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RESET_ACK, tp);
683 break;
684 case NS_PDUT_BLOCK:
685 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_BLOCK, tp);
686 break;
687 case NS_PDUT_BLOCK_ACK:
688 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_BLOCK_ACK, tp);
689 break;
690 case NS_PDUT_UNBLOCK:
691 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNBLOCK, tp);
692 break;
693 case NS_PDUT_UNBLOCK_ACK:
694 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNBLOCK_ACK, tp);
695 break;
696 case NS_PDUT_ALIVE:
697 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_ALIVE, tp);
698 break;
699 case NS_PDUT_ALIVE_ACK:
700 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_ALIVE_ACK, tp);
701 break;
702 case NS_PDUT_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100703 /* UNITDATA have to free msg because it might send the msg layer upwards */
Alexander Couzens6a161492020-07-12 13:45:50 +0200704 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_UNITDATA, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100705 return 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200706 default:
707 LOGP(DLNS, LOGL_ERROR, "NSEI=%u Rx unknown NS PDU type %s\n", nsvc->nse->nsei,
708 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));
709 return -EINVAL;
710 }
711
Alexander Couzenscce88282020-10-26 00:25:50 +0100712out:
713 msgb_free(msg);
714
715 return rc;
Alexander Couzens6a161492020-07-12 13:45:50 +0200716}
717
Harald Welte5bef2cc2020-09-18 22:33:24 +0200718/*! is the given NS-VC unblocked? */
Alexander Couzens6a161492020-07-12 13:45:50 +0200719int gprs_ns2_vc_is_unblocked(struct gprs_ns2_vc *nsvc)
720{
721 return (nsvc->fi->state == GPRS_NS2_ST_UNBLOCKED);
722}
723
724/* initialize osmo_ctx on main tread */
725static __attribute__((constructor)) void on_dso_load_ctx(void)
726{
727 OSMO_ASSERT(osmo_fsm_register(&gprs_ns2_vc_fsm) == 0);
728}