firmware/layer1: handle CSD related channel modes

Change-Id: Ib73210b273826ded56d42c41ffeb835eef96dd2b
Related: OS#4396
---
M src/target/firmware/layer1/async.c
M src/target/firmware/layer1/prim_tch.c
2 files changed, 26 insertions(+), 0 deletions(-)

diff --git a/src/target/firmware/layer1/async.c b/src/target/firmware/layer1/async.c
index fe8a906..8d76e5c 100644
--- a/src/target/firmware/layer1/async.c
+++ b/src/target/firmware/layer1/async.c
@@ -109,6 +109,10 @@
 	switch (mode) {
 	case GSM48_CMODE_SPEECH_V1:
 	case GSM48_CMODE_SPEECH_EFR:
+	case GSM48_CMODE_DATA_14k5:
+	case GSM48_CMODE_DATA_12k0:
+	case GSM48_CMODE_DATA_6k0:
+	case GSM48_CMODE_DATA_3k6:
 		l1s.tch_mode = mode;
 		break;
 	default:
diff --git a/src/target/firmware/layer1/prim_tch.c b/src/target/firmware/layer1/prim_tch.c
index c6fbddd..a33cb58 100644
--- a/src/target/firmware/layer1/prim_tch.c
+++ b/src/target/firmware/layer1/prim_tch.c
@@ -81,6 +81,18 @@
 		case GSM48_CMODE_SPEECH_EFR:
 			*tch_mode = *tch_f_hn ? TCH_EFR_MODE : SIG_ONLY_MODE;
 			break;
+		case GSM48_CMODE_DATA_14k5:
+			*tch_mode = *tch_f_hn ? TCH_144_MODE : SIG_ONLY_MODE;
+			break;
+		case GSM48_CMODE_DATA_12k0:
+			*tch_mode = *tch_f_hn ? TCH_96_MODE : SIG_ONLY_MODE;
+			break;
+		case GSM48_CMODE_DATA_6k0:
+			*tch_mode = *tch_f_hn ? TCH_48F_MODE : TCH_48H_MODE;
+			break;
+		case GSM48_CMODE_DATA_3k6:
+			*tch_mode = *tch_f_hn ? TCH_24F_MODE : TCH_24H_MODE;
+			break;
 		default:
 			*tch_mode = SIG_ONLY_MODE;
 		}

