Return-Path: Date: Fri, 4 Sep 2015 13:44:42 +0200 (CEST) From: Maxime Chevallier To: linux-bluetooth@vger.kernel.org Message-ID: <955556471.193976.1441367082888.JavaMail.zimbra@openwide.fr> Subject: [PATCH] Add hci_le_set_advertising_parameters to hci_lib MIME-Version: 1.0 Content-Type: text/plain; charset=utf-8 Sender: linux-bluetooth-owner@vger.kernel.org List-ID: Hi everyone I am currently developing an utility that puts the Marvell 88W8887 chip in 'Wake on Low-Energy' mode, and I need to set LE advertising parameters with HCI commands to do so, using hci_lib. I noticed that all required data structures and defines are already present in hci.h to implement this command, but I couldn't find any implementation in lib/hci_lib.h and lib/hci.c I made the implementation of the function on my side and tested it on my setup, and I figured you could be interested. I don't know if there is any specific reason this particular function was not implemented. Regards, Maxime Chevallier Signed-off-by: Maxime Chevallier --- lib/hci.c | 39 +++++++++++++++++++++++++++++++++++++++ lib/hci_lib.h | 5 +++++ 2 files changed, 44 insertions(+) diff --git a/lib/hci.c b/lib/hci.c index c25be9e..efdcc5d 100644 --- a/lib/hci.c +++ b/lib/hci.c @@ -2996,6 +2996,45 @@ int hci_le_set_advertise_enable(int dd, uint8_t enable, int to) return 0; } +int hci_le_set_advertising_parameters(int dd, uint16_t min_interval, + uint16_t max_interval, uint8_t advtype, + uint8_t own_bdaddr_type, uint8_t direct_bdaddr_type, + const bdaddr_t *direct_bdaddr, uint8_t chan_map, + uint8_t filter, int to) +{ + struct hci_request rq; + le_set_advertising_parameters_cp param_cp; + uint8_t status; + + memset(¶m_cp, 0, sizeof(param_cp)); + param_cp.min_interval = min_interval; + param_cp.max_interval = max_interval; + param_cp.advtype = advtype; + param_cp.own_bdaddr_type = own_bdaddr_type; + param_cp.direct_bdaddr_type = direct_bdaddr_type; + bacpy(¶m_cp.direct_bdaddr, direct_bdaddr); + param_cp.chan_map = chan_map; + param_cp.filter = filter; + + memset(&rq, 0, sizeof(rq)); + rq.ogf = OGF_LE_CTL; + rq.ocf = OCF_LE_SET_ADVERTISING_PARAMETERS; + rq.cparam = ¶m_cp; + rq.clen = LE_SET_ADVERTISING_PARAMETERS_CP_SIZE; + rq.rparam = &status; + rq.rlen = 1; + + if (hci_send_req(dd, &rq, to) < 0) + return -1; + + if (status) { + errno = EIO; + return -1; + } + + return 0; +} + int hci_le_create_conn(int dd, uint16_t interval, uint16_t window, uint8_t initiator_filter, uint8_t peer_bdaddr_type, bdaddr_t peer_bdaddr, uint8_t own_bdaddr_type, diff --git a/lib/hci_lib.h b/lib/hci_lib.h index 55aeb17..9fd7505 100644 --- a/lib/hci_lib.h +++ b/lib/hci_lib.h @@ -120,6 +120,11 @@ int hci_le_set_scan_parameters(int dev_id, uint8_t type, uint16_t interval, uint16_t window, uint8_t own_type, uint8_t filter, int to); int hci_le_set_advertise_enable(int dev_id, uint8_t enable, int to); +int hci_le_set_advertising_parameters(int dd, uint16_t min_interval, + uint16_t max_interval, uint8_t advtype, + uint8_t own_bdaddr_type, uint8_t direct_bdaddr_type, + const bdaddr_t *direct_bdaddr, uint8_t chan_map, + uint8_t filter, int to); int hci_le_create_conn(int dd, uint16_t interval, uint16_t window, uint8_t initiator_filter, uint8_t peer_bdaddr_type, bdaddr_t peer_bdaddr, uint8_t own_bdaddr_type, -- 2.1.4