Merge "ARM: msm: dts: Add qrtr net ids for sm8150-sdxprairie" (bca7dcc8) · Commits · e / devices / android_kernel_oneplus_sm8150

arch/arm64/boot/dts/qcom/sm8150-sdxprairie.dtsi

+25 −0

Original line number	Diff line number	Diff line
		@@ -38,6 +38,31 @@
		mhi_chan@105 {
		status = "disabled";
		};

		mhi_devices {
		mhi_qrtr {
		mhi,chan = "IPCR";
		qcom,net-id = <3>;
		};
		};
		};

		&glink_adsp {
		qcom,adsp_qrtr {
		qcom,net-id = <2>;
		};
		};

		&glink_slpi {
		qcom,slpi_qrtr {
		qcom,net-id = <1>;
		};
		};

		&glink_cdsp {
		qcom,cdsp_qrtr {
		qcom,net-id = <1>;
		};
		};

		&soc {

include/uapi/linux/qrtr.h

+7 −0

Original line number	Diff line number	Diff line
		@@ -27,6 +27,8 @@ enum qrtr_pkt_type {
		QRTR_TYPE_NEW_LOOKUP = 10,
		QRTR_TYPE_DEL_LOOKUP = 11,
		};
		#define QRTR_TYPE_DEL_PROC 13


		struct qrtr_ctrl_pkt {
		__le32 cmd;
		@@ -43,6 +45,11 @@ struct qrtr_ctrl_pkt {
		__le32 node;
		__le32 port;
		} client;

		struct {
		__le32 rsvd;
		__le32 node;
		} proc;
		};
		} __packed;

net/qrtr/qrtr.c

+60 −0

Original line number	Diff line number	Diff line
		@@ -233,6 +233,10 @@ static void qrtr_log_tx_msg(struct qrtr_node node, struct qrtr_hdr_v1 hdr,
		QRTR_INFO(node->ilc,
		"TX CTRL: cmd:0x%x node[0x%x]\n",
		hdr->type, hdr->src_node_id);
		else if (hdr->type == QRTR_TYPE_DEL_PROC)
		QRTR_INFO(node->ilc,
		"TX CTRL: cmd:0x%x node[0x%x]\n",
		hdr->type, pkt->proc.node);
		}
		}

		@@ -949,6 +953,60 @@ int qrtr_endpoint_register(struct qrtr_endpoint *ep, unsigned int net_id)
		}
		EXPORT_SYMBOL_GPL(qrtr_endpoint_register);

		static u32 qrtr_calc_checksum(struct qrtr_ctrl_pkt *pkt)
		{
		u32 checksum = 0;
		u32 mask = 0xffff;
		u16 upper_nb;
		u16 lower_nb;
		u32 *msg;
		int i;

		if (!pkt)
		return checksum;
		msg = (u32 *)pkt;

		for (i = 0; i < sizeof(pkt) / sizeof(msg); i++) {
		lower_nb = *msg & mask;
		upper_nb = (*msg >> 16) & mask;
		checksum += (upper_nb + lower_nb);
		msg++;
		}
		while (checksum > 0xffff)
		checksum = (checksum & mask) + ((checksum >> 16) & mask);

		checksum = ~checksum & mask;

		return checksum;
		}

		static void qrtr_fwd_del_proc(struct qrtr_node *src, unsigned int nid)
		{
		struct sockaddr_qrtr from = {AF_QIPCRTR, 0, QRTR_PORT_CTRL};
		struct sockaddr_qrtr to = {AF_QIPCRTR, 0, QRTR_PORT_CTRL};
		struct qrtr_ctrl_pkt *pkt;
		struct qrtr_node *dst;
		struct sk_buff *skb;

		list_for_each_entry(dst, &qrtr_all_epts, item) {
		if (!qrtr_must_forward(nid, dst->nid, QRTR_TYPE_DEL_PROC))
		continue;

		skb = qrtr_alloc_ctrl_packet(&pkt);
		if (!skb)
		return;

		pkt->cmd = cpu_to_le32(QRTR_TYPE_DEL_PROC);
		pkt->proc.rsvd = QRTR_DEL_PROC_MAGIC;
		pkt->proc.node = cpu_to_le32(nid);
		pkt->proc.rsvd = cpu_to_le32(qrtr_calc_checksum(pkt));

		from.sq_node = src->nid;
		to.sq_node = dst->nid;
		qrtr_node_enqueue(dst, skb, QRTR_TYPE_DEL_PROC, &from, &to, 0);
		}
		}

		/**
		* qrtr_endpoint_unregister - unregister endpoint
		* @ep: endpoint to unregister
		@@ -980,6 +1038,8 @@ void qrtr_endpoint_unregister(struct qrtr_endpoint *ep)
		src.sq_node = iter.index;
		pkt->cmd = cpu_to_le32(QRTR_TYPE_BYE);
		qrtr_local_enqueue(NULL, skb, QRTR_TYPE_BYE, &src, &dst, 0);

		qrtr_fwd_del_proc(node, iter.index);
		}
		up_read(&qrtr_node_lock);

net/qrtr/qrtr.h

+2 −0

Original line number	Diff line number	Diff line
		@@ -10,6 +10,8 @@ struct sk_buff;
		#define QRTR_EP_NID_AUTO (-1)
		#define QRTR_EP_NET_ID_AUTO (1)

		#define QRTR_DEL_PROC_MAGIC 0xe111

		/**
		* struct qrtr_endpoint - endpoint handle
		* @xmit: Callback for outgoing packets