blob: e69f327e98a5a68cc70d7337eba8c0788bd176d4 [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
Alexander Couzens47afc422021-01-17 20:12:46 +0100376 priv->accept_unitdata = true;
Daniel Willmann15c09a82020-11-03 23:05:43 +0100377 ns2_nse_notify_unblocked(nsvc, true);
Alexander Couzens138b96f2021-01-25 16:23:29 +0100378 ns2_prim_status_ind(nse, nsvc, 0, GPRS_NS2_AFF_CAUSE_VC_RECOVERY);
Alexander Couzens6a161492020-07-12 13:45:50 +0200379}
380
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100381static void ns2_st_unblocked(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200382{
383 struct gprs_ns2_vc_priv *priv = fi->priv;
384
385 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100386 case GPRS_NS2_EV_RX_UNBLOCK:
Alexander Couzensc4b74622021-01-10 20:44:26 +0100387 ns2_tx_unblock_ack(priv->nsvc);
388 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100389 case GPRS_NS2_EV_RX_BLOCK:
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100390 priv->initiate_block = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200391 ns2_tx_block_ack(priv->nsvc);
392 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED,
393 0, 2);
394 break;
395 }
396}
397
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100398static void ns2_st_alive(struct osmo_fsm_inst *fi, uint32_t event, void *data)
Alexander Couzens6a161492020-07-12 13:45:50 +0200399{
400 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100401 case GPRS_NS2_EV_RX_ALIVE_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200402 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNBLOCKED, 0, 0);
403 break;
404 }
405}
406
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100407static void ns2_st_alive_onenter(struct osmo_fsm_inst *fi, uint32_t old_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200408{
409 struct gprs_ns2_vc_priv *priv = fi->priv;
410 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
411
412 priv->alive.mode = NS_TOUT_TNS_TEST;
413 osmo_timer_schedule(&priv->alive.timer, nsi->timeout[NS_TOUT_TNS_TEST], 0);
414
415 if (old_state != GPRS_NS2_ST_ALIVE)
416 priv->N = 0;
417
418 ns2_tx_alive(priv->nsvc);
419 ns2_nse_notify_unblocked(priv->nsvc, false);
420}
421
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100422static void ns2_st_alive_onleave(struct osmo_fsm_inst *fi, uint32_t next_state)
Alexander Couzens6a161492020-07-12 13:45:50 +0200423{
424 start_test_procedure(fi->priv);
425}
426
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100427static const struct osmo_fsm_state ns2_vc_states[] = {
Alexander Couzens6a161492020-07-12 13:45:50 +0200428 [GPRS_NS2_ST_UNCONFIGURED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100429 .in_event_mask = S(GPRS_NS2_EV_REQ_START),
Alexander Couzens6a161492020-07-12 13:45:50 +0200430 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE),
431 .name = "UNCONFIGURED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100432 .action = ns2_st_unconfigured,
Alexander Couzens6a161492020-07-12 13:45:50 +0200433 },
434 [GPRS_NS2_ST_RESET] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100435 .in_event_mask = S(GPRS_NS2_EV_RX_RESET_ACK) | S(GPRS_NS2_EV_RX_RESET),
Alexander Couzens6a161492020-07-12 13:45:50 +0200436 .out_state_mask = S(GPRS_NS2_ST_RESET) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100437 S(GPRS_NS2_ST_BLOCKED) |
438 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200439 .name = "RESET",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100440 .action = ns2_st_reset,
441 .onenter = ns2_st_reset_onenter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200442 },
443 [GPRS_NS2_ST_BLOCKED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100444 .in_event_mask = S(GPRS_NS2_EV_RX_BLOCK) | S(GPRS_NS2_EV_RX_BLOCK_ACK) |
445 S(GPRS_NS2_EV_RX_UNBLOCK) | S(GPRS_NS2_EV_RX_UNBLOCK_ACK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200446 .out_state_mask = S(GPRS_NS2_ST_RESET) |
447 S(GPRS_NS2_ST_UNBLOCKED) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100448 S(GPRS_NS2_ST_BLOCKED) |
449 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200450 .name = "BLOCKED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100451 .action = ns2_st_blocked,
452 .onenter = ns2_st_blocked_onenter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200453 },
454 [GPRS_NS2_ST_UNBLOCKED] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100455 .in_event_mask = S(GPRS_NS2_EV_RX_BLOCK) | S(GPRS_NS2_EV_RX_UNBLOCK_ACK) |
456 S(GPRS_NS2_EV_RX_UNBLOCK),
Alexander Couzens6a161492020-07-12 13:45:50 +0200457 .out_state_mask = S(GPRS_NS2_ST_RESET) | S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100458 S(GPRS_NS2_ST_BLOCKED) |
459 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200460 .name = "UNBLOCKED",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100461 .action = ns2_st_unblocked,
462 .onenter = ns2_st_unblocked_on_enter,
Alexander Couzens6a161492020-07-12 13:45:50 +0200463 },
464
465 /* ST_ALIVE is only used on VC without RESET/BLOCK */
466 [GPRS_NS2_ST_ALIVE] = {
Alexander Couzensf5775432021-01-18 13:49:00 +0100467 .in_event_mask = S(GPRS_NS2_EV_RX_ALIVE_ACK),
Alexander Couzens191c2d72021-01-19 17:59:45 +0100468 .out_state_mask = S(GPRS_NS2_ST_ALIVE) |
Daniel Willmanned0c9822020-11-18 14:08:07 +0100469 S(GPRS_NS2_ST_UNBLOCKED) |
470 S(GPRS_NS2_ST_UNCONFIGURED),
Alexander Couzens6a161492020-07-12 13:45:50 +0200471 .name = "ALIVE",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100472 .action = ns2_st_alive,
473 .onenter = ns2_st_alive_onenter,
474 .onleave = ns2_st_alive_onleave,
Alexander Couzens6a161492020-07-12 13:45:50 +0200475 },
476};
477
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100478static int ns2_vc_fsm_timer_cb(struct osmo_fsm_inst *fi)
Alexander Couzens6a161492020-07-12 13:45:50 +0200479{
480 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
481 struct gprs_ns2_vc_priv *priv = fi->priv;
482
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100483 switch (fi->state) {
484 case GPRS_NS2_ST_RESET:
485 if (priv->initiate_reset) {
Harald Welte4c54f592021-01-30 22:42:15 +0100486 rate_ctr_inc(&priv->nsvc->ctrg->ctr[NS_CTR_LOST_RESET]);
Alexander Couzens6a161492020-07-12 13:45:50 +0200487 priv->N++;
488 if (priv->N <= nsi->timeout[NS_TOUT_TNS_RESET_RETRIES]) {
489 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
490 } else {
491 priv->N = 0;
492 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
493 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100494 }
495 break;
496 case GPRS_NS2_ST_BLOCKED:
497 if (priv->initiate_block) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200498 priv->N++;
Alexander Couzens47afc422021-01-17 20:12:46 +0100499 if (priv->om_blocked) {
500 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
501 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
502 } else {
503 /* 7.2 stop accepting data when BLOCK PDU not responded */
504 priv->accept_unitdata = false;
505 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200506 } else {
Alexander Couzens47afc422021-01-17 20:12:46 +0100507 if (priv->N <= nsi->timeout[NS_TOUT_TNS_BLOCK_RETRIES]) {
508 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
509 } else {
510 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], 0);
511 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200512 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100513 }
514 break;
515 case GPRS_NS2_ST_ALIVE:
516 if (priv->initiate_reset) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200517 priv->N++;
518 if (priv->N <= nsi->timeout[NS_TOUT_TNS_ALIVE_RETRIES]) {
519 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
520 } else {
521 priv->N = 0;
522 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_ALIVE, 0, 0);
523 }
524 break;
525 }
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100526 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200527 }
528 return 0;
529}
530
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100531static void ns2_recv_unitdata(struct osmo_fsm_inst *fi,
Alexander Couzens6a161492020-07-12 13:45:50 +0200532 struct msgb *msg)
533{
534 struct gprs_ns2_vc_priv *priv = fi->priv;
535 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
536 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
537 struct osmo_gprs_ns2_prim nsp = {};
538 uint16_t bvci;
539
Alexander Couzenscce88282020-10-26 00:25:50 +0100540 if (msgb_l2len(msg) < sizeof(*nsh) + 3) {
541 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200542 return;
Alexander Couzenscce88282020-10-26 00:25:50 +0100543 }
Alexander Couzens6a161492020-07-12 13:45:50 +0200544
545 /* TODO: 7.1: For an IP sub-network, an NS-UNITDATA PDU
546 * for a PTP BVC may indicate a request to change the IP endpoint
547 * and/or a response to a change in the IP endpoint. */
548
549 /* TODO: nsh->data[0] -> C/R only valid in IP SNS */
550 bvci = nsh->data[1] << 8 | nsh->data[2];
551
Alexander Couzens89acdef2020-09-23 18:22:31 +0200552 msg->l3h = &nsh->data[3];
553 nsp.bvci = bvci;
554 nsp.nsei = priv->nsvc->nse->nsei;
Alexander Couzens6a161492020-07-12 13:45:50 +0200555
Alexander Couzensc1cd3332020-09-23 23:24:02 +0200556 /* 10.3.9 NS SDU Control Bits */
557 if (nsh->data[0] & 0x1)
Alexander Couzens138b96f2021-01-25 16:23:29 +0100558 nsp.u.unitdata.change = GPRS_NS2_ENDPOINT_REQUEST_CHANGE;
Alexander Couzens6a161492020-07-12 13:45:50 +0200559
Alexander Couzens138b96f2021-01-25 16:23:29 +0100560 osmo_prim_init(&nsp.oph, SAP_NS, GPRS_NS2_PRIM_UNIT_DATA,
Alexander Couzens6a161492020-07-12 13:45:50 +0200561 PRIM_OP_INDICATION, msg);
562 nsi->cb(&nsp.oph, nsi->cb_data);
563}
564
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100565static void ns2_vc_fsm_allstate_action(struct osmo_fsm_inst *fi,
Alexander Couzens6a161492020-07-12 13:45:50 +0200566 uint32_t event,
567 void *data)
568{
569 struct gprs_ns2_vc_priv *priv = fi->priv;
570 struct gprs_ns2_inst *nsi = ns_inst_from_fi(fi);
Alexander Couzenscce88282020-10-26 00:25:50 +0100571 struct msgb *msg = data;
Alexander Couzens6a161492020-07-12 13:45:50 +0200572
573 switch (event) {
Alexander Couzensf5775432021-01-18 13:49:00 +0100574 case GPRS_NS2_EV_RX_RESET:
Alexander Couzens138b96f2021-01-25 16:23:29 +0100575 if (priv->nsvc->mode != GPRS_NS2_VC_MODE_BLOCKRESET)
Alexander Couzens6a161492020-07-12 13:45:50 +0200576 break;
577
578 /* move the FSM into reset */
579 if (fi->state != GPRS_NS2_ST_RESET) {
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100580 priv->initiate_reset = false;
Alexander Couzens6a161492020-07-12 13:45:50 +0200581 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_RESET, nsi->timeout[NS_TOUT_TNS_RESET], NS_TOUT_TNS_RESET);
582 }
583 /* pass the event down into FSM action */
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100584 ns2_st_reset(fi, event, data);
Alexander Couzens6a161492020-07-12 13:45:50 +0200585 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100586 case GPRS_NS2_EV_RX_ALIVE:
Alexander Couzens6a161492020-07-12 13:45:50 +0200587 switch (fi->state) {
588 case GPRS_NS2_ST_UNCONFIGURED:
589 case GPRS_NS2_ST_RESET:
590 /* ignore ALIVE */
591 break;
592 default:
593 ns2_tx_alive_ack(priv->nsvc);
594 }
595 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100596 case GPRS_NS2_EV_RX_ALIVE_ACK:
Alexander Couzens6a161492020-07-12 13:45:50 +0200597 /* for VCs without RESET/BLOCK/UNBLOCK, the connections comes after ALIVE_ACK unblocked */
598 if (fi->state == GPRS_NS2_ST_ALIVE)
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100599 ns2_st_alive(fi, event, data);
Alexander Couzens6a161492020-07-12 13:45:50 +0200600 else
601 recv_test_procedure(fi);
602 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100603 case GPRS_NS2_EV_RX_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100604 /* UNITDATA has to handle the release of msg.
605 * If send upwards (gprs_ns2_recv_unitdata) it must NOT free
606 * the msg, the upper layer has to do it.
607 * Otherwise the msg must be freed.
608 */
Alexander Couzens6a161492020-07-12 13:45:50 +0200609 switch (fi->state) {
610 case GPRS_NS2_ST_BLOCKED:
611 /* 7.2.1: the BLOCKED_ACK might be lost */
Alexander Couzens47afc422021-01-17 20:12:46 +0100612 if (priv->accept_unitdata) {
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100613 ns2_recv_unitdata(fi, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100614 return;
615 }
616
617 ns2_tx_status(priv->nsvc,
618 NS_CAUSE_NSVC_BLOCKED,
619 0, msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200620 break;
621 /* ALIVE can receive UNITDATA if the ALIVE_ACK is lost */
622 case GPRS_NS2_ST_ALIVE:
623 case GPRS_NS2_ST_UNBLOCKED:
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100624 ns2_recv_unitdata(fi, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100625 return;
Alexander Couzens6a161492020-07-12 13:45:50 +0200626 }
Alexander Couzenscce88282020-10-26 00:25:50 +0100627
628 msgb_free(msg);
Alexander Couzens6a161492020-07-12 13:45:50 +0200629 break;
Alexander Couzensf5775432021-01-18 13:49:00 +0100630 case GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED:
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100631 if (fi->state != GPRS_NS2_ST_UNCONFIGURED) {
632 /* Force the NSVC back to its initial state */
633 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_UNCONFIGURED, 0, 0);
Alexander Couzensf5775432021-01-18 13:49:00 +0100634 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_REQ_START, NULL);
Alexander Couzens6f3b7382020-12-21 15:57:04 +0100635 return;
636 }
Daniel Willmanned0c9822020-11-18 14:08:07 +0100637 break;
Alexander Couzens47afc422021-01-17 20:12:46 +0100638 case GPRS_NS2_EV_REQ_OM_BLOCK:
639 /* vty cmd: block */
640 priv->initiate_block = true;
641 priv->om_blocked = true;
642 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
643 break;
644 case GPRS_NS2_EV_REQ_OM_UNBLOCK:
645 /* vty cmd: unblock*/
646 if (!priv->om_blocked)
647 return;
648 priv->om_blocked = false;
649 if (fi->state == GPRS_NS2_ST_BLOCKED)
650 osmo_fsm_inst_state_chg(fi, GPRS_NS2_ST_BLOCKED, nsi->timeout[NS_TOUT_TNS_BLOCK], 0);
651 break;
Alexander Couzens6a161492020-07-12 13:45:50 +0200652 }
653}
654
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100655static void ns2_vc_fsm_clean(struct osmo_fsm_inst *fi,
Alexander Couzens0346b642020-10-27 13:05:56 +0100656 enum osmo_fsm_term_cause cause)
657{
658 struct gprs_ns2_vc_priv *priv = fi->priv;
659
660 osmo_timer_del(&priv->alive.timer);
661}
662
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100663static struct osmo_fsm ns2_vc_fsm = {
Alexander Couzens6a161492020-07-12 13:45:50 +0200664 .name = "GPRS-NS2-VC",
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100665 .states = ns2_vc_states,
666 .num_states = ARRAY_SIZE(ns2_vc_states),
Alexander Couzensf5775432021-01-18 13:49:00 +0100667 .allstate_event_mask = S(GPRS_NS2_EV_RX_UNITDATA) |
668 S(GPRS_NS2_EV_RX_RESET) |
669 S(GPRS_NS2_EV_RX_ALIVE) |
670 S(GPRS_NS2_EV_RX_ALIVE_ACK) |
671 S(GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED) |
Alexander Couzens47afc422021-01-17 20:12:46 +0100672 S(GPRS_NS2_EV_REQ_OM_BLOCK) |
673 S(GPRS_NS2_EV_REQ_OM_UNBLOCK),
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100674 .allstate_action = ns2_vc_fsm_allstate_action,
675 .cleanup = ns2_vc_fsm_clean,
676 .timer_cb = ns2_vc_fsm_timer_cb,
Alexander Couzens6a161492020-07-12 13:45:50 +0200677 /* .log_subsys = DNS, "is not constant" */
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100678 .event_names = ns2_vc_event_names,
Alexander Couzens6a161492020-07-12 13:45:50 +0200679 .pre_term = NULL,
680 .log_subsys = DLNS,
681};
682
683/*!
684 * \brief gprs_ns2_vc_fsm_alloc
685 * \param ctx
686 * \param vc
687 * \param id a char representation of the virtual curcuit
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100688 * \param initiator initiator is the site which starts the connection. Usually the BSS.
Alexander Couzens6a161492020-07-12 13:45:50 +0200689 * \return NULL on error, otherwise the fsm
690 */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100691struct osmo_fsm_inst *ns2_vc_fsm_alloc(struct gprs_ns2_vc *nsvc,
Daniel Willmannf5b2e282020-11-18 18:51:25 +0100692 const char *id, bool initiator)
Alexander Couzens6a161492020-07-12 13:45:50 +0200693{
694 struct osmo_fsm_inst *fi;
695 struct gprs_ns2_vc_priv *priv;
696
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100697 fi = osmo_fsm_inst_alloc(&ns2_vc_fsm, nsvc, NULL, LOGL_DEBUG, id);
Alexander Couzens6a161492020-07-12 13:45:50 +0200698 if (!fi)
699 return fi;
700
701 nsvc->fi = fi;
702 priv = fi->priv = talloc_zero(fi, struct gprs_ns2_vc_priv);
703 priv->nsvc = nsvc;
Alexander Couzensea01bf22021-01-18 14:01:01 +0100704 priv->initiator = initiator;
Alexander Couzens6a161492020-07-12 13:45:50 +0200705
706 osmo_timer_setup(&priv->alive.timer, alive_timeout_handler, fi);
707
708 return fi;
709}
710
Harald Welte5bef2cc2020-09-18 22:33:24 +0200711/*! Start a NS-VC FSM.
712 * \param nsvc the virtual circuit
713 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100714int ns2_vc_fsm_start(struct gprs_ns2_vc *nsvc)
Alexander Couzens6a161492020-07-12 13:45:50 +0200715{
716 /* allows to call this function even for started nsvc by gprs_ns2_start_alive_all_nsvcs */
717 if (nsvc->fi->state == GPRS_NS2_ST_UNCONFIGURED)
Alexander Couzensf5775432021-01-18 13:49:00 +0100718 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_START, NULL);
Alexander Couzens6a161492020-07-12 13:45:50 +0200719 return 0;
720}
721
Daniel Willmanned0c9822020-11-18 14:08:07 +0100722/*! Reset a NS-VC FSM.
723 * \param nsvc the virtual circuit
724 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100725int ns2_vc_force_unconfigured(struct gprs_ns2_vc *nsvc)
Daniel Willmanned0c9822020-11-18 14:08:07 +0100726{
Alexander Couzensf5775432021-01-18 13:49:00 +0100727 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_FORCE_UNCONFIGURED, NULL);
Daniel Willmanned0c9822020-11-18 14:08:07 +0100728}
729
Alexander Couzens47afc422021-01-17 20:12:46 +0100730/*! Block a NS-VC.
731 * \param nsvc the virtual circuit
732 * \return 0 on success; negative on error */
733int ns2_vc_block(struct gprs_ns2_vc *nsvc)
734{
735 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_OM_BLOCK, NULL);
736}
737
738/*! Unblock a NS-VC.
739 * \param nsvc the virtual circuit
740 * \return 0 on success; negative on error */
741int ns2_vc_unblock(struct gprs_ns2_vc *nsvc)
742{
743 return osmo_fsm_inst_dispatch(nsvc->fi, GPRS_NS2_EV_REQ_OM_UNBLOCK, NULL);
744}
745
Harald Welte5bef2cc2020-09-18 22:33:24 +0200746/*! entry point for messages from the driver/VL
747 * \param nsvc virtual circuit on which the message was received
748 * \param msg message that was received
749 * \param tp parsed TLVs of the received message
750 * \return 0 on success; negative on error */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100751int ns2_vc_rx(struct gprs_ns2_vc *nsvc, struct msgb *msg, struct tlv_parsed *tp)
Alexander Couzens6a161492020-07-12 13:45:50 +0200752{
753 struct gprs_ns_hdr *nsh = (struct gprs_ns_hdr *) msg->l2h;
754 struct osmo_fsm_inst *fi = nsvc->fi;
Alexander Couzenscce88282020-10-26 00:25:50 +0100755 int rc = 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200756 uint8_t cause;
Alexander Couzens3f576ab2021-01-20 14:50:31 +0100757 uint16_t nsei, nsvci;
Alexander Couzens6a161492020-07-12 13:45:50 +0200758
759 /* TODO: 7.2: on UNBLOCK/BLOCK: check if NS-VCI is correct,
760 * if not answer STATUS with "NS-VC unknown" */
Alexander Couzens6a161492020-07-12 13:45:50 +0200761 /* TODO: handle BLOCK/UNBLOCK/ALIVE with different VCI */
762
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100763 if (ns2_validate(nsvc, nsh->pdu_type, msg, tp, &cause)) {
Alexander Couzens6a161492020-07-12 13:45:50 +0200764 if (nsh->pdu_type != NS_PDUT_STATUS) {
Alexander Couzenscce88282020-10-26 00:25:50 +0100765 rc = ns2_tx_status(nsvc, cause, 0, msg);
766 goto out;
Alexander Couzens6a161492020-07-12 13:45:50 +0200767 }
768 }
769
Alexander Couzens43771df2021-01-20 13:03:03 +0100770 if (TLVP_PRESENT(tp, NS_IE_NSEI)) {
771 nsei = tlvp_val16be(tp, NS_IE_NSEI);
772 if (nsei != nsvc->nse->nsei) {
773 /* 48.016 § 7.3.1 send, RESET_ACK to wrong NSVCI + ignore */
774 if (nsh->pdu_type == NS_PDUT_RESET)
775 ns2_tx_reset_ack(nsvc);
776
777 LOGNSVC(nsvc, LOGL_ERROR, "Rx %s with wrong NSEI=%05u. Ignoring PDU.\n",
778 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type), nsei);
779 goto out;
780 }
781 }
782
Alexander Couzens3f576ab2021-01-20 14:50:31 +0100783 if (nsvc->nsvci_is_valid && TLVP_PRESENT(tp, NS_IE_VCI)) {
784 nsvci = tlvp_val16be(tp, NS_IE_VCI);
785 if (nsvci != nsvc->nsvci) {
786 /* 48.016 § 7.3.1 send RESET_ACK to wrong NSVCI + ignore */
787 if (nsh->pdu_type == NS_PDUT_RESET)
788 ns2_tx_reset_ack(nsvc);
789
790 LOGNSVC(nsvc, LOGL_ERROR, "Rx %s with wrong NSVCI=%05u. Ignoring PDU.\n",
791 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type), nsvci);
792 goto out;
793 }
794 }
795
Alexander Couzens6a161492020-07-12 13:45:50 +0200796 switch (nsh->pdu_type) {
797 case NS_PDUT_RESET:
Alexander Couzensf5775432021-01-18 13:49:00 +0100798 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_RESET, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200799 break;
800 case NS_PDUT_RESET_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100801 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_RESET_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200802 break;
803 case NS_PDUT_BLOCK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100804 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_BLOCK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200805 break;
806 case NS_PDUT_BLOCK_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100807 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_BLOCK_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200808 break;
809 case NS_PDUT_UNBLOCK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100810 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNBLOCK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200811 break;
812 case NS_PDUT_UNBLOCK_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100813 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNBLOCK_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200814 break;
815 case NS_PDUT_ALIVE:
Alexander Couzensf5775432021-01-18 13:49:00 +0100816 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_ALIVE, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200817 break;
818 case NS_PDUT_ALIVE_ACK:
Alexander Couzensf5775432021-01-18 13:49:00 +0100819 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_ALIVE_ACK, tp);
Alexander Couzens6a161492020-07-12 13:45:50 +0200820 break;
821 case NS_PDUT_UNITDATA:
Alexander Couzenscce88282020-10-26 00:25:50 +0100822 /* UNITDATA have to free msg because it might send the msg layer upwards */
Alexander Couzensf5775432021-01-18 13:49:00 +0100823 osmo_fsm_inst_dispatch(fi, GPRS_NS2_EV_RX_UNITDATA, msg);
Alexander Couzenscce88282020-10-26 00:25:50 +0100824 return 0;
Alexander Couzens6a161492020-07-12 13:45:50 +0200825 default:
Harald Weltef2949742021-01-20 14:54:14 +0100826 LOGPFSML(fi, LOGL_ERROR, "NSEI=%u Rx unknown NS PDU type %s\n", nsvc->nse->nsei,
827 get_value_string(gprs_ns_pdu_strings, nsh->pdu_type));
Alexander Couzens6a161492020-07-12 13:45:50 +0200828 return -EINVAL;
829 }
830
Alexander Couzenscce88282020-10-26 00:25:50 +0100831out:
832 msgb_free(msg);
833
834 return rc;
Alexander Couzens6a161492020-07-12 13:45:50 +0200835}
836
Harald Welte5bef2cc2020-09-18 22:33:24 +0200837/*! is the given NS-VC unblocked? */
Alexander Couzens8dfc24c2021-01-25 16:09:23 +0100838int ns2_vc_is_unblocked(struct gprs_ns2_vc *nsvc)
Alexander Couzens6a161492020-07-12 13:45:50 +0200839{
840 return (nsvc->fi->state == GPRS_NS2_ST_UNBLOCKED);
841}
842
843/* initialize osmo_ctx on main tread */
844static __attribute__((constructor)) void on_dso_load_ctx(void)
845{
Alexander Couzensf7e2cac2021-01-25 16:18:21 +0100846 OSMO_ASSERT(osmo_fsm_register(&ns2_vc_fsm) == 0);
Alexander Couzens6a161492020-07-12 13:45:50 +0200847}