From 3303a2455b19eff6b4b7716b22c5a936f6ee6f6c Mon Sep 17 00:00:00 2001
From: Matthias Ringwald <matthias@ringwald.ch>
Date: Mon, 22 Apr 2019 11:15:13 +0200
Subject: [PATCH] mesh: add mesh_network_setup_pdu_header

---
 src/ble/mesh/mesh_network.c | 20 ++++++++++++++++++++
 src/ble/mesh/mesh_network.h | 13 +++++++++++++
 2 files changed, 33 insertions(+)

diff --git a/src/ble/mesh/mesh_network.c b/src/ble/mesh/mesh_network.c
index 87be218a1..3c5fe0c3e 100644
--- a/src/ble/mesh/mesh_network.c
+++ b/src/ble/mesh/mesh_network.c
@@ -777,6 +777,26 @@ void mesh_network_setup_pdu(mesh_network_pdu_t * network_pdu, uint16_t netkey_in
     network_pdu->len += transport_pdu_len;
 }
 
+/*
+ * @brief Setup network pdu header
+ * @param netkey_index
+ * @param ctl
+ * @param ttl
+ * @param seq
+ * @param dest
+ */
+void mesh_network_setup_pdu_header(mesh_network_pdu_t * network_pdu, uint16_t netkey_index, uint8_t nid, uint8_t ctl, uint8_t ttl, uint32_t seq, uint16_t src, uint16_t dest){
+    // set netkey_index
+    network_pdu->netkey_index = netkey_index;
+    // setup header
+    network_pdu->data[0] = (global_iv_index << 7) |  nid;
+    uint8_t ctl_ttl = (ctl << 7) | (ttl & 0x7f);
+    network_pdu->data[1] = ctl_ttl;
+    big_endian_store_24(network_pdu->data, 2, seq);
+    big_endian_store_16(network_pdu->data, 5, src);
+    big_endian_store_16(network_pdu->data, 7, dest);
+}
+
 void mesh_set_iv_index(uint32_t iv_index){
     global_iv_index = iv_index;
 }
diff --git a/src/ble/mesh/mesh_network.h b/src/ble/mesh/mesh_network.h
index b483a73df..310afe3e8 100644
--- a/src/ble/mesh/mesh_network.h
+++ b/src/ble/mesh/mesh_network.h
@@ -205,6 +205,19 @@ void mesh_network_send_pdu(mesh_network_pdu_t * network_pdu);
  */
 void mesh_network_setup_pdu(mesh_network_pdu_t * network_pdu, uint16_t netkey_index, uint8_t nid, uint8_t ctl, uint8_t ttl, uint32_t seq, uint16_t src, uint16_t dst, const uint8_t * transport_pdu_data, uint8_t transport_pdu_len);
 
+/**
+ * Setup network pdu header without modifying len or payload
+ * @param network_pdu
+ * @param netkey_index
+ * @param nid
+ * @param ctl
+ * @param ttl
+ * @param seq
+ * @param src
+ * @param dest
+ */
+void mesh_network_setup_pdu_header(mesh_network_pdu_t * network_pdu, uint16_t netkey_index, uint8_t nid, uint8_t ctl, uint8_t ttl, uint32_t seq, uint16_t src, uint16_t dest);
+
 /**
  * @brief Validate network addresses
  * @param ctl