Use libosmocore for SW Description parsing
Requires libosmocore with Ib63b6b5e83b8914864fc7edd789f8958cdc993cd. Change-Id: Ib94db414e94a2a1f234ac6f1cb346dca1c7a8be3
This commit is contained in:
parent
310b730798
commit
fd2c1f90ba
|
@ -68,18 +68,6 @@ struct abis_nm_cfg {
|
|||
int (*sw_act_req)(struct msgb *);
|
||||
};
|
||||
|
||||
struct abis_nm_sw_descr {
|
||||
/* where does it start? how long is it? */
|
||||
const uint8_t *start;
|
||||
size_t len;
|
||||
|
||||
/* the parsed data */
|
||||
const uint8_t *file_id;
|
||||
uint16_t file_id_len;
|
||||
const uint8_t *file_ver;
|
||||
uint16_t file_ver_len;
|
||||
};
|
||||
|
||||
extern int abis_nm_rcvmsg(struct msgb *msg);
|
||||
|
||||
int abis_nm_tlv_parse(struct tlv_parsed *tp, struct gsm_bts *bts, const uint8_t *buf, int len);
|
||||
|
@ -181,9 +169,7 @@ int _abis_nm_sendmsg(struct msgb *msg);
|
|||
|
||||
void abis_nm_queue_send_next(struct gsm_bts *bts); /* for bs11_config. */
|
||||
|
||||
int abis_nm_parse_sw_config(const uint8_t *data, const size_t len,
|
||||
struct abis_nm_sw_descr *res, const int res_len);
|
||||
int abis_nm_select_newest_sw(const struct abis_nm_sw_descr *sw, const size_t len);
|
||||
int abis_nm_select_newest_sw(const struct abis_nm_sw_desc *sw, const size_t len);
|
||||
|
||||
/* Helper functions for updating attributes */
|
||||
int abis_nm_update_max_power_red(struct gsm_bts_trx *trx);
|
||||
|
|
|
@ -52,6 +52,7 @@
|
|||
#include <openbsc/network_listen.h>
|
||||
#include <osmocom/core/talloc.h>
|
||||
#include <osmocom/abis/abis.h>
|
||||
#include <osmocom/gsm/protocol/gsm_12_21.h>
|
||||
|
||||
struct gsm_network *bsc_gsmnet;
|
||||
|
||||
|
@ -70,17 +71,9 @@ static char *firmware_analysis = NULL;
|
|||
static int found_trx = 0;
|
||||
static int loop_tests = 0;
|
||||
|
||||
struct sw_load {
|
||||
uint8_t file_id[255];
|
||||
uint8_t file_id_len;
|
||||
|
||||
uint8_t file_version[255];
|
||||
uint8_t file_version_len;
|
||||
};
|
||||
|
||||
static void *tall_ctx_config = NULL;
|
||||
static struct sw_load *sw_load1 = NULL;
|
||||
static struct sw_load *sw_load2 = NULL;
|
||||
static struct abis_nm_sw_desc *sw_load1 = NULL;
|
||||
static struct abis_nm_sw_desc *sw_load2 = NULL;
|
||||
|
||||
/*
|
||||
static uint8_t prim_oml_attr[] = { 0x95, 0x00, 7, 0x88, 192, 168, 100, 11, 0x00, 0x00 };
|
||||
|
@ -344,19 +337,11 @@ static int swload_cbfn(unsigned int hook, unsigned int event, struct msgb *_msg,
|
|||
msg->l3h = &msg->l2h[3];
|
||||
|
||||
/* activate software */
|
||||
if (sw_load1) {
|
||||
msgb_v_put(msg, NM_ATT_SW_DESCR);
|
||||
msgb_tl16v_put(msg, NM_ATT_FILE_ID, sw_load1->file_id_len, sw_load1->file_id);
|
||||
msgb_tl16v_put(msg, NM_ATT_FILE_VERSION, sw_load1->file_version_len,
|
||||
sw_load1->file_version);
|
||||
}
|
||||
if (sw_load1)
|
||||
abis_nm_put_sw_desc(msg, sw_load1, true);
|
||||
|
||||
if (sw_load2) {
|
||||
msgb_v_put(msg, NM_ATT_SW_DESCR);
|
||||
msgb_tl16v_put(msg, NM_ATT_FILE_ID, sw_load2->file_id_len, sw_load2->file_id);
|
||||
msgb_tl16v_put(msg, NM_ATT_FILE_VERSION, sw_load2->file_version_len,
|
||||
sw_load2->file_version);
|
||||
}
|
||||
if (sw_load2)
|
||||
abis_nm_put_sw_desc(msg, sw_load2, true);
|
||||
|
||||
/* fill in the data */
|
||||
msg->l2h[0] = NM_ATT_IPACC_CUR_SW_CFG;
|
||||
|
@ -618,11 +603,11 @@ static int nm_state_event(int evt, uint8_t obj_class, void *obj,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static struct sw_load *create_swload(struct sdp_header *header)
|
||||
static struct abis_nm_sw_desc *create_swload(struct sdp_header *header)
|
||||
{
|
||||
struct sw_load *load;
|
||||
struct abis_nm_sw_desc *load;
|
||||
|
||||
load = talloc_zero(tall_ctx_config, struct sw_load);
|
||||
load = talloc_zero(tall_ctx_config, struct abis_nm_sw_desc);
|
||||
|
||||
strncpy((char *)load->file_id, header->firmware_info.sw_part, 20);
|
||||
load->file_id_len = strlen(header->firmware_info.sw_part) + 1;
|
||||
|
|
|
@ -409,93 +409,29 @@ static int abis_nm_rcvmsg_report(struct msgb *mb, struct gsm_bts *bts)
|
|||
|
||||
/* Activate the specified software into the BTS */
|
||||
static int ipacc_sw_activate(struct gsm_bts *bts, uint8_t obj_class, uint8_t i0, uint8_t i1,
|
||||
uint8_t i2, const uint8_t *sw_desc, uint8_t swdesc_len)
|
||||
uint8_t i2, const struct abis_nm_sw_desc *sw_desc)
|
||||
{
|
||||
struct abis_om_hdr *oh;
|
||||
struct msgb *msg = nm_msgb_alloc();
|
||||
uint8_t len = swdesc_len;
|
||||
uint8_t *trailer;
|
||||
uint16_t len = abis_nm_sw_desc_len(sw_desc, true);
|
||||
|
||||
oh = (struct abis_om_hdr *) msgb_put(msg, ABIS_OM_FOM_HDR_SIZE);
|
||||
fill_om_fom_hdr(oh, len, NM_MT_ACTIVATE_SW, obj_class, i0, i1, i2);
|
||||
|
||||
trailer = msgb_put(msg, swdesc_len);
|
||||
memcpy(trailer, sw_desc, swdesc_len);
|
||||
abis_nm_put_sw_desc(msg, sw_desc, true);
|
||||
|
||||
return abis_nm_sendmsg(bts, msg);
|
||||
}
|
||||
|
||||
int abis_nm_parse_sw_config(const uint8_t *sw_descr, const size_t sw_descr_len,
|
||||
struct abis_nm_sw_descr *desc, const int res_len)
|
||||
{
|
||||
static const struct tlv_definition sw_descr_def = {
|
||||
.def = {
|
||||
[NM_ATT_FILE_ID] = { TLV_TYPE_TL16V, },
|
||||
[NM_ATT_FILE_VERSION] = { TLV_TYPE_TL16V, },
|
||||
},
|
||||
};
|
||||
|
||||
size_t pos = 0;
|
||||
int desc_pos = 0;
|
||||
|
||||
for (pos = 0; pos < sw_descr_len && desc_pos < res_len; ++desc_pos) {
|
||||
uint8_t tag;
|
||||
uint16_t tag_len;
|
||||
const uint8_t *val;
|
||||
int len;
|
||||
|
||||
memset(&desc[desc_pos], 0, sizeof(desc[desc_pos]));
|
||||
desc[desc_pos].start = &sw_descr[pos];
|
||||
|
||||
/* Classic TLV parsing doesn't work well with SW_DESCR because of it's
|
||||
* nested nature and the fact you have to assume it contains only two sub
|
||||
* tags NM_ATT_FILE_VERSION & NM_ATT_FILE_ID to parse it */
|
||||
if (sw_descr[pos] != NM_ATT_SW_DESCR) {
|
||||
LOGP(DNM, LOGL_ERROR,
|
||||
"SW_DESCR attribute identifier not found!\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
pos += 1;
|
||||
len = tlv_parse_one(&tag, &tag_len, &val,
|
||||
&sw_descr_def, &sw_descr[pos], sw_descr_len - pos);
|
||||
if (len < 0 || (tag != NM_ATT_FILE_ID)) {
|
||||
LOGP(DNM, LOGL_ERROR,
|
||||
"FILE_ID attribute identifier not found!\n");
|
||||
return -2;
|
||||
}
|
||||
desc[desc_pos].file_id = val;
|
||||
desc[desc_pos].file_id_len = tag_len;
|
||||
pos += len;
|
||||
|
||||
|
||||
len = tlv_parse_one(&tag, &tag_len, &val,
|
||||
&sw_descr_def, &sw_descr[pos], sw_descr_len - pos);
|
||||
if (len < 0 || (tag != NM_ATT_FILE_VERSION)) {
|
||||
LOGP(DNM, LOGL_ERROR,
|
||||
"FILE_VERSION attribute identifier not found!\n");
|
||||
return -3;
|
||||
}
|
||||
desc[desc_pos].file_ver = val;
|
||||
desc[desc_pos].file_ver_len = tag_len;
|
||||
pos += len;
|
||||
|
||||
/* final size */
|
||||
desc[desc_pos].len = &sw_descr[pos] - desc[desc_pos].start;
|
||||
}
|
||||
|
||||
return desc_pos;
|
||||
}
|
||||
|
||||
int abis_nm_select_newest_sw(const struct abis_nm_sw_descr *sw_descr,
|
||||
const size_t size)
|
||||
int abis_nm_select_newest_sw(const struct abis_nm_sw_desc *sw_descr,
|
||||
const size_t size)
|
||||
{
|
||||
int res = 0;
|
||||
int i;
|
||||
|
||||
for (i = 1; i < size; ++i) {
|
||||
if (memcmp(sw_descr[res].file_ver, sw_descr[i].file_ver,
|
||||
OSMO_MIN(sw_descr[i].file_ver_len, sw_descr[res].file_ver_len)) < 0) {
|
||||
if (memcmp(sw_descr[res].file_version, sw_descr[i].file_version,
|
||||
OSMO_MIN(sw_descr[i].file_version_len,
|
||||
sw_descr[res].file_version_len)) < 0) {
|
||||
res = i;
|
||||
}
|
||||
}
|
||||
|
@ -511,7 +447,7 @@ static int abis_nm_rx_sw_act_req(struct msgb *mb)
|
|||
struct tlv_parsed tp;
|
||||
const uint8_t *sw_config;
|
||||
int ret, sw_config_len, len;
|
||||
struct abis_nm_sw_descr sw_descr[5];
|
||||
struct abis_nm_sw_desc sw_descr[5];
|
||||
|
||||
abis_nm_debugp_foh(DNM, foh);
|
||||
|
||||
|
@ -542,8 +478,8 @@ static int abis_nm_rx_sw_act_req(struct msgb *mb)
|
|||
}
|
||||
|
||||
/* Parse up to two sw descriptions from the data */
|
||||
len = abis_nm_parse_sw_config(sw_config, sw_config_len,
|
||||
&sw_descr[0], ARRAY_SIZE(sw_descr));
|
||||
len = abis_nm_get_sw_conf(sw_config, sw_config_len, &sw_descr[0],
|
||||
ARRAY_SIZE(sw_descr));
|
||||
if (len <= 0) {
|
||||
LOGP(DNM, LOGL_ERROR, "Failed to parse SW Config.\n");
|
||||
return -EINVAL;
|
||||
|
@ -556,7 +492,7 @@ static int abis_nm_rx_sw_act_req(struct msgb *mb)
|
|||
foh->obj_inst.bts_nr,
|
||||
foh->obj_inst.trx_nr,
|
||||
foh->obj_inst.ts_nr,
|
||||
sw_descr[ret].start, sw_descr[ret].len);
|
||||
&sw_descr[ret]);
|
||||
}
|
||||
|
||||
/* Receive a CHANGE_ADM_STATE_ACK, parse the TLV and update local state */
|
||||
|
|
|
@ -22,22 +22,12 @@
|
|||
|
||||
#include <osmocom/core/application.h>
|
||||
#include <osmocom/core/utils.h>
|
||||
#include <osmocom/gsm/protocol/gsm_12_21.h>
|
||||
|
||||
#include <openbsc/gsm_data.h>
|
||||
#include <openbsc/abis_nm.h>
|
||||
#include <openbsc/debug.h>
|
||||
|
||||
static const uint8_t simple_config[] = {
|
||||
/*0, 13, */
|
||||
66, 18, 0, 3, 1, 2, 3, 19, 0, 3, 3, 4, 5,
|
||||
};
|
||||
|
||||
static const uint8_t dual_config[] = {
|
||||
/*0, 26, */
|
||||
66, 18, 0, 3, 1, 2, 3, 19, 0, 3, 3, 4, 5,
|
||||
66, 18, 0, 3, 9, 7, 5, 19, 0, 3, 6, 7, 8,
|
||||
};
|
||||
|
||||
static const uint8_t load_config[] = {
|
||||
0x42, 0x12, 0x00, 0x08, 0x31, 0x36, 0x38, 0x64,
|
||||
0x34, 0x37, 0x32, 0x00, 0x13, 0x00, 0x0b, 0x76,
|
||||
|
@ -48,94 +38,29 @@ static const uint8_t load_config[] = {
|
|||
0x33, 0x64, 0x31, 0x00
|
||||
};
|
||||
|
||||
static void test_simple_sw_config(void)
|
||||
{
|
||||
struct abis_nm_sw_descr descr[1];
|
||||
int rc;
|
||||
|
||||
rc = abis_nm_parse_sw_config(simple_config, ARRAY_SIZE(simple_config),
|
||||
&descr[0], ARRAY_SIZE(descr));
|
||||
if (rc != 1) {
|
||||
printf("FAILED to parse the File Id/File version\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
if (descr[0].len != 13) {
|
||||
printf("WRONG SIZE: %zu\n", descr[0].len);
|
||||
abort();
|
||||
}
|
||||
|
||||
printf("Start: %td len: %zu\n", descr[0].start - simple_config, descr[0].len);
|
||||
printf("file_id: %s\n", osmo_hexdump(descr[0].file_id, descr[0].file_id_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[0].file_ver, descr[0].file_ver_len));
|
||||
}
|
||||
|
||||
static void test_simple_sw_short(void)
|
||||
{
|
||||
struct abis_nm_sw_descr descr[1];
|
||||
int i;
|
||||
|
||||
for (i = 1; i < ARRAY_SIZE(simple_config); ++i) {
|
||||
int rc = abis_nm_parse_sw_config(simple_config,
|
||||
ARRAY_SIZE(simple_config) - i, &descr[0],
|
||||
ARRAY_SIZE(descr));
|
||||
if (rc >= 1) {
|
||||
printf("SHOULD not have parsed: %d\n", rc);
|
||||
abort();
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static void test_dual_sw_config(void)
|
||||
{
|
||||
struct abis_nm_sw_descr descr[2];
|
||||
int rc;
|
||||
|
||||
rc = abis_nm_parse_sw_config(dual_config, ARRAY_SIZE(dual_config),
|
||||
&descr[0], ARRAY_SIZE(descr));
|
||||
if (rc != 2) {
|
||||
printf("FAILED to parse the File Id/File version\n");
|
||||
abort();
|
||||
}
|
||||
|
||||
if (descr[0].len != 13) {
|
||||
printf("WRONG SIZE0: %zu\n", descr[0].len);
|
||||
abort();
|
||||
}
|
||||
|
||||
if (descr[1].len != 13) {
|
||||
printf("WRONG SIZE1: %zu\n", descr[1].len);
|
||||
abort();
|
||||
}
|
||||
|
||||
printf("Start: %td len: %zu\n", descr[0].start - dual_config, descr[0].len);
|
||||
printf("file_id: %s\n", osmo_hexdump(descr[0].file_id, descr[0].file_id_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[0].file_ver, descr[0].file_ver_len));
|
||||
|
||||
printf("Start: %td len: %zu\n", descr[1].start - dual_config, descr[1].len);
|
||||
printf("file_id: %s\n", osmo_hexdump(descr[1].file_id, descr[1].file_id_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[1].file_ver, descr[1].file_ver_len));
|
||||
}
|
||||
|
||||
static void test_sw_selection(void)
|
||||
{
|
||||
struct abis_nm_sw_descr descr[8], tmp;
|
||||
struct abis_nm_sw_desc descr[8], tmp;
|
||||
uint16_t len0, len1;
|
||||
int rc, pos;
|
||||
|
||||
rc = abis_nm_parse_sw_config(load_config, ARRAY_SIZE(load_config),
|
||||
rc = abis_nm_get_sw_conf(load_config, ARRAY_SIZE(load_config),
|
||||
&descr[0], ARRAY_SIZE(descr));
|
||||
if (rc != 2) {
|
||||
printf("FAILED to parse the File Id/File version\n");
|
||||
printf("%s(): FAILED to parse the File Id/File version: %d\n",
|
||||
__func__, rc);
|
||||
abort();
|
||||
}
|
||||
|
||||
printf("Start: %td len: %zu\n", descr[0].start - load_config, descr[0].len);
|
||||
len0 = abis_nm_sw_desc_len(&descr[0], true);
|
||||
printf("len: %u\n", len0);
|
||||
printf("file_id: %s\n", osmo_hexdump(descr[0].file_id, descr[0].file_id_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[0].file_ver, descr[0].file_ver_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[0].file_version, descr[0].file_version_len));
|
||||
|
||||
printf("Start: %td len: %zu\n", descr[1].start - load_config, descr[1].len);
|
||||
len1 = abis_nm_sw_desc_len(&descr[1], true);
|
||||
printf("len: %u\n", len1);
|
||||
printf("file_id: %s\n", osmo_hexdump(descr[1].file_id, descr[1].file_id_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[1].file_ver, descr[1].file_ver_len));
|
||||
printf("file_ver: %s\n", osmo_hexdump(descr[1].file_version, descr[1].file_version_len));
|
||||
|
||||
/* start */
|
||||
pos = abis_nm_select_newest_sw(descr, rc);
|
||||
|
@ -155,14 +80,13 @@ static void test_sw_selection(void)
|
|||
abort();
|
||||
}
|
||||
printf("SELECTED: %d\n", pos);
|
||||
printf("%s(): OK\n", __func__);
|
||||
}
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
osmo_init_logging(&log_info);
|
||||
test_simple_sw_config();
|
||||
test_simple_sw_short();
|
||||
test_dual_sw_config();
|
||||
|
||||
test_sw_selection();
|
||||
|
||||
return EXIT_SUCCESS;
|
||||
|
|
|
@ -1,17 +1,9 @@
|
|||
Start: 0 len: 13
|
||||
file_id: 01 02 03
|
||||
file_ver: 03 04 05
|
||||
Start: 0 len: 13
|
||||
file_id: 01 02 03
|
||||
file_ver: 03 04 05
|
||||
Start: 13 len: 13
|
||||
file_id: 09 07 05
|
||||
file_ver: 06 07 08
|
||||
Start: 0 len: 26
|
||||
len: 26
|
||||
file_id: 31 36 38 64 34 37 32 00
|
||||
file_ver: 76 32 30 30 62 31 34 33 64 30 00
|
||||
Start: 26 len: 26
|
||||
len: 26
|
||||
file_id: 31 36 38 64 34 37 32 00
|
||||
file_ver: 76 32 30 30 62 31 34 33 64 31 00
|
||||
SELECTED: 1
|
||||
SELECTED: 0
|
||||
test_sw_selection(): OK
|
||||
|
|
Loading…
Reference in New Issue