mesh: Filter originated Provisioning Data packets
PATCH 1/2 mesh: Filter originated Provisioning Data packets
The mesh daemon can process incoming mesh packets on more than one controller, but if a Provisioning data packet that originated from the local daemon is received by a different controller, it must be filtered and disregarded, or it will break the provisioning protocol.
--- mesh/mesh-io-mgmt.c | 58 ++++++++++++++++++++++++++++++++++++--------- 1 file changed, 47 insertions(+), 11 deletions(-)
mesh/mesh-io-mgmt.c +47 -11
@@ -82,6 +82,8 @@ struct dup_filter {uint8_t addr[6 ]; } __packed; +static const uint8_t zero_addr[] = {0 ,0 ,0 ,0 ,0 ,0 }; +static struct mesh_io_private *pvt;static uint32_t get_instant (void )
@@ -110,6 +112,14 @@ static bool find_by_addr(const void *a, const void *b)return !memcmp (filter->addr, b,6 ); } +static bool find_by_adv (const void *a,const void *b) +{ +const struct dup_filter *filter = a; +uint64_t data =l_get_be64 (b); + +return !memcmp (filter->addr, zero_addr,6 ) && filter->data == data; +} +static void filter_timeout (struct l_timeout *timeout,void *user_data) {struct dup_filter *filter;
@@ -146,7 +156,22 @@ static bool filter_dups(const uint8_t *addr, const uint8_t *adv,uint32_t instant_delta;uint64_t data =l_get_be64 (adv); - filter =l_queue_remove_if (pvt->dup_filters, find_by_addr, addr); +if (!addr) + addr = zero_addr; + +if (adv[1 ] ==MESH_AD_TYPE_PROVISION ) { + filter =l_queue_find (pvt->dup_filters, find_by_adv, adv); + +if (!filter && addr != zero_addr) +return false; + +l_queue_remove (pvt->dup_filters, filter); + + }else { + filter =l_queue_remove_if (pvt->dup_filters, find_by_addr, + addr); + } +if (!filter) { filter = l_new(struct dup_filter, 1);memcpy (filter->addr, addr,6 );
@@ -177,7 +202,7 @@ static void process_rx_callbacks(void *v_reg, void *v_rx) rx_reg->cb (rx_reg->user_data, &rx->info, rx->data, rx->len); } -static void process_rx (struct mesh_io_private *pvt,int8_t rssi, +static void process_rx (uint16_t index,struct mesh_io_private *pvt,int8_t rssi,uint32_t instant,const uint8_t *addr,const uint8_t *data,uint8_t len) {
@@ -191,6 +216,10 @@ static void process_rx(struct mesh_io_private *pvt, int8_t rssi, .info.rssi = rssi, }; +/* Accept all traffic except beacons from any controller */ +if (index != pvt->send_idx && data[0 ] ==MESH_AD_TYPE_BEACON ) +return ; +print_packet ("RX" , data, len);l_queue_foreach (pvt->rx_regs, process_rx_callbacks, &rx); }
@@ -205,7 +234,7 @@ static void event_device_found(uint16_t index, uint16_t length, const void *param, void *user_data) { const struct mgmt_ev_mesh_device_found *ev = param; -struct mesh_io *io = user_data; +struct mesh_io_private *pvt = user_data;const uint8_t *adv;const uint8_t *addr;uint32_t instant;
@@ -236,9 +265,10 @@ static void event_device_found(uint16_t index, uint16_t length,if (len > adv_len)break ; -if (adv[1 ] >=0x29 && adv[1 ] <=0x2B ) -process_rx (io->pvt, ev->rssi, instant, addr, adv +1 , - adv[0 ]); +if (adv[1 ] >=MESH_AD_TYPE_PROVISION && + adv[1 ] <=MESH_AD_TYPE_BEACON ) +process_rx (index, pvt, ev->rssi, instant, addr, + adv +1 , adv[0 ]); adv += field_len +1 ; }
@@ -320,6 +350,12 @@ static void ctl_up(uint8_t status, uint16_t length, mesh->num_ad_types =sizeof (mesh_ad_types);memcpy (mesh->ad_types, mesh_ad_types,sizeof (mesh_ad_types)); + pvt->rx_id =mesh_mgmt_register (MGMT_EV_MESH_DEVICE_FOUND , +MGMT_INDEX_NONE , event_device_found, pvt, +NULL ); + pvt->tx_id =mesh_mgmt_register (MGMT_EV_MESH_PACKET_CMPLT , + index, send_cmplt, pvt,NULL ); +mesh_mgmt_send (MGMT_OP_SET_MESH_RECEIVER , index, len, mesh, mesh_up,L_UINT_TO_PTR (index),NULL );l_debug ("done %d mesh startup" , index);
@@ -407,11 +443,6 @@ static bool dev_init(struct mesh_io *io, void *opts, void *user_data)mesh_mgmt_send (MGMT_OP_READ_INFO , index,0 ,NULL , read_info_cb,L_UINT_TO_PTR (index),NULL ); - pvt->rx_id =mesh_mgmt_register (MGMT_EV_MESH_DEVICE_FOUND , -MGMT_INDEX_NONE , event_device_found, io,NULL ); - pvt->tx_id =mesh_mgmt_register (MGMT_EV_MESH_PACKET_CMPLT , -MGMT_INDEX_NONE , send_cmplt, io,NULL ); - pvt->dup_filters =l_queue_new (); pvt->rx_regs =l_queue_new (); pvt->tx_pkts =l_queue_new ();
@@ -522,6 +553,11 @@ static void send_pkt(struct mesh_io_private *pvt, struct tx_pkt *tx, send->adv_data_len = tx->len +1 ; send->adv_data[0 ] = tx->len;memcpy (send->adv_data +1 , tx->pkt, tx->len); + +/* Filter looped back Provision packets */ +if (tx->pkt[0 ] ==MESH_AD_TYPE_PROVISION ) +filter_dups (NULL , send->adv_data,get_instant ()); +mesh_mgmt_send (MGMT_OP_MESH_SEND , index, len, send, send_queued, tx,NULL );print_packet ("Mesh Send Start" , tx->pkt, tx->len);
Signature · 1 line
2.39.2
PATCH 2/2 mesh: Make MGMT mesh-io less noisy
Remove excessive logging traffic
--- mesh/mesh-io-mgmt.c | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-)
mesh/mesh-io-mgmt.c +3 -3
@@ -227,7 +227,7 @@ static void process_rx(uint16_t index, struct mesh_io_private *pvt, int8_t rssi,static void send_cmplt (uint16_t index,uint16_t length,const void *param,void *user_data) { -print_packet ("Mesh Send Complete" , param, length); +/* print_packet("Mesh Send Complete", param, length); */ } static void event_device_found(uint16_t index, uint16_t length,
@@ -506,7 +506,7 @@ static void send_cancel(struct mesh_io_private *pvt)if (pvt->handle) { remove.handle = pvt->handle; -l_debug ("Cancel TX" ); +/* l_debug("Cancel TX"); */ mesh_mgmt_send (MGMT_OP_MESH_SEND_CANCEL , pvt->send_idx,sizeof (remove), &remove,NULL ,NULL ,NULL );
@@ -560,7 +560,7 @@ static void send_pkt(struct mesh_io_private *pvt, struct tx_pkt *tx,mesh_mgmt_send (MGMT_OP_MESH_SEND , index, len, send, send_queued, tx,NULL ); -print_packet ("Mesh Send Start" , tx->pkt, tx->len); +/* print_packet("Mesh Send Start", tx->pkt, tx->len); */ pvt->tx = tx; }
Signature · 1 line
2.39.2
This is automated email and please do not reply to this email!
Dear submitter,
Thank you for submitting the patches to the linux bluetooth mailing list. This is a CI test results with your patch series:
PW Link:https://patchwork.kernel.org/project/bluetooth/list/?series=730438
---Test result---
Test Summary:
CheckPatch PASS 0.93 seconds GitLint PASS 0.62 seconds BuildEll PASS 28.26 seconds BluezMake PASS 913.57 seconds MakeCheck PASS 12.44 seconds MakeDistcheck PASS 158.01 seconds CheckValgrind PASS 262.77 seconds CheckSmatch WARNING 349.89 seconds bluezmakeextell PASS 105.25 seconds IncrementalBuild PASS 1503.12 seconds ScanBuild PASS 1072.16 seconds
Details
##############################
Test: CheckSmatch - WARNING
Desc: Run smatch tool with source
Output:mesh/mesh-io-mgmt.c:537:67: warning: Variable length array is used.mesh/mesh-io-mgmt.c:537:67: warning: Variable length array is used.
---
Regards,
Linux Bluetooth