Author: hselasky
Date: Fri Apr 24 08:07:59 2020
New Revision: 360243
URL: https://svnweb.freebsd.org/changeset/base/360243

Log:
  Add support for LE advertising to hccontrol(8).
  
  Submitted by: Marc Veldman <m...@bumblingdork.com>
  PR:           245848
  MFC after:    1 week
  Sponsored by: Mellanox Technologies

Modified:
  head/usr.sbin/bluetooth/hccontrol/hccontrol.8
  head/usr.sbin/bluetooth/hccontrol/le.c

Modified: head/usr.sbin/bluetooth/hccontrol/hccontrol.8
==============================================================================
--- head/usr.sbin/bluetooth/hccontrol/hccontrol.8       Fri Apr 24 07:55:39 
2020        (r360242)
+++ head/usr.sbin/bluetooth/hccontrol/hccontrol.8       Fri Apr 24 08:07:59 
2020        (r360243)
@@ -25,7 +25,7 @@
 .\" $Id: hccontrol.8,v 1.6 2003/08/06 21:26:38 max Exp $
 .\" $FreeBSD$
 .\"
-.Dd February 7, 2015
+.Dd April 24, 2020
 .Dt HCCONTROL 8
 .Os
 .Sh NAME
@@ -133,6 +133,8 @@ are:
 .It Cm Write_Page_Scan_Period_Mode
 .It Cm Read_Page_Scan_Mode
 .It Cm Write_Page_Scan_Mode
+.It Cm Read_LE_Host_Support
+.It Cm Write_LE_Host_Support
 .It Cm Read_Local_Version_Information
 .It Cm Read_Local_Supported_Commands
 .It Cm Read_Local_Supported_Features
@@ -143,6 +145,15 @@ are:
 .It Cm Reset_Failed_Contact_Counter
 .It Cm Get_Link_Quality
 .It Cm Read_RSSI
+.It Cm LE_Read_Local_Supported_Features
+.It Cm LE_Set_Advertising_Parameters 
+.It Cm LE_Read_Advertising_Physical_Channel_Tx_Power 
+.It Cm LE_Set_Advertising_Data
+.It Cm LE_Set_Scan_Response_Data
+.It Cm LE_Set_Advertising_Enable
+.It Cm LE_Set_Scan_Parameters
+.It Cm LE_Set_Scan_Enable
+.It Cm LE_Read_Supported_States
 .El
 .Pp
 The currently supported node commands in
@@ -170,6 +181,18 @@ are:
 .It Cm Write_Node_Role_Switch
 .It Cm Read_Node_List
 .El
+.Sh EXAMPLES
+Make the blutooth LE host, ubt0hci, scannable through
+.Xr hccontrol 8 commands:
+.Pp
+.Bd -literal -offset indent
+hccontrol -n ubt0hci le_set_advertising_enable disable
+hccontrol -n ubt0hci le_set_advertising_param
+hccontrol -n ubt0hci le_read_advertising_channel_tx_power
+hccontrol -n ubt0hci le_set_advertising_data
+hccontrol -n ubt0hci le_set_scan_response -n FBSD_Host
+hccontrol -n ubt0hci le_set_advertising_enable enable
+.Ed
 .Sh EXIT STATUS
 .Ex -std
 .Sh SEE ALSO

Modified: head/usr.sbin/bluetooth/hccontrol/le.c
==============================================================================
--- head/usr.sbin/bluetooth/hccontrol/le.c      Fri Apr 24 07:55:39 2020        
(r360242)
+++ head/usr.sbin/bluetooth/hccontrol/le.c      Fri Apr 24 08:07:59 2020        
(r360243)
@@ -57,6 +57,9 @@ static int le_read_local_supported_features(int s, int
 static int set_le_event_mask(int s, uint64_t mask);
 static int set_event_mask(int s, uint64_t mask);
 static int le_enable(int s, int argc, char *argv[]);
+static int le_set_advertising_enable(int s, int argc, char *argv[]);
+static int le_set_advertising_param(int s, int argc, char *argv[]);
+static int le_read_advertising_channel_tx_power(int s, int argc, char *argv[]);
 
 static int
 le_set_scan_param(int s, int argc, char *argv[])
@@ -339,6 +342,170 @@ int le_enable(int s, int argc, char *argv[])
        return OK;
 }
 
