usr.sbin/btattach/init_swave.c

   1 /*      $NetBSD: init_swave.c,v 1.1 2008/04/15 11:17:48 plunky Exp $    */
   2
   3 /*-
   4  * Copyright (c) 2008 Iain Hibbert
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26  */
  27
  28 /*
  29  * init information in this file gleaned from hciattach(8)
  30  * command from BlueZ for Linux - see http://www.bluez.org/
  31  */
  32
  33 #include <sys/cdefs.h>
  34 __RCSID("$NetBSD: init_swave.c,v 1.1 2008/04/15 11:17:48 plunky Exp $");
  35
  36 #include <bluetooth.h>
  37 #include <err.h>
  38 #include <errno.h>
  39 #include <stdlib.h>
  40 #include <string.h>
  41 #include <termios.h>
  42
  43 #include "btattach.h"
  44
  45 #define HCI_CMD_SWAVE_PARAM_ACCESS_SET \
  46         HCI_OPCODE(HCI_OGF_VENDOR, 0x00b)
  47
  48 typedef struct {
  49         uint8_t         sub_command;
  50         uint8_t         param_type;
  51         uint8_t         param_length;
  52         uint8_t         transport_flow;
  53         uint8_t         transport_type;
  54         uint8_t         transport_rate;
  55 } __attribute__ ((__packed__)) hci_param_access_set_cp;
  56
  57 typedef struct {
  58         uint8_t                 d0;     /* ? */
  59         hci_param_access_set_cp cp;
  60 } __attribute__ ((__packed__)) hci_param_access_set_rp;
  61
  62 void
  63 init_swave(int fd, unsigned int speed)
  64 {
  65         hci_param_access_set_cp cp;
  66         hci_param_access_set_rp rp;
  67         size_t n;
  68
  69         cp.sub_command    = 0x01; /* set */
  70         cp.param_type     = 0x11; /* HCI Transport */
  71         cp.param_length   = 0x03;
  72         cp.transport_flow = 0x01; /* flow control */
  73         cp.transport_type = 0x01; /* UART */
  74
  75         switch(speed) {
  76         case B19200:    cp.transport_rate = 0x03;       break;
  77         case B38400:    cp.transport_rate = 0x02;       break;
  78         case B57600:    cp.transport_rate = 0x01;       break;
  79         case B115200:   cp.transport_rate = 0x00;       break;
  80         default:
  81                 errx(EXIT_FAILURE, "invalid speed for swave: %u\n", speed);
  82         }
  83
  84         uart_send_cmd(fd, HCI_CMD_SWAVE_PARAM_ACCESS_SET, &cp, sizeof(cp));
  85
  86         /*
  87          * we wait for a HCI_EVENT_VENDOR response with "0x0b" in the
  88          * first byte (possibly corresponding to the OGF?), and the
  89          * response should contain our settings as confirmation.
  90          */
  91         do {
  92                 n = uart_recv_ev(fd, HCI_EVENT_VENDOR, &rp, sizeof(rp));
  93         } while (n != sizeof(rp) || rp.d0 != 0x0b);
  94
  95         if (memcmp(&cp, &rp.cp, sizeof(cp)))
  96                 errx(EXIT_FAILURE, "param access set failed");
  97
  98         /*
  99          * now send a soft reset to make those parameters used
 100          */
 101         uart_send_cmd(fd, HCI_CMD_RESET, NULL, 0);
 102         /* assume it succeeded? */
 103
 104         /* bluez also says there will be a confirmation packet
 105          * on the new baud rate - ignore that for now
 106          */
 107 }