From 4809f3c042a99a639542b1e6cd22657871113260 Mon Sep 17 00:00:00 2001 From: "Matthias P. Braendli" Date: Fri, 2 Sep 2016 17:43:32 +0200 Subject: Move all sources to src/ --- src/fig0_1.cpp | 112 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 112 insertions(+) create mode 100644 src/fig0_1.cpp (limited to 'src/fig0_1.cpp') diff --git a/src/fig0_1.cpp b/src/fig0_1.cpp new file mode 100644 index 0000000..f5df4c4 --- /dev/null +++ b/src/fig0_1.cpp @@ -0,0 +1,112 @@ +/* + Copyright (C) 2014 CSP Innovazione nelle ICT s.c.a r.l. (http://www.csp.it/) + Copyright (C) 2016 Matthias P. Braendli (http://www.opendigitalradio.org) + Copyright (C) 2015 Data Path + + This program is free software: you can redistribute it and/or modify + it under the terms of the GNU 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 General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program. If not, see . + + Authors: + Sergio Sagliocco + Matthias P. Braendli + / | |- ')|) |-|_ _ (|,_ .| _ ,_ \ + Data Path \(|(||_(|/_| (||_||(a)_||||(|||.(_()|||/ + +*/ + +#include "figs.hpp" +#include +#include + +static std::unordered_set subchannels_seen; + +bool fig0_1_is_complete(int subch_id) +{ + bool complete = subchannels_seen.count(subch_id); + + if (complete) { + subchannels_seen.clear(); + } + else { + subchannels_seen.insert(subch_id); + } + + return complete; +} + +// FIG 0/1 Basic sub-channel organization +// ETSI EN 300 401 6.2.1 +bool fig0_1(fig0_common_t& fig0, int indent) +{ + int i = 1; + uint8_t* f = fig0.f; + char desc[128]; + bool complete = false; + + while (i < fig0.figlen-3) { + // iterate over subchannels + int subch_id = f[i] >> 2; + complete |= fig0_1_is_complete(subch_id); + + int start_addr = ((f[i] & 0x03) << 8) | + (f[i+1]); + int long_flag = (f[i+2] >> 7); + + if (long_flag) { + int option = (f[i+2] >> 4) & 0x07; + int protection_level = (f[i+2] >> 2) & 0x03; + int subchannel_size = ((f[i+2] & 0x03) << 8 ) | + f[i+3]; + + i += 4; + + if (option == 0x00) { + sprintf(desc, + "Subch 0x%x, start_addr %d, long, EEP %d-A, subch size %d", + subch_id, start_addr, protection_level, subchannel_size); + } + else if (option == 0x01) { + sprintf(desc, + "Subch 0x%x, start_addr %d, long, EEP %d-B, subch size %d", + subch_id, start_addr, protection_level, subchannel_size); + } + else { + sprintf(desc, + "Subch 0x%x, start_addr %d, long, invalid option %d, protection %d, subch size %d", + subch_id, start_addr, option, protection_level, subchannel_size); + } + } + else { + int table_switch = (f[i+2] >> 6) & 0x01; + uint32_t table_index = (f[i+2] & 0x3F); + + + if (table_switch == 0) { + sprintf(desc, + "Subch 0x%x, start_addr %d, short, table index %d", + subch_id, start_addr, table_index); + } + else { + sprintf(desc, + "Subch 0x%x, start_addr %d, short, invalid table_switch(=1), table index %d", + subch_id, start_addr, table_index); + } + + i += 3; + } + printbuf(desc, indent+1, NULL, 0); + } + + return complete; +} + -- cgit v1.2.3