Bluetooth: Controller: Fix conn timeout due to delayed conn upd ind

Unlike legacy Zephyr Controller's double headed Tx queue
linked list, the new split Zephyr Controller's new LLCP does
not place a control PDU at the head of the Tx queue causing
control PDUs to be delayed on air.

Increase the instant value in the LE Connection Update Ind
PDU if there are prior enqueued PDUs in the LLL context of
the connection.

There can still be connection timeout if enqueued PDUs are
not being transmitted/acked during repeated retransmissions.

Signed-off-by: Vinayak Kariappa Chettimada <vich@nordicsemi.no>

Author: cvinayak

subsys/bluetooth/controller/ll_sw/ull_conn.c

@@ -1478,6 +1478,21 @@ void ull_conn_tx_lll_enqueue(struct ll_conn *conn, uint8_t count)
 	}
 }
 
+uint16_t ull_conn_tx_enqueue_count_get(struct ll_conn *conn)
+{
+	uint16_t count = 0;
+	memq_link_t *curr;
+
+	curr = memq_peek(conn->lll.memq_tx.head, conn->lll.memq_tx.tail, NULL);
+	while (curr != NULL) {
+		count++;
+
+		curr = memq_peek(curr->next, conn->lll.memq_tx.tail, NULL);
+	}
+
+	return count;
+}
+
 void ull_conn_link_tx_release(void *link)
 {
 	mem_release(link, &mem_link_tx.free);

subsys/bluetooth/controller/ll_sw/ull_conn_internal.h

@@ -31,6 +31,7 @@ int ull_conn_llcp(struct ll_conn *conn, uint32_t ticks_at_expire,
 void ull_conn_done(struct node_rx_event_done *done);
 void ull_conn_tx_demux(uint8_t count);
 void ull_conn_tx_lll_enqueue(struct ll_conn *conn, uint8_t count);
+uint16_t ull_conn_tx_enqueue_count_get(struct ll_conn *conn);
 void ull_conn_link_tx_release(void *link);
 uint8_t ull_conn_ack_last_idx_get(void);
 memq_link_t *ull_conn_ack_peek(uint8_t *ack_last, uint16_t *handle,

subsys/bluetooth/controller/ll_sw/ull_llcp_conn_upd.c

@@ -242,6 +242,7 @@ static void cu_prepare_update_ind(struct ll_conn *conn, struct proc_ctx *ctx)
 #endif /* CONFIG_BT_CTLR_CONN_PARAM_REQ */
 
 	ctx->data.cu.instant = ull_conn_event_counter(conn) + conn->lll.latency +
+			       ull_conn_tx_enqueue_count_get(conn) +
 			       CONN_UPDATE_INSTANT_DELTA;
 }