1 files changed, 15 insertions, 18 deletions

diff --git a/src/host/trxcon/src/sched_lchan_tchf.c b/src/host/trxcon/src/sched_lchan_tchf.c
index 0206b610..12bea578 100644
--- a/src/host/trxcon/src/sched_lchan_tchf.c
+++ b/src/host/trxcon/src/sched_lchan_tchf.c
@@ -229,39 +229,39 @@ int tx_tchf_fn(struct l1sched_lchan_state *lchan,
 	memset(&bursts_p[464], 0, 464);
 	*mask = *mask << 4;
 
-	lchan->prim = prim_dequeue_tchf(lchan);
+	struct msgb *msg = prim_dequeue_tchf(lchan);
 
 	/* populate the buffer with bursts */
 	switch (lchan->tch_mode) {
 	case GSM48_CMODE_SIGN:
-		if (lchan->prim == NULL)
-			lchan->prim = l1sched_lchan_prim_dummy_lapdm(lchan);
+		if (msg == NULL)
+			msg = l1sched_lchan_prim_dummy_lapdm(lchan);
 		/* fall-through */
 	case GSM48_CMODE_SPEECH_V1:
 	case GSM48_CMODE_SPEECH_EFR:
-		if (lchan->prim == NULL) {
+		if (msg == NULL) {
 			/* transmit a dummy speech block with inverted CRC3 */
 			gsm0503_tch_fr_encode(bursts_p, NULL, 0, 1);
 			goto send_burst;
 		}
 		rc = gsm0503_tch_fr_encode(bursts_p,
-					   msgb_l2(lchan->prim),
-					   msgb_l2len(lchan->prim), 1);
+					   msgb_l2(msg),
+					   msgb_l2len(msg), 1);
 		break;
 	case GSM48_CMODE_SPEECH_AMR:
 	{
 		bool amr_fn_is_cmr = !sched_tchf_ul_amr_cmi_map[br->fn % 26];
-		const uint8_t *data = lchan->prim ? msgb_l2(lchan->prim) : NULL;
-		size_t data_len = lchan->prim ? msgb_l2len(lchan->prim) : 0;
+		const uint8_t *data = msg ? msgb_l2(msg) : NULL;
+		size_t data_len = msg ? msgb_l2len(msg) : 0;
 
-		if (lchan->prim == NULL) {
+		if (msg == NULL) {
 			/* TODO: It's not clear what to do for TCH/AFS.
 			 * TODO: Send dummy FACCH maybe? */
 			goto send_burst; /* send something */
 		}
 
 		if (data_len != GSM_MACBLOCK_LEN) { /* TCH/AFS: speech */
-			if (!l1sched_lchan_amr_prim_is_valid(lchan, amr_fn_is_cmr))
+			if (!l1sched_lchan_amr_prim_is_valid(lchan, msg, amr_fn_is_cmr))
 				goto free_bad_msg;
 			/* pull the AMR header - sizeof(struct amr_hdr) */
 			data_len -= 2;
@@ -286,12 +286,15 @@ int tx_tchf_fn(struct l1sched_lchan_state *lchan,
 
 	if (rc) {
 		LOGP_LCHAND(lchan, LOGL_ERROR, "Failed to encode L2 payload (len=%u): %s\n",
-			    msgb_l2len(lchan->prim), msgb_hexdump_l2(lchan->prim));
+			    msgb_l2len(msg), msgb_hexdump_l2(msg));
 free_bad_msg:
-		l1sched_lchan_prim_drop(lchan);
+		msgb_free(msg);
 		return -EINVAL;
 	}
 
+	/* Confirm data / traffic sending (pass ownership of the msgb/prim) */
+	l1sched_lchan_emit_data_cnf(lchan, msg, br->fn);
+
 send_burst:
 	/* Determine which burst should be sent */
 	burst = bursts_p + br->bid * 116;
@@ -312,11 +315,5 @@ send_burst:
 
 	LOGP_LCHAND(lchan, LOGL_DEBUG, "Scheduled fn=%u burst=%u\n", br->fn, br->bid);
 
-	/* If we have sent the last (4/4) burst */
-	if ((*mask & 0x0f) == 0x0f) {
-		/* Confirm data / traffic sending (pass ownership of the prim) */
-		l1sched_lchan_emit_data_cnf(lchan, br->fn);
-	}
-
 	return 0;
 }