lce: add support for PP indirect link establishment

TODO:
 - Update tp->tpui based on temporary identity assignments
 - Implement group TPUI support

Signed-off-by: Patrick McHardy <kaber@trash.net>

include/dect/lce.h

@@ -25,6 +25,8 @@ struct dect_lce_page_param {
 struct dect_lce_ops {
 	bool	(*lce_page_response)(struct dect_handle *dh,
 				     struct dect_lce_page_param *param);
+	void	(*lce_group_ring_ind)(struct dect_handle *dh,
+				      enum dect_ring_patterns pattern);
 };
 
 extern int dect_lce_group_ring_req(struct dect_handle *dh,

include/dect/libdect.h

@@ -139,6 +139,9 @@ extern void dect_close_handle(struct dect_handle *dh);
 
 extern int dect_init(struct dect_handle *dh, const char *cluster);
 
+extern void dect_pp_set_ipui(struct dect_handle *dh,
+			     const struct dect_ipui *ipui);
+
 #ifdef __cplusplus
 }
 #endif

include/libdect.h

@@ -25,11 +25,14 @@ struct dect_fp_capabilities {
  * @mode:	cluster mode
  * @pari:	FP's PARI
  * @fpc:	FP capabilities
+ * @ipui:	PP's IPUI
+ * @tpui:	PP's TPUI
  * @b_sap:	B-SAP socket
  * @s_sap:	S-SAP listener socket
  * @links:	list of data links
  * @mme_list:	MM endpoint list
  */
+#include <lce.h>
 struct dect_handle {
 	const struct dect_ops		*ops;
 
@@ -41,6 +44,10 @@ struct dect_handle {
 	struct dect_ari			pari;
 	struct dect_fp_capabilities	fpc;
 
+	struct dect_transaction		page_transaction;
+	struct dect_ipui		ipui;
+	struct dect_tpui		tpui;
+
 	struct dect_fd			*b_sap;
 	struct dect_fd			*s_sap;
 	struct list_head		links;

src/lce.c

@@ -192,17 +192,75 @@ static int dect_lce_page(const struct dect_handle *dh,
 	return dect_lce_broadcast(dh, &msg.hdr, sizeof(msg));
 }
 
+static void dect_lce_send_page_response(struct dect_handle *dh)
+{
+	struct dect_ie_portable_identity portable_identity;
+	struct dect_ie_fixed_identity fixed_identity;
+	struct dect_lce_page_response_msg msg = {
+		.portable_identity	= &portable_identity,
+		.fixed_identity		= &fixed_identity,
+	};
+
+	portable_identity.type = DECT_PORTABLE_ID_TYPE_IPUI;
+	portable_identity.ipui = dh->ipui;
+
+	fixed_identity.type    = DECT_FIXED_ID_TYPE_PARK;
+	fixed_identity.ari     = dh->pari;
+
+	if (dect_open_transaction(dh, &dh->page_transaction, &dh->ipui,
+				  DECT_PD_LCE) < 0)
+		return;
+
+	dect_lce_send(dh, &dh->page_transaction, &lce_page_response_msg_desc,
+		      &msg.common, DECT_LCE_PAGE_RESPONSE);
+}
+
 static void dect_lce_rcv_short_page(struct dect_handle *dh,
 				    struct dect_msg_buf *mb)
 {
 	struct dect_short_page_msg *msg = (void *)mb->data;
-	uint8_t hdr;
+	struct dect_tpui tpui;
+	uint16_t info, t;
+	uint8_t hdr, pattern;
 	bool w;
 
-	w   = msg->hdr & DECT_LCE_PAGE_W_FLAG;
-	hdr = msg->hdr & DECT_LCE_PAGE_HDR_MASK;
-	lce_debug("short page: w=%u hdr=%u information=%x\n",
-		  w, hdr, __be16_to_cpu(msg->information));
+	w    = msg->hdr & DECT_LCE_PAGE_W_FLAG;
+	hdr  = msg->hdr & DECT_LCE_PAGE_HDR_MASK;
+	info = __be16_to_cpu(msg->information);
+	lce_debug("short page: w=%u hdr=%u information=%04x\n", w, hdr, info);
+
+	if (hdr == DECT_LCE_PAGE_UNKNOWN_RINGING) {
+		pattern = (info & DECT_LCE_SHORT_PAGE_RING_PATTERN_MASK) >>
+			  DECT_LCE_SHORT_PAGE_RING_PATTERN_SHIFT;
+
+		if (w == 0) {
+			/* assigned connectionless group TPUI or CBI */
+			if ((info ^ DECT_TPUI_CBI) &
+			    DECT_LCE_SHORT_PAGE_GROUP_MASK)
+				return;
+		} else {
+			/* group mask */
+			return;
+		}
+
+		lce_debug("LCE_GROUP_RING-ind: pattern: %x\n", pattern);
+		dh->ops->lce_ops->lce_group_ring_ind(dh, pattern);
+	} else {
+		if (w == 0) {
+			/* default individual TPUI */
+			dect_ipui_to_tpui(&tpui, &dh->ipui);
+			t = dect_build_tpui(&tpui);
+			if (info != t)
+				return;
+		} else {
+			/* assigned TPUI or CBI */
+			t = dect_build_tpui(&dh->tpui);
+			if (info != t && info != DECT_TPUI_CBI)
+				return;
+		}
+
+		dect_lce_send_page_response(dh);
+	}
 }
 
 static void dect_lce_bsap_event(struct dect_handle *dh, struct dect_fd *dfd,

src/libdect.c

@@ -71,4 +71,17 @@ void dect_close_handle(struct dect_handle *dh)
 }
 EXPORT_SYMBOL(dect_close_handle);
 
+/**
+ * Set the PP's IPUI
+ *
+ * @param dh		libdect DECT handle
+ * @param ipui		IPUI
+ */
+void dect_pp_set_ipui(struct dect_handle *dh, const struct dect_ipui *ipui)
+{
+	dh->ipui = *ipui;
+	dect_ipui_to_tpui(&dh->tpui, ipui);
+}
+EXPORT_SYMBOL(dect_pp_set_ipui);
+
 /** @} */