223 lines
6.9 KiB
C
223 lines
6.9 KiB
C
/* SM PDUs, 3GPP TS 24.008 Session Management Messages */
|
|
/* (C) 2023 by Sysmocom s.f.m.c. GmbH
|
|
*
|
|
* All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as published by
|
|
* the Free Software Foundation; either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Affero General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Affero General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <errno.h>
|
|
|
|
#include <osmocom/core/msgb.h>
|
|
#include <osmocom/core/bitvec.h>
|
|
#include <osmocom/core/endian.h>
|
|
#include <osmocom/core/socket.h>
|
|
#include <osmocom/gsm/tlv.h>
|
|
#include <osmocom/gsm/protocol/gsm_04_08.h>
|
|
#include <osmocom/gsm/protocol/gsm_04_08_gprs.h>
|
|
#include <osmocom/gsm/apn.h>
|
|
|
|
#include <osmocom/gprs/sm/sm_private.h>
|
|
#include <osmocom/gprs/sm/sm_pdu.h>
|
|
|
|
|
|
const struct tlv_definition gprs_sm_att_tlvdef = {
|
|
.def = {
|
|
[GSM48_IE_GSM_RADIO_PRIO] = {TLV_TYPE_SINGLE_TV, 1 },
|
|
[GSM48_IE_GSM_APN] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_PROTO_CONF_OPT] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_PDP_ADDR] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_AA_TMR] = { TLV_TYPE_TV, 1 },
|
|
[GSM48_IE_GSM_QOS] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_TFT] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_LLC_SAPI] = { TLV_TYPE_TV, 1 },
|
|
[GSM48_IE_GSM_PFI] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_NAME_FULL] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_NAME_SHORT] = { TLV_TYPE_TLV, 0 },
|
|
[GSM48_IE_GSM_TIMEZONE] = { TLV_TYPE_FIXED, 1 },
|
|
[GSM48_IE_GSM_UTC_AND_TZ] = { TLV_TYPE_FIXED, 7 },
|
|
[GSM48_IE_GSM_LSA_ID] = { TLV_TYPE_TLV, 0 },
|
|
},
|
|
};
|
|
|
|
/* 10.5.6.4 Packet data protocol address */
|
|
static uint8_t gprs_sm_pdp_addr_enc_ietf(struct gprs_sm_pdp_addr *out,
|
|
enum osmo_gprs_sm_pdp_addr_ietf_type pdp_addr_ietf_type,
|
|
const struct osmo_sockaddr *pdp_addr_v4,
|
|
const struct osmo_sockaddr *pdp_addr_v6)
|
|
{
|
|
memset(out, 0, sizeof(*out));
|
|
unsigned int len = 2;
|
|
|
|
out->spare = 0x00;
|
|
out->organization = GPRS_SM_PDP_ADDR_ORG_IETF;
|
|
out->type = pdp_addr_ietf_type;
|
|
|
|
switch (pdp_addr_ietf_type) {
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV6:
|
|
if (pdp_addr_v6) {
|
|
memcpy(out->addr6, pdp_addr_v6->u.sin6.sin6_addr.s6_addr, sizeof(out->addr6));
|
|
len += sizeof(out->addr6);
|
|
}
|
|
break;
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV4V6:
|
|
if (pdp_addr_v4) {
|
|
out->both.addr = pdp_addr_v4->u.sin.sin_addr.s_addr;
|
|
len += sizeof(out->both.addr);
|
|
if (pdp_addr_v6) {
|
|
memcpy(out->both.addr6, pdp_addr_v6->u.sin6.sin6_addr.s6_addr, sizeof(out->both.addr6));
|
|
len += sizeof(out->both.addr6);
|
|
}
|
|
} else if (pdp_addr_v6) {
|
|
memcpy(out->addr6, pdp_addr_v6->u.sin6.sin6_addr.s6_addr, sizeof(out->addr6));
|
|
len += sizeof(out->addr6);
|
|
}
|
|
break;
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV4:
|
|
default:
|
|
/* All other values shall be interpreted as IPv4 address in this version of the protocol */
|
|
if (pdp_addr_v4) {
|
|
out->addr = pdp_addr_v4->u.sin.sin_addr.s_addr;
|
|
len += sizeof(out->both.addr);
|
|
}
|
|
break;
|
|
}
|
|
return len;
|
|
}
|
|
|
|
int gprs_sm_pdp_addr_dec(const struct gprs_sm_pdp_addr *pdp_addr,
|
|
uint16_t pdp_addr_len,
|
|
enum osmo_gprs_sm_pdp_addr_ietf_type *pdp_addr_ietf_type,
|
|
struct osmo_sockaddr *osa4,
|
|
struct osmo_sockaddr *osa6)
|
|
{
|
|
|
|
OSMO_ASSERT(pdp_addr);
|
|
OSMO_ASSERT(pdp_addr_ietf_type);
|
|
OSMO_ASSERT(osa4);
|
|
OSMO_ASSERT(osa6);
|
|
|
|
memset(osa4, 0, sizeof(*osa4));
|
|
memset(osa6, 0, sizeof(*osa6));
|
|
osa4->u.sa.sa_family = AF_UNSPEC;
|
|
osa6->u.sa.sa_family = AF_UNSPEC;
|
|
|
|
switch (pdp_addr->organization) {
|
|
case GPRS_SM_PDP_ADDR_ORG_IETF:
|
|
break;
|
|
case GPRS_SM_PDP_ADDR_ORG_ETSI:
|
|
default:
|
|
LOGSM(LOGL_INFO, "Unsupported PDP address organization %u\n", pdp_addr->organization);
|
|
return -EINVAL;
|
|
}
|
|
|
|
pdp_addr_len -= 2;
|
|
switch (pdp_addr->type) {
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV4:
|
|
if (pdp_addr_len == sizeof(pdp_addr->addr)) {
|
|
osa4->u.sa.sa_family = AF_INET;
|
|
osa4->u.sin.sin_addr.s_addr = pdp_addr->addr;
|
|
} else if (pdp_addr_len != 0) {
|
|
LOGSM(LOGL_INFO, "Wrong IPv4 PDP address length %u\n", pdp_addr_len);
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV6:
|
|
if (pdp_addr_len == sizeof(pdp_addr->addr6)) {
|
|
osa6->u.sa.sa_family = AF_INET6;
|
|
memcpy(osa6->u.sin6.sin6_addr.s6_addr, pdp_addr->addr6, sizeof(pdp_addr->addr6));
|
|
} else if (pdp_addr_len != 0) {
|
|
LOGSM(LOGL_INFO, "Wrong IPv6 PDP address length %u\n", pdp_addr_len);
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
case OSMO_GPRS_SM_PDP_ADDR_IETF_IPV4V6:
|
|
if (pdp_addr_len == sizeof(pdp_addr->addr)) {
|
|
osa4->u.sa.sa_family = AF_INET;
|
|
osa4->u.sin.sin_addr.s_addr = pdp_addr->both.addr;
|
|
} else if (pdp_addr_len == sizeof(pdp_addr->both.addr6)) {
|
|
osa6->u.sa.sa_family = AF_INET6;
|
|
memcpy(osa6->u.sin6.sin6_addr.s6_addr, pdp_addr->both.addr6, sizeof(pdp_addr->both.addr6));
|
|
} else if (pdp_addr_len == sizeof(pdp_addr->both)) {
|
|
osa4->u.sa.sa_family = AF_INET;
|
|
osa4->u.sin.sin_addr.s_addr = pdp_addr->both.addr;
|
|
osa6->u.sa.sa_family = AF_INET6;
|
|
memcpy(osa6->u.sin6.sin6_addr.s6_addr, pdp_addr->both.addr6, sizeof(pdp_addr->both.addr6));
|
|
} else if (pdp_addr_len != 0) {
|
|
LOGSM(LOGL_INFO, "Wrong IPv4v6 PDP address length %u\n", pdp_addr_len);
|
|
return -EINVAL;
|
|
}
|
|
break;
|
|
default:
|
|
LOGSM(LOGL_INFO, "No IPv4 or IPv6\n");
|
|
return -EINVAL;
|
|
}
|
|
*pdp_addr_ietf_type = pdp_addr->type;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Chapter 9.5.1: Activate PDP Context Request */
|
|
int gprs_sm_build_act_pdp_ctx_req(struct gprs_sm_entity *sme,
|
|
struct msgb *msg)
|
|
{
|
|
|
|
struct gsm48_hdr *gh;
|
|
uint8_t *l;
|
|
int rc;
|
|
uint8_t transaction_id = sme->ti ^ 0x8; /* flip */
|
|
|
|
gh = (struct gsm48_hdr *) msgb_put(msg, sizeof(*gh));
|
|
gh->proto_discr = GSM48_PDISC_SM_GPRS | (transaction_id << 4);
|
|
gh->msg_type = GSM48_MT_GSM_ACT_PDP_REQ;
|
|
|
|
/* 10.5.6.2 Requested NSAPI */
|
|
msgb_v_put(msg, sme->nsapi);
|
|
|
|
/* 10.5.6.9 Requested LLC SAPI */
|
|
msgb_v_put(msg, sme->llc_sapi);
|
|
|
|
/* 10.5.6.5 Requested QoS */
|
|
msgb_lv_put(msg, sme->qos_len, (uint8_t *)&sme->qos);
|
|
|
|
/* 10.5.6.4 Requested PDP address */
|
|
l = msgb_put(msg, 1); /* len */
|
|
*l = gprs_sm_pdp_addr_enc_ietf((struct gprs_sm_pdp_addr *)msg->tail,
|
|
sme->pdp_addr_ietf_type,
|
|
!osmo_sockaddr_is_any(&sme->pdp_addr_v4) ? &sme->pdp_addr_v4 : NULL,
|
|
!osmo_sockaddr_is_any(&sme->pdp_addr_v6) ? &sme->pdp_addr_v6 : NULL);
|
|
msgb_put(msg, *l);
|
|
|
|
/* 10.5.6.1 Access point name (Optional) */
|
|
if (sme->apn[0] != '\0') {
|
|
msgb_v_put(msg, GSM48_IE_GSM_APN);
|
|
l = msgb_put(msg, 1); /* len */
|
|
rc = osmo_apn_from_str(msg->tail, msgb_tailroom(msg), sme->apn);
|
|
if (rc < 0)
|
|
return -EINVAL;
|
|
*l = rc;
|
|
msgb_put(msg, *l);
|
|
}
|
|
|
|
/* 10.5.6.3 Protocol configuration options (Optional) */
|
|
if (sme->pco_len > 0)
|
|
msgb_tlv_put(msg, GSM48_IE_GSM_PROTO_CONF_OPT,
|
|
sme->pco_len, sme->pco);
|
|
|
|
/* TODO: other optional fields */
|
|
return 0;
|
|
}
|