format: Add support for the file read/written by the Racal 6103E ms test set
Signed-off-by: Sylvain Munaut <tnt@246tNt.com>
diff --git a/src/fmt_racal.c b/src/fmt_racal.c
new file mode 100644
index 0000000..65f810f
--- /dev/null
+++ b/src/fmt_racal.c
@@ -0,0 +1,162 @@
+/* Racal 6103E TCH recordings format */
+
+/*
+ * This file is part of gapk (GSM Audio Pocket Knife).
+ *
+ * gapk 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.
+ *
+ * gapk 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 gapk. If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <stdint.h>
+
+#include <osmocom/codec/codec.h>
+
+#include <gapk/codecs.h>
+#include <gapk/formats.h>
+#include <gapk/utils.h>
+
+
+static int
+racal_hr_from_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i, voiced;
+ const uint16_t *bit_mapping;
+
+ voiced = (msb_get_bit(src, 34) << 1) | msb_get_bit(src, 35);
+
+ bit_mapping = voiced ?
+ &gsm620_voiced_bitorder[0] :
+ &gsm620_unvoiced_bitorder[0] ;
+
+ for (i=0; i<112; i++) {
+ int si = bit_mapping[i];
+ int di = i;
+ lsb_put_bit(dst, di, msb_get_bit(src, si));
+ }
+
+ return 0;
+}
+
+static int
+racal_hr_to_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i, voiced;
+ const uint16_t *bit_mapping;
+
+ voiced = (lsb_get_bit(src, 94) << 1) | lsb_get_bit(src, 93);
+
+ bit_mapping = voiced ?
+ &gsm620_voiced_bitorder[0] :
+ &gsm620_unvoiced_bitorder[0] ;
+
+ for (i=0; i<112; i++) {
+ int si = i;
+ int di = bit_mapping[i];
+ msb_put_bit(dst, di, lsb_get_bit(src, si));
+ }
+
+ return 0;
+}
+
+const struct format_desc fmt_racal_hr = {
+ .type = FMT_RACAL_HR,
+ .codec_type = CODEC_HR,
+ .name = "racal-hr",
+ .description = "Racal HR TCH/H recording",
+
+ .frame_len = 14,
+ .conv_from_canon = racal_hr_from_canon,
+ .conv_to_canon = racal_hr_to_canon,
+};
+
+
+static int
+racal_fr_from_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i;
+
+ dst[32] = 0x00; /* last nibble won't written, pre-clear it */
+
+ for (i=0; i<260; i++) {
+ int si = gsm610_bitorder[i];
+ int di = i;
+ lsb_put_bit(dst, di, msb_get_bit(src, si));
+ }
+
+ return 0;
+}
+
+static int
+racal_fr_to_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i;
+
+ dst[32] = 0x00; /* last nibble won't written, pre-clear it */
+
+ for (i=0; i<260; i++) {
+ int si = i;
+ int di = gsm610_bitorder[i];
+ msb_put_bit(dst, di, lsb_get_bit(src, si));
+ }
+
+ return 0;
+}
+
+const struct format_desc fmt_racal_fr = {
+ .type = FMT_RACAL_FR,
+ .codec_type = CODEC_FR,
+ .name = "racal-fr",
+ .description = "Racal FR TCH/F recording",
+
+ .frame_len = 33,
+ .conv_from_canon = racal_fr_from_canon,
+ .conv_to_canon = racal_fr_to_canon,
+};
+
+
+static int
+racal_efr_from_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i;
+
+ dst[30] = 0x00; /* last nibble won't written, pre-clear it */
+
+ for (i=0; i<244; i++)
+ lsb_put_bit(dst, i, msb_get_bit(src, i));
+
+ return 0;
+}
+
+static int
+racal_efr_to_canon(uint8_t *dst, const uint8_t *src)
+{
+ int i;
+
+ dst[30] = 0x00; /* last nibble won't written, pre-clear it */
+
+ for (i=0; i<244; i++)
+ msb_put_bit(dst, i, lsb_get_bit(src, i));
+
+ return 0;
+}
+
+const struct format_desc fmt_racal_efr = {
+ .type = FMT_RACAL_EFR,
+ .codec_type = CODEC_EFR,
+ .name = "racal-efr",
+ .description = "Racal EFR TCH/F recording",
+
+ .frame_len = 31,
+ .conv_from_canon = racal_efr_from_canon,
+ .conv_to_canon = racal_efr_to_canon,
+};