From patchwork Wed Mar 15 17:26:09 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Brian Gix X-Patchwork-Id: 663554 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 7B4BFC6FD1D for ; Wed, 15 Mar 2023 17:26:23 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231802AbjCOR0V (ORCPT ); Wed, 15 Mar 2023 13:26:21 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60680 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S232234AbjCOR0T (ORCPT ); Wed, 15 Mar 2023 13:26:19 -0400 Received: from mail-pl1-x62c.google.com (mail-pl1-x62c.google.com [IPv6:2607:f8b0:4864:20::62c]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id AC72126846 for ; Wed, 15 Mar 2023 10:26:14 -0700 (PDT) Received: by mail-pl1-x62c.google.com with SMTP id ja10so11172998plb.5 for ; Wed, 15 Mar 2023 10:26:14 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20210112; t=1678901174; h=content-transfer-encoding:mime-version:message-id:date:subject:cc :to:from:from:to:cc:subject:date:message-id:reply-to; bh=94yMlbDzjaMILVDL5DimGkuhCNlfrbJ5xFedRs1rvno=; b=goUzuvNN8QWPYwjxOr0KlFfKPI36ttqfefrtIse9vCxFMJntQwUtpa98RKgQAGELOE Znd4v+86BgOwvb6c61+5lWsqaNTdSQEmyHNJQ9GSoDJvU6MVEkskZBsVnva8DDhqqzBa oOhn+QzNeMY+fhZMFPLXgIXS1Hzy8nUEKobcbwhoNfTjpMFgn2V8vUdPEeatAthxhvDM XMIg8yEbOHN8S6DcFPkEnJyRlnL/+wzbVBg+sQ5HuOFaSBAcDdPezcYW34lU+7pvRgXX uYEHl4MhQae9DpZP6Qf9NLexvLQ6XSDESqwCKgwyMZh7dkJcSxvWX7fujIILx35Wu/UP Lrog== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20210112; t=1678901174; h=content-transfer-encoding:mime-version:message-id:date:subject:cc :to:from:x-gm-message-state:from:to:cc:subject:date:message-id :reply-to; bh=94yMlbDzjaMILVDL5DimGkuhCNlfrbJ5xFedRs1rvno=; b=dHaKg3aIMhgdZQ3CqXfnhZVhllZYaYq2ENGI2+iqjaLaNFW0IjmpFRA8mbYvr6tIQq muWyZ9GbzdU88clcB21X7JXVfr5y6IWJMkEfPrzlT5T85X84F7nna7MFRkW7JgyXzlgt 4m2MhIOv96D+Nk/MAdDjnR1oOI54tNQiX40I0LBd1U+HcpaFysbI0/joWFPtIos6I74p f+3OKDZRCaPxF1kUUb68tyE6qtMcqN0nh5VrOUvEjtjnXexdjcsXe+hsOBZHpnwQEzTE Vd9F8rA3cpz6PmpU6OpuNqJvdhQpVS/U/qsSMWig85E/2QW6caVAaPaF/G4Gx/49ebEF ns9A== X-Gm-Message-State: AO0yUKW9Yea+3i9NEB+qKjHIfaySy0MR5CJtSmcOO5+hgcRS4fqZie8v l7HCImxFs2OzaHuFn88x0pUCVcmLKCY= X-Google-Smtp-Source: AK7set9wjy3LxmWOwrNnaqM/L6e4JUfAspt1xj62i7qWSZPAor96uINiISeL+5rj/SniiOVMxrVBgg== X-Received: by 2002:a05:6a20:12c6:b0:d4:686:4a92 with SMTP id v6-20020a056a2012c600b000d406864a92mr550317pzg.34.1678901173457; Wed, 15 Mar 2023 10:26:13 -0700 (PDT) Received: from zbook.. (97-113-12-200.tukw.qwest.net. [97.113.12.200]) by smtp.gmail.com with ESMTPSA id g24-20020aa78198000000b00592417157f2sm3930971pfi.148.2023.03.15.10.26.12 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 15 Mar 2023 10:26:13 -0700 (PDT) From: Brian Gix To: linux-bluetooth@vger.kernel.org Cc: brian.gix@intel.com, brian.gix@gmail.com, inga.stotland@intel.com Subject: [PATCH BlueZ 1/2] mesh: Filter originated Provisioning Data packets Date: Wed, 15 Mar 2023 10:26:09 -0700 Message-Id: <20230315172610.13796-1-brian.gix@gmail.com> X-Mailer: git-send-email 2.39.2 MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org 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(-) diff --git a/mesh/mesh-io-mgmt.c b/mesh/mesh-io-mgmt.c index 9ae1af05a..65994f058 100644 --- a/mesh/mesh-io-mgmt.c +++ b/mesh/mesh-io-mgmt.c @@ -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);