Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 1 | /* |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 2 | * (C) 2020-2022 by sysmocom - s.f.m.c. GmbH, Author: Philipp Maier |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 3 | * All Rights Reserved |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 2 of the License, or |
| 10 | * (at your option) any later version. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with this program. If not, see <http://www.gnu.org/licenses/>. |
| 19 | * |
| 20 | */ |
| 21 | |
| 22 | #include <stdio.h> |
| 23 | #include <stdint.h> |
| 24 | #include <string.h> |
| 25 | #include <stdlib.h> |
| 26 | #include <errno.h> |
| 27 | |
| 28 | #include <osmocom/core/bits.h> |
| 29 | #include <osmocom/core/conv.h> |
| 30 | #include <osmocom/core/utils.h> |
| 31 | #include <osmocom/coding/gsm0503_amr_dtx.h> |
| 32 | #include <osmocom/coding/gsm0503_parity.h> |
| 33 | #include <osmocom/gsm/gsm0503.h> |
| 34 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 35 | #define S2U(b) ((b) < 0) |
| 36 | |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 37 | /* See also: 3GPP TS 05.03, chapter 3.10.1.3, 3.10.5.2 Identification marker */ |
| 38 | static const ubit_t id_marker_1[] = { 1, 0, 1, 1, 0, 0, 0, 0, 1 }; |
| 39 | |
| 40 | /* See also: 3GPP TS 05.03, chapter 3.9.1.3, 3.10.2.2, 3.10.2.2 Identification marker */ |
| 41 | static const ubit_t id_marker_0[] = { 0, 1, 0, 0, 1, 1, 1, 1, 0 }; |
| 42 | |
| 43 | /* See also: 3GPP TS 05.03, chapter 3.9 Adaptive multi rate speech channel at full rate (TCH/AFS) */ |
| 44 | static const ubit_t codec_mode_1_sid[] = { 1, 1, 1, 1, 0, 0, 0, 0, 1, 1, 0, 0, 1, 0, 1, 0 }; |
| 45 | static const ubit_t codec_mode_2_sid[] = { 0, 0, 0, 1, 1, 1, 0, 1, 0, 1, 1, 1, 1, 1, 0, 0 }; |
| 46 | static const ubit_t codec_mode_3_sid[] = { 1, 1, 0, 0, 0, 1, 1, 0, 0, 0, 0, 1, 0, 0, 0, 1 }; |
| 47 | static const ubit_t codec_mode_4_sid[] = { 0, 0, 1, 0, 1, 0, 1, 1, 1, 0, 1, 0, 0, 1, 1, 1 }; |
| 48 | |
| 49 | const struct value_string gsm0503_amr_dtx_frame_names[] = { |
Philipp Maier | 3c0a87c | 2020-04-23 10:46:30 +0200 | [diff] [blame] | 50 | { AMR_OTHER, "AMR_OTHER (audio)" }, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 51 | { AFS_SID_FIRST, "AFS_SID_FIRST" }, |
Philipp Maier | 3c0a87c | 2020-04-23 10:46:30 +0200 | [diff] [blame] | 52 | { AFS_SID_UPDATE, "AFS_SID_UPDATE (marker)" }, |
| 53 | { AFS_SID_UPDATE_CN, "AFS_SID_UPDATE_CN (audio)" }, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 54 | { AFS_ONSET, "AFS_ONSET" }, |
Philipp Maier | 3c0a87c | 2020-04-23 10:46:30 +0200 | [diff] [blame] | 55 | { AHS_SID_UPDATE, "AHS_SID_UPDATE (marker)" }, |
| 56 | { AHS_SID_UPDATE_CN, "AHS_SID_UPDATE_CN (audio)" }, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 57 | { AHS_SID_FIRST_P1, "AHS_SID_FIRST_P1" }, |
| 58 | { AHS_SID_FIRST_P2, "AHS_SID_FIRST_P2" }, |
| 59 | { AHS_ONSET, "AHS_ONSET" }, |
| 60 | { AHS_SID_FIRST_INH, "AHS_SID_FIRST_INH" }, |
| 61 | { AHS_SID_UPDATE_INH, "AHS_SID_UPDATE_INH" }, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 62 | { 0, NULL } |
| 63 | }; |
| 64 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 65 | static bool detect_afs_id_marker(int *n_errors, int *n_bits_total, const sbit_t *sbits, uint8_t offset, uint8_t count, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 66 | const ubit_t * id_marker, uint8_t id_marker_len) |
| 67 | { |
| 68 | unsigned int i, k; |
| 69 | unsigned int id_bit_nr = 0; |
| 70 | int errors = 0; |
| 71 | int bits = 0; |
| 72 | |
| 73 | /* Override coded in-band data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 74 | sbits += offset; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 75 | |
| 76 | /* Check for identification marker bits */ |
| 77 | for (i = 0; i < count; i++) { |
| 78 | for (k = 0; k < 4; k++) { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 79 | if (*sbits == 0 || id_marker[id_bit_nr % id_marker_len] != S2U(*sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 80 | errors++; |
| 81 | id_bit_nr++; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 82 | sbits++; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 83 | bits++; |
| 84 | } |
| 85 | |
| 86 | /* Jump to the next block of 4 bits */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 87 | sbits += 4; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 88 | } |
| 89 | |
| 90 | *n_errors = errors; |
| 91 | *n_bits_total = bits; |
| 92 | |
| 93 | /* Tolerate up to 1/8 errornous bits */ |
| 94 | return *n_errors < *n_bits_total / 8; |
| 95 | } |
| 96 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 97 | static bool detect_ahs_id_marker(int *n_errors, int *n_bits_total, const sbit_t *sbits, const ubit_t *id_marker) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 98 | { |
| 99 | unsigned int i, k; |
| 100 | int errors = 0; |
| 101 | int bits = 0; |
| 102 | |
| 103 | /* Override coded in-band data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 104 | sbits += 16; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 105 | |
| 106 | /* Check first identification marker bits (23*9 bits) */ |
| 107 | for (i = 0; i < 23; i++) { |
| 108 | for (k = 0; k < 9; k++) { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 109 | if (*sbits == 0 || id_marker[k] != S2U(*sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 110 | errors++; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 111 | sbits++; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 112 | bits++; |
| 113 | } |
| 114 | } |
| 115 | |
| 116 | /* Check remaining identification marker bits (5 bits) */ |
| 117 | for (k = 0; k < 5; k++) { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 118 | if (*sbits == 0 || id_marker[k] != S2U(*sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 119 | errors++; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 120 | sbits++; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 121 | bits++; |
| 122 | } |
| 123 | |
| 124 | *n_errors = errors; |
| 125 | *n_bits_total = bits; |
| 126 | |
| 127 | /* Tolerate up to 1/8 errornous bits */ |
| 128 | return *n_errors < *n_bits_total / 8; |
| 129 | } |
| 130 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 131 | static bool detect_interleaved_ahs_id_marker(int *n_errors, int *n_bits_total, const sbit_t *sbits, uint8_t offset, |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 132 | uint8_t n_bits, const ubit_t * id_marker, uint8_t id_marker_len) |
| 133 | { |
| 134 | unsigned int i, k; |
| 135 | int errors = 0; |
| 136 | int bits = 0; |
| 137 | uint8_t full_rounds = n_bits / id_marker_len; |
| 138 | uint8_t remainder = n_bits % id_marker_len; |
| 139 | |
| 140 | /* Override coded in-band data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 141 | sbits += offset; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 142 | |
| 143 | /* Check first identification marker bits (23*9 bits) */ |
| 144 | for (i = 0; i < full_rounds; i++) { |
| 145 | for (k = 0; k < id_marker_len; k++) { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 146 | if (*sbits == 0 || id_marker[k] != S2U(*sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 147 | errors++; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 148 | sbits += 2; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 149 | bits++; |
| 150 | } |
| 151 | } |
| 152 | |
| 153 | /* Check remaining identification marker bits (5 bits) */ |
| 154 | for (k = 0; k < remainder; k++) { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 155 | if (*sbits == 0 || id_marker[k] != S2U(*sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 156 | errors++; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 157 | sbits += 2; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 158 | bits++; |
| 159 | } |
| 160 | |
| 161 | *n_errors = errors; |
| 162 | *n_bits_total = bits; |
| 163 | |
| 164 | /* Tolerate up to 1/8 errornous bits */ |
| 165 | return *n_errors < *n_bits_total / 8; |
| 166 | } |
| 167 | |
Vadim Yanitskiy | f6fd0bb | 2022-04-23 03:34:33 +0300 | [diff] [blame] | 168 | /* Detect an FR AMR SID_FIRST frame by its identifcation marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 169 | static bool detect_afs_sid_first(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 170 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 171 | return detect_afs_id_marker(n_errors, n_bits_total, sbits, 32, 53, id_marker_0, 9); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 172 | } |
| 173 | |
Vadim Yanitskiy | f6fd0bb | 2022-04-23 03:34:33 +0300 | [diff] [blame] | 174 | /* Detect an FR AMR SID_UPDATE frame by its identification marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 175 | static bool detect_afs_sid_update(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 176 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 177 | return detect_afs_id_marker(n_errors, n_bits_total, sbits, 36, 53, id_marker_0, 9); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 178 | } |
| 179 | |
Vadim Yanitskiy | f6fd0bb | 2022-04-23 03:34:33 +0300 | [diff] [blame] | 180 | /* Detect an FR AMR ONSET frame by its repeating coded inband data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 181 | static int detect_afs_onset(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 182 | { |
| 183 | bool rc; |
| 184 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 185 | rc = detect_afs_id_marker(n_errors, n_bits_total, sbits, 4, 57, codec_mode_1_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 186 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 187 | return 0; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 188 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 189 | rc = detect_afs_id_marker(n_errors, n_bits_total, sbits, 4, 57, codec_mode_2_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 190 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 191 | return 1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 192 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 193 | rc = detect_afs_id_marker(n_errors, n_bits_total, sbits, 4, 57, codec_mode_3_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 194 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 195 | return 2; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 196 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 197 | rc = detect_afs_id_marker(n_errors, n_bits_total, sbits, 4, 57, codec_mode_4_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 198 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 199 | return 3; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 200 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 201 | return -1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 202 | } |
| 203 | |
| 204 | /* Detect an HR AMR SID UPDATE frame by its identification marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 205 | static bool detect_ahs_sid_update(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 206 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 207 | return detect_ahs_id_marker(n_errors, n_bits_total, sbits, id_marker_1); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 208 | } |
| 209 | |
| 210 | /* Detect an HR AMR SID FIRST (part 1) frame by its identification marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 211 | static bool detect_ahs_sid_first_p1(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 212 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 213 | return detect_ahs_id_marker(n_errors, n_bits_total, sbits, id_marker_0); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 214 | } |
| 215 | |
| 216 | /* Detect an HR AMR SID FIRST (part 2) frame by its repeating coded inband data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 217 | static int detect_ahs_sid_first_p2(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 218 | { |
| 219 | bool rc; |
| 220 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 221 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 0, 114, codec_mode_1_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 222 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 223 | return 0; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 224 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 225 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 0, 114, codec_mode_2_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 226 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 227 | return 1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 228 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 229 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 0, 114, codec_mode_3_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 230 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 231 | return 2; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 232 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 233 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 0, 114, codec_mode_4_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 234 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 235 | return 3; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 236 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 237 | return -1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 238 | } |
| 239 | |
| 240 | /* Detect an HR AMR ONSET frame by its repeating coded inband data */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 241 | static int detect_ahs_onset(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 242 | { |
| 243 | bool rc; |
| 244 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 245 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 1, 114, codec_mode_1_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 246 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 247 | return 0; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 248 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 249 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 1, 114, codec_mode_2_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 250 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 251 | return 1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 252 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 253 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 1, 114, codec_mode_3_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 254 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 255 | return 2; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 256 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 257 | rc = detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 1, 114, codec_mode_4_sid, 16); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 258 | if (rc) |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 259 | return 3; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 260 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 261 | return -1; |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 262 | } |
| 263 | |
| 264 | /* Detect an HR AMR SID FIRST INHIBIT frame by its identification marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 265 | static bool detect_ahs_sid_first_inh(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 266 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 267 | return detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 33, 212, id_marker_1, 9); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 268 | } |
| 269 | |
| 270 | /* Detect an HR AMR SID UPDATE INHIBIT frame by its identification marker */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 271 | static bool detect_ahs_sid_update_inh(int *n_errors, int *n_bits_total, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 272 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 273 | return detect_interleaved_ahs_id_marker(n_errors, n_bits_total, sbits, 33, 212, id_marker_0, 9); |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 274 | } |
| 275 | |
| 276 | /*! Detect FR AMR DTX frame in unmapped, deinterleaved frame bits. |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 277 | * \param[out] n_errors number of errornous bits. |
| 278 | * \param[out] n_bits_total number of checked bits. |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 279 | * \param[out] mode_id codec mode ID (0..3 or -1). |
| 280 | * \param[in] sbits input soft-bits (456 bit). |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 281 | * \returns dtx frame type. */ |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 282 | enum gsm0503_amr_dtx_frames gsm0503_detect_afs_dtx_frame2(int *n_errors, int *n_bits_total, |
| 283 | int *mode_id, const sbit_t *sbits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 284 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 285 | if (detect_afs_sid_first(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 286 | return AFS_SID_FIRST; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 287 | if (detect_afs_sid_update(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 288 | return AFS_SID_UPDATE; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 289 | if ((*mode_id = detect_afs_onset(n_errors, n_bits_total, sbits)) != -1) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 290 | return AFS_ONSET; |
| 291 | |
| 292 | *n_errors = 0; |
| 293 | *n_bits_total = 0; |
| 294 | return AMR_OTHER; |
| 295 | } |
| 296 | |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 297 | /*! Detect FR AMR DTX frame in unmapped, deinterleaved frame bits. |
| 298 | * DEPRECATED: use gsm0503_detect_afs_dtx_frame2() instead. |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 299 | * \param[out] n_errors number of errornous bits. |
| 300 | * \param[out] n_bits_total number of checked bits. |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 301 | * \param[in] ubits input bits (456 bit). |
| 302 | * \returns dtx frame type. */ |
| 303 | enum gsm0503_amr_dtx_frames gsm0503_detect_afs_dtx_frame(int *n_errors, int *n_bits_total, |
| 304 | const ubit_t *ubits) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 305 | { |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 306 | int mode_id; /* unused */ |
| 307 | sbit_t sbits[456]; |
| 308 | |
| 309 | osmo_ubit2sbit(&sbits[0], &ubits[0], sizeof(sbits)); |
| 310 | return gsm0503_detect_afs_dtx_frame2(n_errors, n_bits_total, &mode_id, &sbits[0]); |
| 311 | } |
| 312 | |
| 313 | /*! Detect HR AMR DTX frame in unmapped, deinterleaved frame bits. |
| 314 | * \param[out] n_errors number of errornous bits. |
| 315 | * \param[out] n_bits_total number of checked bits. |
| 316 | * \param[out] mode_id codec ID (CMI or CMC/CMR). |
| 317 | * \param[out] mode_id codec mode ID (0..3 or -1). |
| 318 | * \param[in] sbits input soft-bits (456 bit). |
| 319 | * \returns dtx frame type, */ |
| 320 | enum gsm0503_amr_dtx_frames gsm0503_detect_ahs_dtx_frame2(int *n_errors, int *n_bits_total, |
| 321 | int *mode_id, const sbit_t *sbits) |
| 322 | { |
| 323 | if (detect_ahs_sid_update(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 324 | return AHS_SID_UPDATE; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 325 | if (detect_ahs_sid_first_inh(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 326 | return AHS_SID_FIRST_INH; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 327 | if (detect_ahs_sid_update_inh(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 328 | return AHS_SID_UPDATE_INH; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 329 | if (detect_ahs_sid_first_p1(n_errors, n_bits_total, sbits)) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 330 | return AHS_SID_FIRST_P1; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 331 | if ((*mode_id = detect_ahs_sid_first_p2(n_errors, n_bits_total, sbits)) != -1) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 332 | return AHS_SID_FIRST_P2; |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 333 | if ((*mode_id = detect_ahs_onset(n_errors, n_bits_total, sbits)) != -1) |
Philipp Maier | 898c9c6 | 2020-02-06 14:25:01 +0100 | [diff] [blame] | 334 | return AHS_ONSET; |
| 335 | |
| 336 | *n_errors = 0; |
| 337 | *n_bits_total = 0; |
| 338 | return AMR_OTHER; |
| 339 | } |
Vadim Yanitskiy | cc4213e | 2022-05-24 04:17:23 +0700 | [diff] [blame] | 340 | |
| 341 | /*! Detect HR AMR DTX frame in unmapped, deinterleaved frame bits. |
| 342 | * DEPRECATED: use gsm0503_detect_ahs_dtx_frame2() instead. |
| 343 | * \param[out] n_errors number of errornous bits. |
| 344 | * \param[out] n_bits_total number of checked bits. |
| 345 | * \param[in] ubits input bits (456 bit). |
| 346 | * \returns dtx frame type, */ |
| 347 | enum gsm0503_amr_dtx_frames gsm0503_detect_ahs_dtx_frame(int *n_errors, int *n_bits_total, |
| 348 | const ubit_t *ubits) |
| 349 | { |
| 350 | int mode_id; /* unused */ |
| 351 | sbit_t sbits[456]; |
| 352 | |
| 353 | osmo_ubit2sbit(&sbits[0], &ubits[0], sizeof(sbits)); |
| 354 | return gsm0503_detect_ahs_dtx_frame2(n_errors, n_bits_total, &mode_id, &sbits[0]); |
| 355 | } |