6 #include <osmocom/core/msgb.h> 7 #include <osmocom/core/bit16gen.h> 8 #include <osmocom/core/bit32gen.h> 28 #define LV_GROSS_LEN(x) (x+1) 30 #define TLV_GROSS_LEN(x) (x+2) 32 #define TLV16_GROSS_LEN(x) ((2*x)+2) 34 #define TL16V_GROSS_LEN(x) (x+3) 36 #define L16TV_GROSS_LEN(x) (x+3) 38 #define T16LV_GROSS_LEN(x) (x+3) 41 #define TVLV_MAX_ONEBYTE 0x7f 85 static inline uint8_t *
lv_put(uint8_t *buf, uint8_t
len,
89 memcpy(buf, val, len);
94 static inline uint8_t *
tlv_put(uint8_t *buf, uint8_t tag, uint8_t
len,
99 memcpy(buf, val, len);
104 static inline uint8_t *
tlv16_put(uint8_t *buf, uint8_t tag, uint8_t
len,
109 memcpy(buf, val, len*2);
114 static inline uint8_t *
tl16v_put(uint8_t *buf, uint8_t tag, uint16_t
len,
120 memcpy(buf, val, len);
125 static inline uint8_t *
t16lv_put(uint8_t *buf, uint16_t tag, uint8_t
len,
131 memcpy(buf, val, len);
132 return buf + len + 2;
136 static inline uint8_t *
tvlv_put(uint8_t *buf, uint8_t tag, uint16_t
len,
142 ret =
tlv_put(buf, tag, len, val);
151 static inline uint8_t *
vt_gan_put(uint8_t *buf, uint16_t tag)
155 *buf++ = 0x80 | (tag >> 8);
156 *buf++ = (tag & 0xff);
180 memcpy(ret, val, len);
187 static inline uint8_t *
msgb_tlv16_put(
struct msgb *msg, uint8_t tag, uint8_t
len,
const uint16_t *val)
201 static inline uint8_t *
msgb_t16lv_put(
struct msgb *msg, uint16_t tag, uint8_t
len,
const uint8_t *val)
212 return tvlv_put(buf, tag, len, val);
217 uint16_t
len,
const uint8_t *val)
232 memcpy(buf, val, len);
237 static inline uint8_t *
v_put(uint8_t *buf, uint8_t val)
244 static inline uint8_t *
tv_put(uint8_t *buf, uint8_t tag,
254 unsigned int len,
const uint8_t *val)
257 memcpy(buf, val, len);
266 static inline uint8_t *
tv16_put(uint8_t *buf, uint8_t tag,
277 static inline uint8_t *
msgb_lv_put(
struct msgb *msg, uint8_t
len,
const uint8_t *val)
280 return lv_put(buf, len, val);
285 static inline uint8_t *
msgb_tlv_put(
struct msgb *msg, uint8_t tag, uint8_t
len,
const uint8_t *val)
288 return tlv_put(buf, tag, len, val);
293 static inline uint8_t *
msgb_tv_put(
struct msgb *msg, uint8_t tag, uint8_t val)
295 uint8_t *buf = msgb_put(msg, 2);
296 return tv_put(buf, tag, val);
302 unsigned int len,
const uint8_t *val)
304 uint8_t *buf = msgb_put(msg, 1+len);
310 static inline uint8_t *
msgb_v_put(
struct msgb *msg, uint8_t val)
312 uint8_t *buf = msgb_put(msg, 1);
313 return v_put(buf, val);
318 static inline uint8_t *
msgb_tv16_put(
struct msgb *msg, uint8_t tag, uint16_t val)
320 uint8_t *buf = msgb_put(msg, 3);
326 static inline uint8_t *
msgb_tlv_push(
struct msgb *msg, uint8_t tag, uint8_t
len,
const uint8_t *val)
335 static inline uint8_t *
msgb_tv_push(
struct msgb *msg, uint8_t tag, uint8_t val)
337 uint8_t *buf = msgb_push(msg, 2);
344 static inline uint8_t *
msgb_tv16_push(
struct msgb *msg, uint8_t tag, uint16_t val)
346 uint8_t *buf = msgb_push(msg, 3);
373 uint16_t
len,
const uint8_t *val)
420 int tlv_parse_one(uint8_t *o_tag, uint16_t *o_len,
const uint8_t **o_val,
422 const uint8_t *buf,
int buf_len);
424 const uint8_t *buf,
int buf_len, uint8_t lv_tag, uint8_t lv_tag2);
428 #define TLVP_PRESENT(x, y) ((x)->lv[y].val) 429 #define TLVP_LEN(x, y) (x)->lv[y].len 430 #define TLVP_VAL(x, y) (x)->lv[y].val 432 #define TLVP_PRES_LEN(tp, tag, min_len) \ 433 (TLVP_PRESENT(tp, tag) && TLVP_LEN(tp, tag) >= min_len) 443 memcpy(&res,
TLVP_VAL(tp, pos),
sizeof(res));
455 memcpy(&res,
TLVP_VAL(tp, pos),
sizeof(res));
466 return osmo_load16be(
TLVP_VAL(tp, pos));
476 return osmo_load32be(
TLVP_VAL(tp, pos));
483 size_t len, uint8_t **value);
485 uint8_t tag,
size_t len, uint8_t **value);
487 uint8_t *tag, uint8_t **value,
size_t *value_len);
489 uint8_t tag, uint8_t **value,
size_t *value_len);
491 uint8_t **value,
size_t *value_len);
static uint8_t * msgb_tv_push(struct msgb *msg, uint8_t tag, uint8_t val)
push (prepend) a TV field to a msgb
Definition: tlv.h:335
static uint16_t VTVLV_GAN_GROSS_LEN(uint16_t tag, uint16_t len)
gross length of vTvLV (tag+len+val)
Definition: tlv.h:67
static uint16_t tlvp_val16be(const struct tlv_parsed *tp, int pos)
Retrieve (possibly unaligned) TLV element and convert to host byte order.
Definition: tlv.h:464
static uint8_t * msgb_tv16_push(struct msgb *msg, uint8_t tag, uint16_t val)
push (prepend) a TV16 field to a msgb
Definition: tlv.h:344
static uint8_t * tv_put(uint8_t *buf, uint8_t tag, uint8_t val)
put (append) a TV field
Definition: tlv.h:244
static uint8_t * msgb_l16tv_put(struct msgb *msg, uint16_t len, uint8_t tag, const uint8_t *val)
put (append) a L16TV field to msgb
Definition: tlv.h:224
uint16_t len
length
Definition: tlv.h:384
int osmo_shift_v_fixed(uint8_t **data, size_t *data_len, size_t len, uint8_t **value)
Advance the data pointer, subtract length and assign value pointer.
Definition: tlv_parser.c:311
static uint8_t * msgb_tlv16_put(struct msgb *msg, uint8_t tag, uint8_t len, const uint16_t *val)
put (append) a TLV16 field to msgb
Definition: tlv.h:187
static uint8_t * msgb_tv_put(struct msgb *msg, uint8_t tag, uint8_t val)
put (append) a TV field to a msgb
Definition: tlv.h:293
int tlv_parse_one(uint8_t *o_tag, uint16_t *o_len, const uint8_t **o_val, const struct tlv_definition *def, const uint8_t *buf, int buf_len)
Parse a single TLV encoded IE.
Definition: tlv_parser.c:129
struct tlv_definition tvlv_att_def
Definition: tlv_parser.c:45
static uint8_t * msgb_tvlv_push(struct msgb *msg, uint8_t tag, uint16_t len, const uint8_t *val)
push (prepend) a TvLV field to a msgb
Definition: tlv.h:353
static uint32_t tlvp_val32be(const struct tlv_parsed *tp, int pos)
Retrieve (possibly unaligned) TLV element and convert to host byte order.
Definition: tlv.h:474
int osmo_match_shift_tv_fixed(uint8_t **data, size_t *data_len, uint8_t tag, size_t len, uint8_t **value)
Match tag, check length and assign value pointer.
Definition: tlv_parser.c:339
static uint16_t TVLV_GROSS_LEN(uint16_t len)
gross length of a TVLV type field
Definition: tlv.h:44
static uint8_t * vt_gan_put(uint8_t *buf, uint16_t tag)
put (append) a variable-length tag or variable-length length *
Definition: tlv.h:151
uint8_t type
Definition: gsm_04_08.h:91
static uint8_t * tvlv_put(uint8_t *buf, uint8_t tag, uint16_t len, const uint8_t *val)
put (append) a TvLV field
Definition: tlv.h:136
static uint8_t * lv_put(uint8_t *buf, uint8_t len, const uint8_t *val)
put (append) a LV field
Definition: tlv.h:85
static uint8_t * msgb_vtvl_gan_push(struct msgb *msg, uint16_t tag, uint16_t len)
Definition: tlv.h:363
int osmo_shift_tlv(uint8_t **data, size_t *data_len, uint8_t *tag, uint8_t **value, size_t *value_len)
Extract TLV and advance data pointer + subtract length.
Definition: tlv_parser.c:405
Entry in a TLV parser array.
Definition: tlv.h:383
#define TLV_GROSS_LEN(x)
gross length of a TLV type field
Definition: tlv.h:30
tag-value (8bit)
Definition: tlv.h:393
static uint8_t * tv_fixed_put(uint8_t *buf, uint8_t tag, unsigned int len, const uint8_t *val)
put (append) a TVfixed field
Definition: tlv.h:253
#define TL16V_GROSS_LEN(x)
gross length of a TL16V type field
Definition: tlv.h:34
no type
Definition: tlv.h:390
#define TVLV_MAX_ONEBYTE
maximum length of TLV of one byte length
Definition: tlv.h:41
static uint8_t * msgb_vtvlv_gan_put(struct msgb *msg, uint16_t tag, uint16_t len, const uint8_t *val)
put (append) a vTvLV field to msgb
Definition: tlv.h:216
static uint16_t VTVL_GAN_GROSS_LEN(uint16_t tag, uint16_t len)
gross length of vTvL header (tag+len)
Definition: tlv.h:53
static uint8_t * msgb_tv16_put(struct msgb *msg, uint8_t tag, uint16_t val)
put (append) a TV16 field to a msgb
Definition: tlv.h:318
#define TLV16_GROSS_LEN(x)
gross length of a TLV16 type field
Definition: tlv.h:32
Definition of a single IE (Information Element)
Definition: tlv.h:402
#define L16TV_GROSS_LEN(x)
gross length of a L16TV type field
Definition: tlv.h:36
static uint8_t * tl16v_put(uint8_t *buf, uint8_t tag, uint16_t len, const uint8_t *val)
put (append) a TL16V field
Definition: tlv.h:114
static uint8_t * msgb_tlv_put(struct msgb *msg, uint8_t tag, uint8_t len, const uint8_t *val)
put (append) a TLV field to a msgb
Definition: tlv.h:285
static uint8_t * tv16_put(uint8_t *buf, uint8_t tag, uint16_t val)
put (append) a TV16 field
Definition: tlv.h:266
static uint16_t tlvp_val16_unal(const struct tlv_parsed *tp, int pos)
Align given TLV element with 16 bit value to an even address.
Definition: tlv.h:440
static uint8_t * tlv16_put(uint8_t *buf, uint8_t tag, uint8_t len, const uint16_t *val)
put (append) a TLV16 field
Definition: tlv.h:104
int osmo_shift_lv(uint8_t **data, size_t *data_len, uint8_t **value, size_t *value_len)
Extract LV and advance data pointer + subtract length.
Definition: tlv_parser.c:445
tag-length-value
Definition: tlv.h:394
static uint8_t * msgb_tv_fixed_put(struct msgb *msg, uint8_t tag, unsigned int len, const uint8_t *val)
put (append) a TVfixed field to a msgb
Definition: tlv.h:301
int osmo_match_shift_tlv(uint8_t **data, size_t *data_len, uint8_t tag, uint8_t **value, size_t *value_len)
Verify TLV header and advance data / subtract length.
Definition: tlv_parser.c:377
static uint8_t * vtvl_gan_put(uint8_t *buf, uint16_t tag, uint16_t len)
Definition: tlv.h:164
uint8_t len
Definition: gsm_04_11.h:434
tlv_type
TLV type.
Definition: tlv.h:389
static uint8_t * v_put(uint8_t *buf, uint8_t val)
put (append) a V field
Definition: tlv.h:237
static uint8_t * msgb_tl16v_put(struct msgb *msg, uint8_t tag, uint16_t len, const uint8_t *val)
put (append) a TL16V field to msgb
Definition: tlv.h:194
variable-length tag, variable-length length
Definition: tlv.h:398
tag, 16 bit length, value
Definition: tlv.h:395
struct tlv_parsed * osmo_tlvp_copy(const struct tlv_parsed *tp_orig, void *ctx)
Copy tlv_parsed using given talloc context.
Definition: tlv_parser.c:66
#define T16LV_GROSS_LEN(x)
gross length of a T16LV type field
Definition: tlv.h:38
result of the TLV parser
Definition: tlv.h:413
static uint8_t * t16lv_put(uint8_t *buf, uint16_t tag, uint8_t len, const uint8_t *val)
put (append) a TL16V field
Definition: tlv.h:125
static uint8_t * tlv_put(uint8_t *buf, uint8_t tag, uint8_t len, const uint8_t *val)
put (append) a TLV field
Definition: tlv.h:94
uint8_t fixed_len
length in case of TLV_TYPE_FIXED
Definition: tlv.h:404
fixed-length value-only
Definition: tlv.h:391
void tlv_def_patch(struct tlv_definition *dst, const struct tlv_definition *src)
take a master (src) tlvdev and fill up all empty slots in 'dst'
Definition: tlv_parser.c:282
static uint8_t * msgb_vtvlv_gan_push(struct msgb *msg, uint16_t tag, uint16_t len, const uint8_t *val)
Definition: tlv.h:372
static uint32_t tlvp_val32_unal(const struct tlv_parsed *tp, int pos)
Align given TLV element with 32 bit value to an address that is a multiple of 4.
Definition: tlv.h:452
Definition of All 256 IE / TLV.
Definition: tlv.h:408
int osmo_tlvp_merge(struct tlv_parsed *dst, const struct tlv_parsed *src)
Merge all tlv_parsed attributes of 'src' into 'dst'.
Definition: tlv_parser.c:101
static uint8_t * msgb_v_put(struct msgb *msg, uint8_t val)
put (append) a V field to a msgb
Definition: tlv.h:310
int tlv_parse(struct tlv_parsed *dec, const struct tlv_definition *def, const uint8_t *buf, int buf_len, uint8_t lv_tag, uint8_t lv_tag2)
Parse an entire buffer of TLV encoded Information Elements.
Definition: tlv_parser.c:229
#define LV_GROSS_LEN(x)
gross length of a LV type field
Definition: tlv.h:28
tag-only
Definition: tlv.h:392
tag, variable length, value
Definition: tlv.h:396
const uint8_t * val
pointer to value
Definition: tlv.h:385
#define TLVP_VAL(x, y)
Definition: tlv.h:430
static uint8_t * vtvlv_gan_put(uint8_t *buf, uint16_t tag, uint16_t len, const uint8_t *val)
Definition: tlv.h:173
static uint8_t * msgb_tlv_push(struct msgb *msg, uint8_t tag, uint8_t len, const uint8_t *val)
push (prepend) a TLV field to a msgb
Definition: tlv.h:326
struct tlv_definition vtvlv_gan_att_def
Definition: tlv_parser.c:46
uint8_t data[0]
message payload data
Definition: gsm_03_41.h:108
static uint8_t * msgb_lv_put(struct msgb *msg, uint8_t len, const uint8_t *val)
put (append) a LV field to a msgb
Definition: tlv.h:277
static uint8_t * msgb_tvlv_put(struct msgb *msg, uint8_t tag, uint16_t len, const uint8_t *val)
put (append) a TvLV field to msgb
Definition: tlv.h:208
tag and value (both 4 bit) in 1 byte
Definition: tlv.h:397
static uint8_t * msgb_t16lv_put(struct msgb *msg, uint16_t tag, uint8_t len, const uint8_t *val)
Definition: tlv.h:201