+static int
+le_set_advertising_enable(int s, int argc, char *argv[])
+{
+       ng_hci_le_set_advertise_enable_cp cp;
+       ng_hci_le_set_advertise_enable_rp rp;
+       int n, enable = 0;
+
+       if (argc != 1)
+               return USAGE;
+         
+       if (strcmp(argv[0], "enable") == 0)
+               enable = 1;
+       else if (strcmp(argv[0], "disable") != 0)
+               return USAGE;
+
+       n = sizeof(rp);
+       cp.advertising_enable = enable;
+       if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LE,
+               NG_HCI_OCF_LE_SET_ADVERTISE_ENABLE), 
+               (void *)&cp, sizeof(cp), (void *)&rp, &n) == ERROR)
+               return (ERROR);
+                       
+       if (rp.status != 0x00) {
+               fprintf(stdout, "Status: %s [%#02x]\n", 
+                       hci_status2str(rp.status), rp.status);
+               return (FAILED);
+       }
+        fprintf(stdout, "LE Advertising %s\n", (enable ? "enabled" : 
"disabled"));
+
+       return (OK);
+}
+
+static int
+le_set_advertising_param(int s, int argc, char *argv[])
+{
+       ng_hci_le_set_advertising_parameters_cp cp;
+       ng_hci_le_set_advertising_parameters_rp rp;
+
+       int n, ch;
+
+       cp.advertising_interval_min = 0x800;
+       cp.advertising_interval_max = 0x800;
+       cp.advertising_type = 0;
+       cp.own_address_type = 0;
+       cp.direct_address_type = 0;
+
+       cp.advertising_channel_map = 7;
+       cp.advertising_filter_policy = 0;
+
+       optreset = 1;
+       optind = 0;
+       while ((ch = getopt(argc, argv , "m:M:t:o:p:a:c:f:")) != -1) {
+               switch(ch) {
+               case 'm':
+                       cp.advertising_interval_min =
+                               (uint16_t)(strtod(optarg, NULL)/0.625);
+                       break;
+               case 'M':
+                       cp.advertising_interval_max =
+                               (uint16_t)(strtod(optarg, NULL)/0.625);
+                       break;
+               case 't':
+                       cp.advertising_type =
+                               (uint8_t)strtod(optarg, NULL);
+                       break;
+               case 'o':
+                       cp.own_address_type =
+                               (uint8_t)strtod(optarg, NULL);
+                       break;
+               case 'p':
+                       cp.direct_address_type =
+                               (uint8_t)strtod(optarg, NULL);
+                       break;
+               case 'a':
+                       if (!bt_aton(optarg, &cp.direct_address)) {
+                               struct hostent  *he = NULL;
+
+                               if ((he = bt_gethostbyname(optarg)) == NULL)
+                                       return (USAGE);
+
+                               memcpy(&cp.direct_address, he->h_addr, 
sizeof(cp.direct_address));
+                       }
+                       break;
+               case 'c':
+                       cp.advertising_channel_map =
+                               (uint8_t)strtod(optarg, NULL);
+                       break;
+               case 'f':
+                       cp.advertising_filter_policy =
+                               (uint8_t)strtod(optarg, NULL);
+                       break;
+               }
+       }
+
+       n = sizeof(rp);
+       if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LE,
+               NG_HCI_OCF_LE_SET_ADVERTISING_PARAMETERS), 
+               (void *)&cp, sizeof(cp), (void *)&rp, &n) == ERROR)
+               return (ERROR);
+                       
+       if (rp.status != 0x00) {
+               fprintf(stdout, "Status: %s [%#02x]\n", 
+                       hci_status2str(rp.status), rp.status);
+               return (FAILED);
+       }
+
+       return (OK);
+}
+
+static int
+le_read_advertising_channel_tx_power(int s, int argc, char *argv[])
+{
+       ng_hci_le_read_advertising_channel_tx_power_rp rp;
+       int n;
+
+       n = sizeof(rp);
+
+       if (hci_simple_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LE,
+               NG_HCI_OCF_LE_READ_ADVERTISING_CHANNEL_TX_POWER), 
+               (void *)&rp, &n) == ERROR)
+               return (ERROR);
+                       
+       if (rp.status != 0x00) {
+               fprintf(stdout, "Status: %s [%#02x]\n", 
+                       hci_status2str(rp.status), rp.status);
+               return (FAILED);
+       }
+
+        fprintf(stdout, "Advertising transmit power level: %d dBm\n",
+               (int8_t)rp.transmit_power_level);
+
+       return (OK);
+}
+
+static int
+le_set_advertising_data(int s, int argc, char *argv[])
+{
+       ng_hci_le_set_advertising_data_cp cp;
+       ng_hci_le_set_advertising_data_rp rp;
+       int n, len;
+
+       n = sizeof(rp);
+
+       char buf[NG_HCI_ADVERTISING_DATA_SIZE];
+
+       len = sizeof(buf);
+       parse_param(argc, argv, buf, &len);
+       memset(cp.advertising_data, 0, sizeof(cp.advertising_data));
+       cp.advertising_data_length = len;
+
+       if (hci_request(s, NG_HCI_OPCODE(NG_HCI_OGF_LE,
+               NG_HCI_OCF_LE_SET_ADVERTISING_DATA), 
+               (void *)&cp, sizeof(cp), (void *)&rp, &n) == ERROR)
+               return (ERROR);
+                       
+       if (rp.status != 0x00) {
+               fprintf(stdout, "Status: %s [%#02x]\n", 
+                       hci_status2str(rp.status), rp.status);
+               return (FAILED);
+       }
+
+       return (OK);
+}
+
 struct hci_command le_commands[] = {
 {
        "le_enable",
@@ -377,5 +544,32 @@ struct hci_command le_commands[] = {
          "le_set_scan_param [active|passive] interval(ms) window(ms) 
[public|random] [all|whitelist] \n"
          "set LE device scan parameter",
          &le_set_scan_param
+  },
+  {
+         "le_set_advertising_enable",
+         "le_set_advertising_enable [enable|disable] \n"
+         "start or stop advertising",
+         &le_set_advertising_enable
+  },
+  {
+         "le_read_advertising_channel_tx_power",
+         "le_read_advertising_channel_tx_power\n"
+         "read host advertising transmit poser level (dBm)",
+         &le_read_advertising_channel_tx_power
+  },
+  {
+         "le_set_advertising_param",
+         "le_set_advertising_param  [-m min_interval(ms)] [-M 
max_interval(ms)]\n"
+         "[-t advertising_type] [-o own_address_type] [-p peer_address_type]\n"
+         "[-c advertising_channel_map] [-f advertising_filter_policy]\n"
+         "[-a peer_address]\n"
+         "set LE device advertising parameters",
+         &le_set_advertising_param
+  },
+  {
+         "le_set_advertising_data",
+         "le_set_advertising_data -n $name -f $flag -u $uuid16,$uuid16 \n"
+         "set LE device advertising packed data",
+         &le_set_advertising_data
   },
 };
_______________________________________________
svn-src-head@freebsd.org mailing list
https://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "svn-src-head-unsubscr...@freebsd.org"

Reply via email to