Harald Welte | 3dcdd20 | 2019-03-09 13:06:46 +0100 | [diff] [blame] | 1 | /* (C) 2018-2019 by Harald Welte <laforge@gnumonks.org> |
| 2 | * |
| 3 | * All Rights Reserved |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 2 of the License, or |
| 10 | * (at your option) any later version. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
| 16 | * |
Harald Welte | 3dcdd20 | 2019-03-09 13:06:46 +0100 | [diff] [blame] | 17 | */ |
| 18 | |
| 19 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 20 | #include <stdint.h> |
| 21 | #include <string.h> |
| 22 | #include <errno.h> |
| 23 | |
| 24 | #include <talloc.h> |
| 25 | |
| 26 | #include <osmocom/core/logging.h> |
| 27 | #include <osmocom/core/utils.h> |
| 28 | #include <osmocom/core/msgb.h> |
| 29 | #include <osmocom/core/fsm.h> |
| 30 | |
| 31 | #include <osmocom/abis/ipa.h> |
| 32 | #include <osmocom/gsm/protocol/ipaccess.h> |
| 33 | |
Harald Welte | f7598fe | 2019-12-16 16:52:45 +0100 | [diff] [blame] | 34 | #include "debug.h" |
| 35 | #include "rspro_client_fsm.h" |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 36 | |
| 37 | #define S(x) (1 << (x)) |
| 38 | |
Harald Welte | 707c85a | 2019-03-09 12:56:35 +0100 | [diff] [blame] | 39 | #define T1_WAIT_CLIENT_CONN_RES 10 |
| 40 | #define T2_RECONNECT 10 |
| 41 | |
| 42 | /*********************************************************************** |
Harald Welte | 0a68497 | 2019-12-02 20:10:59 +0100 | [diff] [blame] | 43 | * client-side FSM for a RSPRO connection to remsim-server |
| 44 | * |
| 45 | * This implements the TCP/IPA client side of an RSPRO connection between |
| 46 | * a logical (TCP-level) client implementation and a remote RSPRO server. |
| 47 | * |
| 48 | * 'client' and 'server' here strictly refer to RSPRO protocol roles, not |
| 49 | * to be confused with the remsim-client or remsim-server! |
| 50 | * |
| 51 | * Specifically, this RSPRO client FSM is used by both remsim-client and |
| 52 | * remsim-bankd for their RSPRO control connection to remsim-server. |
Harald Welte | 707c85a | 2019-03-09 12:56:35 +0100 | [diff] [blame] | 53 | ***********************************************************************/ |
| 54 | |
Harald Welte | 7f0e82f | 2018-10-14 20:07:59 +0200 | [diff] [blame] | 55 | static void push_and_send(struct ipa_client_conn *ipa, struct msgb *msg_tx) |
| 56 | { |
| 57 | ipa_prepend_header_ext(msg_tx, IPAC_PROTO_EXT_RSPRO); |
| 58 | ipa_msg_push_header(msg_tx, IPAC_PROTO_OSMO); |
| 59 | ipa_client_conn_send(ipa, msg_tx); |
| 60 | /* msg_tx is now queued and will be freed. */ |
| 61 | } |
| 62 | |
Harald Welte | 6d61b16 | 2019-12-02 22:47:35 +0100 | [diff] [blame] | 63 | static int ipa_client_conn_send_rspro(struct ipa_client_conn *ipa, RsproPDU_t *rspro) |
Harald Welte | 7f0e82f | 2018-10-14 20:07:59 +0200 | [diff] [blame] | 64 | { |
| 65 | struct msgb *msg = rspro_enc_msg(rspro); |
Harald Welte | 2eee450 | 2019-03-30 08:50:35 +0100 | [diff] [blame] | 66 | if (!msg) { |
Harald Welte | 46122ab | 2021-12-08 20:57:16 +0100 | [diff] [blame] | 67 | LOGP(DRSPRO, LOGL_ERROR, "Error encoding RSPRO: %s\n", rspro_msgt_name(rspro)); |
| 68 | osmo_log_backtrace(DRSPRO, LOGL_ERROR); |
Harald Welte | 2eee450 | 2019-03-30 08:50:35 +0100 | [diff] [blame] | 69 | ASN_STRUCT_FREE(asn_DEF_RsproPDU, rspro); |
Harald Welte | a844bb0 | 2019-03-09 13:38:50 +0100 | [diff] [blame] | 70 | return -1; |
Harald Welte | 2eee450 | 2019-03-30 08:50:35 +0100 | [diff] [blame] | 71 | } |
Harald Welte | 7f0e82f | 2018-10-14 20:07:59 +0200 | [diff] [blame] | 72 | push_and_send(ipa, msg); |
Harald Welte | a844bb0 | 2019-03-09 13:38:50 +0100 | [diff] [blame] | 73 | return 0; |
| 74 | } |
| 75 | |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 76 | static int _server_conn_send_rspro(struct rspro_server_conn *srvc, RsproPDU_t *rspro) |
| 77 | { |
Harald Welte | 8934412 | 2021-12-08 15:55:06 +0100 | [diff] [blame] | 78 | LOGPFSML(srvc->fi, LOGL_DEBUG, "Tx RSPRO %s\n", rspro_msgt_name(rspro)); |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 79 | return ipa_client_conn_send_rspro(srvc->conn, rspro); |
| 80 | } |
| 81 | |
Harald Welte | a844bb0 | 2019-03-09 13:38:50 +0100 | [diff] [blame] | 82 | int server_conn_send_rspro(struct rspro_server_conn *srvc, RsproPDU_t *rspro) |
| 83 | { |
Harald Welte | a8b86ce | 2019-03-31 14:59:20 +0200 | [diff] [blame] | 84 | if (!rspro) { |
| 85 | LOGPFSML(srvc->fi, LOGL_ERROR, "Attempt to transmit NULL\n"); |
Harald Welte | 46122ab | 2021-12-08 20:57:16 +0100 | [diff] [blame] | 86 | osmo_log_backtrace(DRSPRO, LOGL_ERROR); |
Harald Welte | a8b86ce | 2019-03-31 14:59:20 +0200 | [diff] [blame] | 87 | return -EINVAL; |
| 88 | } |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 89 | if (osmo_fsm_inst_dispatch(srvc->fi, SRVC_E_RSPRO_TX, rspro) < 0) { |
| 90 | ASN_STRUCT_FREE(asn_DEF_RsproPDU, rspro); |
| 91 | return -EPERM; |
| 92 | } |
| 93 | return 0; |
Harald Welte | 7f0e82f | 2018-10-14 20:07:59 +0200 | [diff] [blame] | 94 | } |
| 95 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 96 | enum server_conn_fsm_state { |
| 97 | /* waiting for initial connectiong to remsim-server */ |
| 98 | SRVC_ST_INIT, |
| 99 | /* server connection established, waiting for ClientConnectRes */ |
| 100 | SRVC_ST_ESTABLISHED, |
| 101 | /* server connection etsablished, ClientConnect succeeded */ |
| 102 | SRVC_ST_CONNECTED, |
| 103 | /* connection lost, we're waiting for a re-establish */ |
| 104 | SRVC_ST_REESTABLISH, |
| 105 | }; |
| 106 | |
| 107 | static const struct value_string server_conn_fsm_event_names[] = { |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 108 | OSMO_VALUE_STRING(SRVC_E_ESTABLISH), |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 109 | OSMO_VALUE_STRING(SRVC_E_DISCONNECT), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 110 | OSMO_VALUE_STRING(SRVC_E_TCP_UP), |
| 111 | OSMO_VALUE_STRING(SRVC_E_TCP_DOWN), |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 112 | OSMO_VALUE_STRING(SRVC_E_KA_TIMEOUT), |
Harald Welte | b8ec65a | 2019-12-14 17:16:12 +0100 | [diff] [blame] | 113 | OSMO_VALUE_STRING(SRVC_E_KA_TERMINATED), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 114 | OSMO_VALUE_STRING(SRVC_E_CLIENT_CONN_RES), |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 115 | OSMO_VALUE_STRING(SRVC_E_RSPRO_TX), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 116 | { 0, NULL } |
| 117 | }; |
| 118 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 119 | static void srvc_updown_cb(struct ipa_client_conn *conn, int up) |
| 120 | { |
| 121 | struct rspro_server_conn *srvc = conn->data; |
| 122 | |
Harald Welte | 8934412 | 2021-12-08 15:55:06 +0100 | [diff] [blame] | 123 | LOGPFSML(srvc->fi, LOGL_NOTICE, "RSPRO link to %s:%d %s\n", |
| 124 | conn->addr, conn->port, up ? "UP" : "DOWN"); |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 125 | |
| 126 | osmo_fsm_inst_dispatch(srvc->fi, up ? SRVC_E_TCP_UP: SRVC_E_TCP_DOWN, 0); |
| 127 | } |
| 128 | |
| 129 | static int srvc_read_cb(struct ipa_client_conn *conn, struct msgb *msg) |
| 130 | { |
| 131 | struct ipaccess_head *hh = (struct ipaccess_head *) msg->data; |
| 132 | struct ipaccess_head_ext *he = (struct ipaccess_head_ext *) msgb_l2(msg); |
| 133 | struct rspro_server_conn *srvc = conn->data; |
Harald Welte | f9995a3 | 2018-10-14 20:40:05 +0200 | [diff] [blame] | 134 | RsproPDU_t *pdu; |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 135 | int rc; |
| 136 | |
| 137 | if (msgb_length(msg) < sizeof(*hh)) |
| 138 | goto invalid; |
| 139 | msg->l2h = &hh->data[0]; |
Harald Welte | 1a17104 | 2019-03-08 19:18:52 +0100 | [diff] [blame] | 140 | switch (hh->proto) { |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 141 | case IPAC_PROTO_IPACCESS: |
| 142 | rc = ipaccess_bts_handle_ccm(srvc->conn, &srvc->ipa_dev, msg); |
Harald Welte | cacbc2b | 2019-07-24 18:42:02 +0200 | [diff] [blame] | 143 | if (rc < 0) { |
| 144 | msgb_free(msg); |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 145 | break; |
Harald Welte | cacbc2b | 2019-07-24 18:42:02 +0200 | [diff] [blame] | 146 | } |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 147 | switch (hh->data[0]) { |
| 148 | case IPAC_MSGT_PONG: |
| 149 | ipa_keepalive_fsm_pong_received(srvc->keepalive_fi); |
| 150 | rc = 0; |
| 151 | break; |
| 152 | default: |
| 153 | break; |
| 154 | } |
| 155 | break; |
Harald Welte | 1a17104 | 2019-03-08 19:18:52 +0100 | [diff] [blame] | 156 | case IPAC_PROTO_OSMO: |
| 157 | if (!he || msgb_l2len(msg) < sizeof(*he)) |
| 158 | goto invalid; |
| 159 | msg->l2h = &he->data[0]; |
| 160 | switch (he->proto) { |
| 161 | case IPAC_PROTO_EXT_RSPRO: |
Harald Welte | 8934412 | 2021-12-08 15:55:06 +0100 | [diff] [blame] | 162 | LOGPFSML(srvc->fi, LOGL_DEBUG, "Received RSPRO %s\n", msgb_hexdump(msg)); |
Harald Welte | 1a17104 | 2019-03-08 19:18:52 +0100 | [diff] [blame] | 163 | pdu = rspro_dec_msg(msg); |
Harald Welte | 9cdd094 | 2019-12-15 00:10:57 +0100 | [diff] [blame] | 164 | if (!pdu) { |
| 165 | rc = -EIO; |
Harald Welte | 573a5b9 | 2019-09-12 20:27:58 +0200 | [diff] [blame] | 166 | break; |
Harald Welte | 9cdd094 | 2019-12-15 00:10:57 +0100 | [diff] [blame] | 167 | } |
Harald Welte | 1a17104 | 2019-03-08 19:18:52 +0100 | [diff] [blame] | 168 | rc = srvc->handle_rx(srvc, pdu); |
| 169 | ASN_STRUCT_FREE(asn_DEF_RsproPDU, pdu); |
| 170 | break; |
| 171 | default: |
| 172 | goto invalid; |
| 173 | } |
| 174 | break; |
| 175 | default: |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 176 | goto invalid; |
Harald Welte | 1a17104 | 2019-03-08 19:18:52 +0100 | [diff] [blame] | 177 | } |
Harald Welte | 573a5b9 | 2019-09-12 20:27:58 +0200 | [diff] [blame] | 178 | |
| 179 | msgb_free(msg); |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 180 | return rc; |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 181 | |
| 182 | invalid: |
Harald Welte | e57334e | 2019-03-27 22:58:10 +0100 | [diff] [blame] | 183 | LOGPFSML(srvc->fi, LOGL_ERROR, "Error decoding PDU\n"); |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 184 | msgb_free(msg); |
| 185 | return -1; |
| 186 | } |
| 187 | |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 188 | static const struct ipa_keepalive_params ka_params = { |
| 189 | .interval = 30, |
| 190 | .wait_for_resp = 10, |
| 191 | }; |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 192 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 193 | static void srvc_st_init(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| 194 | { |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 195 | switch (event) { |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 196 | case SRVC_E_ESTABLISH: |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 197 | default: |
| 198 | OSMO_ASSERT(0); |
| 199 | } |
| 200 | } |
| 201 | |
| 202 | static void srvc_st_established_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state) |
| 203 | { |
| 204 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 205 | RsproPDU_t *pdu; |
| 206 | |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 207 | ipa_keepalive_fsm_start(srvc->keepalive_fi); |
| 208 | |
Harald Welte | 707c85a | 2019-03-09 12:56:35 +0100 | [diff] [blame] | 209 | if (srvc->own_comp_id.type == ComponentType_remsimClient) |
| 210 | pdu = rspro_gen_ConnectClientReq(&srvc->own_comp_id, srvc->clslot); |
| 211 | else |
Harald Welte | 4fa407a | 2019-04-01 21:05:06 +0200 | [diff] [blame] | 212 | pdu = rspro_gen_ConnectBankReq(&srvc->own_comp_id, srvc->bankd.bank_id, |
| 213 | srvc->bankd.num_slots); |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 214 | _server_conn_send_rspro(srvc, pdu); |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 215 | } |
| 216 | |
| 217 | static void srvc_st_established(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| 218 | { |
Harald Welte | 4e7a285 | 2019-03-17 21:01:50 +0100 | [diff] [blame] | 219 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 220 | RsproPDU_t *pdu = NULL; |
| 221 | e_ResultCode res; |
| 222 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 223 | switch (event) { |
| 224 | case SRVC_E_TCP_DOWN: |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 225 | case SRVC_E_KA_TIMEOUT: |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 226 | osmo_fsm_inst_state_chg(fi, SRVC_ST_REESTABLISH, T2_RECONNECT, 2); |
| 227 | break; |
| 228 | case SRVC_E_CLIENT_CONN_RES: |
Harald Welte | 4e7a285 | 2019-03-17 21:01:50 +0100 | [diff] [blame] | 229 | pdu = data; |
| 230 | res = rspro_get_result(pdu); |
| 231 | if (res != ResultCode_ok) { |
| 232 | ipa_client_conn_close(srvc->conn); |
| 233 | osmo_fsm_inst_dispatch(fi, SRVC_E_TCP_DOWN, NULL); |
| 234 | } else { |
| 235 | /* somehow notify the main code? */ |
| 236 | osmo_fsm_inst_state_chg(fi, SRVC_ST_CONNECTED, 0, 0); |
| 237 | } |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 238 | break; |
| 239 | default: |
| 240 | OSMO_ASSERT(0); |
| 241 | } |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 242 | } |
| 243 | |
Harald Welte | b266d50 | 2020-02-22 20:53:19 +0100 | [diff] [blame] | 244 | static void srvc_st_connected_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state) |
| 245 | { |
| 246 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 247 | |
| 248 | if (fi->proc.parent) |
| 249 | osmo_fsm_inst_dispatch(fi->proc.parent, srvc->parent_conn_evt, NULL); |
| 250 | } |
| 251 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 252 | static void srvc_st_connected(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| 253 | { |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 254 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 255 | RsproPDU_t *pdu = NULL; |
| 256 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 257 | switch (event) { |
| 258 | case SRVC_E_TCP_DOWN: |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 259 | case SRVC_E_KA_TIMEOUT: |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 260 | osmo_fsm_inst_state_chg(fi, SRVC_ST_REESTABLISH, T2_RECONNECT, 2); |
| 261 | break; |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 262 | case SRVC_E_RSPRO_TX: |
| 263 | pdu = data; |
| 264 | _server_conn_send_rspro(srvc, pdu); |
| 265 | break; |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 266 | default: |
| 267 | OSMO_ASSERT(0); |
| 268 | } |
| 269 | } |
| 270 | |
Harald Welte | b266d50 | 2020-02-22 20:53:19 +0100 | [diff] [blame] | 271 | static void srvc_st_connected_onleave(struct osmo_fsm_inst *fi, uint32_t next_state) |
| 272 | { |
| 273 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 274 | |
| 275 | if (fi->proc.parent) |
| 276 | osmo_fsm_inst_dispatch(fi->proc.parent, srvc->parent_disc_evt, NULL); |
| 277 | } |
| 278 | |
Harald Welte | b8ec65a | 2019-12-14 17:16:12 +0100 | [diff] [blame] | 279 | static int ipa_kaepalive_timeout_cb(struct osmo_fsm_inst *ka_fi, void *conn) |
| 280 | { |
| 281 | struct osmo_fsm_inst *fi = ka_fi->proc.parent; |
| 282 | osmo_fsm_inst_dispatch(fi, SRVC_E_KA_TIMEOUT, NULL); |
| 283 | return 0; /* we will explicitly terminate it */ |
| 284 | } |
| 285 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 286 | static void srvc_st_reestablish_onenter(struct osmo_fsm_inst *fi, uint32_t prev_state) |
| 287 | { |
| 288 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 289 | int rc; |
| 290 | |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 291 | if (srvc->keepalive_fi) { |
| 292 | ipa_keepalive_fsm_stop(srvc->keepalive_fi); |
| 293 | osmo_fsm_inst_term(srvc->keepalive_fi, OSMO_FSM_TERM_REGULAR, NULL); |
| 294 | srvc->keepalive_fi = NULL; |
| 295 | } |
| 296 | |
| 297 | if (srvc->conn) { |
| 298 | LOGPFSML(fi, LOGL_INFO, "Destroying existing connection to server\n"); |
| 299 | ipa_client_conn_close(srvc->conn); |
| 300 | ipa_client_conn_destroy(srvc->conn); |
| 301 | srvc->conn = NULL; |
| 302 | } |
| 303 | LOGPFSML(fi, LOGL_INFO, "Creating TCP connection to server at %s:%u\n", |
| 304 | srvc->server_host, srvc->server_port); |
Harald Welte | 8da2209 | 2020-02-16 15:59:32 +0100 | [diff] [blame] | 305 | srvc->conn = ipa_client_conn_create2(fi, NULL, 0, NULL, 0, srvc->server_host, srvc->server_port, |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 306 | srvc_updown_cb, srvc_read_cb, NULL, srvc); |
| 307 | if (!srvc->conn) { |
| 308 | LOGPFSML(fi, LOGL_FATAL, "Unable to create socket: %s\n", strerror(errno)); |
| 309 | exit(1); |
| 310 | } |
| 311 | |
| 312 | srvc->keepalive_fi = ipa_client_conn_alloc_keepalive_fsm(srvc->conn, &ka_params, fi->id); |
| 313 | if (!srvc->keepalive_fi) { |
| 314 | LOGPFSM(fi, "Unable to create keepalive FSM\n"); |
| 315 | exit(1); |
| 316 | } |
Harald Welte | b8ec65a | 2019-12-14 17:16:12 +0100 | [diff] [blame] | 317 | ipa_keepalive_fsm_set_timeout_cb(srvc->keepalive_fi, ipa_kaepalive_timeout_cb); |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 318 | /* ensure parent is notified once keepalive FSM instance is dying */ |
Harald Welte | b8ec65a | 2019-12-14 17:16:12 +0100 | [diff] [blame] | 319 | osmo_fsm_inst_change_parent(srvc->keepalive_fi, srvc->fi, SRVC_E_KA_TERMINATED); |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 320 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 321 | /* Attempt to connect TCP socket */ |
| 322 | rc = ipa_client_conn_open(srvc->conn); |
| 323 | if (rc < 0) { |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 324 | LOGPFSML(fi, LOGL_FATAL, "Unable to connect RSPRO to %s:%u - %s\n", |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 325 | srvc->server_host, srvc->server_port, strerror(errno)); |
| 326 | /* FIXME: retry? Timer? Abort? */ |
| 327 | OSMO_ASSERT(0); |
| 328 | } |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 329 | } |
| 330 | |
| 331 | static void srvc_st_reestablish(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| 332 | { |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 333 | switch (event) { |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 334 | case SRVC_E_TCP_UP: |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 335 | osmo_fsm_inst_state_chg(fi, SRVC_ST_ESTABLISHED, T1_WAIT_CLIENT_CONN_RES, 1); |
| 336 | break; |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 337 | case SRVC_E_TCP_DOWN: |
| 338 | /* wait for normal T2 call-back */ |
| 339 | break; |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 340 | default: |
| 341 | OSMO_ASSERT(0); |
| 342 | } |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 343 | } |
| 344 | |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 345 | static void srvc_allstate_action(struct osmo_fsm_inst *fi, uint32_t event, void *data) |
| 346 | { |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 347 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 348 | |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 349 | switch (event) { |
| 350 | case SRVC_E_ESTABLISH: |
| 351 | osmo_fsm_inst_state_chg(fi, SRVC_ST_REESTABLISH, T2_RECONNECT, 2); |
| 352 | break; |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 353 | case SRVC_E_DISCONNECT: |
| 354 | if (srvc->keepalive_fi) { |
| 355 | ipa_keepalive_fsm_stop(srvc->keepalive_fi); |
| 356 | osmo_fsm_inst_term(srvc->keepalive_fi, OSMO_FSM_TERM_REGULAR, NULL); |
| 357 | srvc->keepalive_fi = NULL; |
| 358 | } |
| 359 | if (srvc->conn) { |
| 360 | LOGPFSML(fi, LOGL_INFO, "Destroying existing connection to server\n"); |
| 361 | ipa_client_conn_close(srvc->conn); |
| 362 | ipa_client_conn_destroy(srvc->conn); |
| 363 | srvc->conn = NULL; |
| 364 | } |
| 365 | osmo_fsm_inst_state_chg(fi, SRVC_ST_INIT, 0, 0); |
| 366 | break; |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 367 | default: |
| 368 | OSMO_ASSERT(0); |
| 369 | } |
| 370 | } |
| 371 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 372 | static int server_conn_fsm_timer_cb(struct osmo_fsm_inst *fi) |
| 373 | { |
Harald Welte | a025e70 | 2019-03-09 21:39:09 +0100 | [diff] [blame] | 374 | struct rspro_server_conn *srvc = (struct rspro_server_conn *) fi->priv; |
| 375 | |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 376 | switch (fi->T) { |
| 377 | case 2: |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 378 | /* TCP reconnect failed: retry */ |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 379 | osmo_fsm_inst_state_chg(fi, SRVC_ST_REESTABLISH, T2_RECONNECT, 2); |
| 380 | break; |
| 381 | case 1: |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 382 | /* no ClientConnectRes received: disconnect + reconnect */ |
Harald Welte | a025e70 | 2019-03-09 21:39:09 +0100 | [diff] [blame] | 383 | ipa_client_conn_close(srvc->conn); |
| 384 | osmo_fsm_inst_dispatch(fi, SRVC_E_TCP_DOWN, NULL); |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 385 | break; |
| 386 | default: |
| 387 | OSMO_ASSERT(0); |
| 388 | } |
| 389 | |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 390 | return 0; |
| 391 | } |
| 392 | |
| 393 | static const struct osmo_fsm_state server_conn_fsm_states[] = { |
| 394 | [SRVC_ST_INIT] = { |
| 395 | .name = "INIT", |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 396 | .in_event_mask = 0, /* S(SRVC_E_ESTABLISH) via allstate */ |
Harald Welte | 0e968cc | 2020-02-22 18:16:16 +0100 | [diff] [blame] | 397 | .out_state_mask = S(SRVC_ST_INIT) | S(SRVC_ST_REESTABLISH), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 398 | .action = srvc_st_init, |
| 399 | }, |
| 400 | [SRVC_ST_ESTABLISHED] = { |
| 401 | .name = "ESTABLISHED", |
Harald Welte | 03b2411 | 2019-03-08 19:43:02 +0100 | [diff] [blame] | 402 | .in_event_mask = S(SRVC_E_TCP_DOWN) | S(SRVC_E_KA_TIMEOUT) | S(SRVC_E_CLIENT_CONN_RES), |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 403 | .out_state_mask = S(SRVC_ST_CONNECTED) | S(SRVC_ST_REESTABLISH) | S(SRVC_ST_INIT), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 404 | .action = srvc_st_established, |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 405 | .onenter = srvc_st_established_onenter, |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 406 | }, |
| 407 | [SRVC_ST_CONNECTED] = { |
| 408 | .name = "CONNECTED", |
Harald Welte | a3b14d1 | 2019-12-02 22:58:34 +0100 | [diff] [blame] | 409 | .in_event_mask = S(SRVC_E_TCP_DOWN) | S(SRVC_E_KA_TIMEOUT) | S(SRVC_E_RSPRO_TX), |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 410 | .out_state_mask = S(SRVC_ST_REESTABLISH) | S(SRVC_ST_INIT), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 411 | .action = srvc_st_connected, |
Harald Welte | b266d50 | 2020-02-22 20:53:19 +0100 | [diff] [blame] | 412 | .onenter = srvc_st_connected_onenter, |
| 413 | .onleave = srvc_st_connected_onleave, |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 414 | }, |
| 415 | [SRVC_ST_REESTABLISH] = { |
| 416 | .name = "REESTABLISH", |
Harald Welte | 52cc7db | 2018-09-24 11:51:51 +0200 | [diff] [blame] | 417 | .in_event_mask = S(SRVC_E_TCP_UP) | S(SRVC_E_TCP_DOWN), |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 418 | .out_state_mask = S(SRVC_ST_ESTABLISHED) | S(SRVC_ST_REESTABLISH) | S(SRVC_ST_INIT), |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 419 | .action = srvc_st_reestablish, |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 420 | .onenter = srvc_st_reestablish_onenter, |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 421 | }, |
| 422 | }; |
| 423 | |
Harald Welte | 3cded63 | 2019-03-09 12:59:41 +0100 | [diff] [blame] | 424 | struct osmo_fsm rspro_client_server_fsm = { |
| 425 | .name = "RSPRO_CLIENT", |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 426 | .states = server_conn_fsm_states, |
| 427 | .num_states = ARRAY_SIZE(server_conn_fsm_states), |
Harald Welte | 16c81ea | 2020-02-16 14:44:00 +0100 | [diff] [blame] | 428 | .allstate_event_mask = S(SRVC_E_ESTABLISH) | S(SRVC_E_DISCONNECT), |
Harald Welte | d2192e2 | 2019-11-07 18:10:57 +0100 | [diff] [blame] | 429 | .allstate_action = srvc_allstate_action, |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 430 | .timer_cb = server_conn_fsm_timer_cb, |
Harald Welte | 46122ab | 2021-12-08 20:57:16 +0100 | [diff] [blame] | 431 | .log_subsys = DRSPRO, |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 432 | .event_names = server_conn_fsm_event_names, |
| 433 | }; |
| 434 | |
Harald Welte | 098ef87 | 2018-10-14 20:08:50 +0200 | [diff] [blame] | 435 | int server_conn_fsm_alloc(void *ctx, struct rspro_server_conn *srvc) |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 436 | { |
| 437 | struct osmo_fsm_inst *fi; |
| 438 | |
Harald Welte | 3cded63 | 2019-03-09 12:59:41 +0100 | [diff] [blame] | 439 | fi = osmo_fsm_inst_alloc(&rspro_client_server_fsm, ctx, srvc, LOGL_DEBUG, "server"); |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 440 | if (!fi) |
| 441 | return -1; |
| 442 | |
Harald Welte | 84ba234 | 2018-08-24 22:20:20 +0200 | [diff] [blame] | 443 | srvc->fi = fi; |
Harald Welte | 24173fb | 2018-08-24 20:37:28 +0200 | [diff] [blame] | 444 | return 0; |
| 445 | } |
Harald Welte | 7fc64bc | 2019-03-02 12:55:59 +0100 | [diff] [blame] | 446 | |
| 447 | static __attribute__((constructor)) void on_dso_load(void) |
| 448 | { |
Harald Welte | 4ccd2fc | 2019-12-01 13:32:54 +0100 | [diff] [blame] | 449 | OSMO_ASSERT(osmo_fsm_register(&rspro_client_server_fsm) == 0); |
Harald Welte | 7fc64bc | 2019-03-02 12:55:59 +0100 | [diff] [blame] | 450 | } |