Refactor all FIG0/x into separate files

1 files changed, 146 insertions, 0 deletions

diff --git a/fig0_2.cpp b/fig0_2.cpp
new file mode 100644
index 0000000..29b52fa
--- /dev/null
+++ b/fig0_2.cpp
@@ -0,0 +1,146 @@
+/*
+    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 <http://www.gnu.org/licenses/>.
+
+    Authors:
+         Sergio Sagliocco <sergio.sagliocco@csp.it>
+         Matthias P. Braendli <matthias@mpb.li>
+                   / |  |-  ')|)  |-|_ _ (|,_   .|  _  ,_ \
+         Data Path \(|(||_(|/_| (||_||(a)_||||(|||.(_()|||/
+
+*/
+
+#include "figs.hpp"
+#include <cstdio>
+#include <string>
+#include <cstring>
+
+// FIG 0/2 Basic service and service component definition
+// ETSI EN 300 401 6.3.1
+void fig0_2(fig0_common_t& fig0, int indent)
+{
+    uint16_t sref, sid;
+    uint8_t cid, ecc, local, caid, ncomp, timd, ps, ca, subchid, scty;
+    int k = 1;
+    std::string psdesc;
+    uint8_t* f = fig0.f;
+    char sctydesc[32];
+    char desc[256];
+
+    while (k < fig0.figlen) {
+        if (fig0.pd() == 0) {
+            sid  =  f[k] * 256 + f[k+1];
+            cid  = (f[k] & 0xF0) >> 4;
+            sref = (f[k] & 0x0F) * 256 + f[k+1];
+            k += 2;
+        }
+        else {
+            sid  =  f[k] * 256 * 256 * 256 + \
+                    f[k+1] * 256 * 256 + \
+                    f[k+2] * 256 + \
+                    f[k+3];
+
+            ecc  =  f[k];
+            cid  = (f[k+1] & 0xF0) >> 4;
+            sref = (f[k+1] & 0x0F) * 256 * 256 + \
+                   f[k+2] * 256 + \
+                   f[k+3];
+
+            k += 4;
+        }
+
+        local = (f[k] & 0x80) >> 7;
+        caid  = (f[k] & 0x70) >> 4;
+        ncomp =  f[k] & 0x0F;
+
+        if (fig0.pd() == 0)
+            sprintf(desc,
+                    "Service ID=0x%X (Country id=%d, Service reference=%d), Number of components=%d, Local flag=%d, CAID=%d",
+                    sid, cid, sref, ncomp, local, caid);
+        else
+            sprintf(desc,
+                    "Service ID=0x%X (ECC=%d, Country id=%d, Service reference=%d), Number of components=%d, Local flag=%d, CAID=%d",
+                    sid, ecc, cid, sref, ncomp, local, caid);
+        printbuf(desc, indent+1, NULL, 0);
+
+        k++;
+        for (int i=0; i<ncomp; i++) {
+            uint8_t scomp[2];
+
+            memcpy(scomp, f+k, 2);
+            sprintf(desc, "Component[%d]", i);
+            printbuf(desc, indent+2, scomp, 2, "");
+            timd    = (scomp[0] & 0xC0) >> 6;
+            ps      = (scomp[1] & 0x02) >> 1;
+            ca      =  scomp[1] & 0x01;
+            scty    =  scomp[0] & 0x3F;
+            subchid = (scomp[1] & 0xFC) >> 2;
+
+            /* useless, kept as reference
+               if (timd == 3) {
+               uint16_t scid;
+               scid = scty*64 + subchid;
+               }
+               */
+
+            if (ps == 0) {
+                psdesc = "Secondary service";
+            }
+            else {
+                psdesc = "Primary service";
+            }
+
+
+            if (timd == 0) {
+                //MSC stream audio
+                if (scty == 0)
+                    sprintf(sctydesc, "MPEG Foreground sound (%d)", scty);
+                else if (scty == 1)
+                    sprintf(sctydesc, "MPEG Background sound (%d)", scty);
+                else if (scty == 2)
+                    sprintf(sctydesc, "Multi Channel sound (%d)", scty);
+                else if (scty == 63)
+                    sprintf(sctydesc, "AAC sound (%d)", scty);
+                else
+                    sprintf(sctydesc, "Unknown ASCTy (%d)", scty);
+
+                sprintf(desc, "Stream audio mode, %s, %s, SubChannel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                printbuf(desc, indent+3, NULL, 0);
+            }
+            else if (timd == 1) {
+                // MSC stream data
+                sprintf(sctydesc, "DSCTy=%d %s", scty, get_dscty_type(scty));
+                sprintf(desc, "Stream data mode, %s, %s, SubChannel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                printbuf(desc, indent+3, NULL, 0);
+            }
+            else if (timd == 2) {
+                // FIDC
+                sprintf(sctydesc, "DSCTy=%d %s", scty, get_dscty_type(scty));
+                sprintf(desc, "FIDC mode, %s, %s, Fast Information Data Channel ID=%02X, CA=%d", psdesc.c_str(), sctydesc, subchid, ca);
+                printbuf(desc, indent+3, NULL, 0);
+            }
+            else if (timd == 3) {
+                // MSC Packet mode
+                sprintf(desc, "MSC Packet Mode, %s, Service Component ID=%02X, CA=%d", psdesc.c_str(), subchid, ca);
+                printbuf(desc, indent+3, NULL, 0);
+            }
+            k += 2;
+        }
+    }
+}
+
+