#include <sys/types.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/mbuf.h>
#include <sys/module.h>
#include <sys/systm.h>
#include <sys/taskqueue.h>
#include "usbdevs.h"
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
#include <netgraph/ng_message.h>
#include <netgraph/netgraph.h>
#include <netgraph/ng_parse.h>
#include <netgraph/bluetooth/include/ng_bluetooth.h>
#include <netgraph/bluetooth/include/ng_hci.h>
#include <netgraph/bluetooth/include/ng_ubt.h>
#include <netgraph/bluetooth/drivers/ubt/ng_ubt_var.h>
#define UBT_INTEL_HCICMD_TIMEOUT 2000
#define UBT_INTEL_TLV_IMAGE_TYPE 0x1c
enum {
UBT_INTEL_DEVICE_7260,
UBT_INTEL_DEVICE_8260,
UBT_INTEL_DEVICE_9260,
};
struct ubt_intel_version_rp {
uint8_t status;
uint8_t hw_platform;
uint8_t hw_variant;
uint8_t hw_revision;
uint8_t fw_variant;
uint8_t fw_revision;
uint8_t fw_build_num;
uint8_t fw_build_ww;
uint8_t fw_build_yy;
uint8_t fw_patch_num;
} __attribute__ ((packed));
static device_probe_t ubt_intel_probe;
static const STRUCT_USB_HOST_ID ubt_intel_devs[] =
{
{ USB_VPI(USB_VENDOR_INTEL2, 0x07dc, UBT_INTEL_DEVICE_7260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0a2a, UBT_INTEL_DEVICE_7260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0aa7, UBT_INTEL_DEVICE_7260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0a2b, UBT_INTEL_DEVICE_8260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0aaa, UBT_INTEL_DEVICE_8260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0025, UBT_INTEL_DEVICE_8260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0026, UBT_INTEL_DEVICE_8260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0029, UBT_INTEL_DEVICE_8260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0032, UBT_INTEL_DEVICE_9260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0033, UBT_INTEL_DEVICE_9260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0035, UBT_INTEL_DEVICE_9260) },
{ USB_VPI(USB_VENDOR_INTEL2, 0x0036, UBT_INTEL_DEVICE_9260) },
};
static usb_error_t
ubt_intel_do_hci_request(struct usb_device *udev, uint16_t opcode,
void *resp, uint8_t resp_len)
{
struct ubt_hci_event_command_compl *evt;
struct ubt_hci_cmd cmd;
usb_error_t error;
memset(&cmd, 0, sizeof(cmd));
cmd.opcode = htole16(opcode);
evt = malloc(offsetof(struct ubt_hci_event_command_compl, data) +
resp_len, M_TEMP, M_ZERO | M_WAITOK);
evt->header.event = NG_HCI_EVENT_COMMAND_COMPL;
evt->header.length = resp_len + UBT_HCI_EVENT_COMPL_HEAD_SIZE;
error = ubt_do_hci_request(udev, &cmd, evt, UBT_INTEL_HCICMD_TIMEOUT);
if (error != USB_ERR_NORMAL_COMPLETION)
goto exit;
if (evt->header.length == resp_len + UBT_HCI_EVENT_COMPL_HEAD_SIZE)
memcpy(resp, evt->data, resp_len);
else
error = USB_ERR_INVAL;
exit:
free(evt, M_TEMP);
return (error);
}
static uint8_t
ubt_intel_get_img_type(struct usb_device *udev)
{
#define UBT_INTEL_MAX_EVT_SIZE 256
static struct ubt_hci_cmd cmd = {
.opcode = htole16(NG_HCI_OPCODE(NG_HCI_OGF_VENDOR, 0x05)),
.length = 1,
.data = { 0xff },
};
struct ubt_hci_event_command_compl *evt;
usb_error_t error;
uint8_t status, datalen, type, len, img_type = 0;
uint8_t *data;
evt = malloc(UBT_INTEL_MAX_EVT_SIZE, M_TEMP, M_ZERO | M_WAITOK);
evt->header.event = NG_HCI_EVENT_COMMAND_COMPL;
evt->header.length =
UBT_INTEL_MAX_EVT_SIZE - sizeof(struct ubt_hci_evhdr);
error = ubt_do_hci_request(udev, &cmd, evt, UBT_INTEL_HCICMD_TIMEOUT);
if (error != USB_ERR_NORMAL_COMPLETION)
goto exit;
datalen = evt->header.length - UBT_HCI_EVENT_COMPL_HEAD_SIZE;
data = evt->data;
status = *data++;
if (status != 0)
goto exit;
datalen--;
while (datalen >= 2) {
type = *data++;
len = *data++;
datalen -= 2;
if (datalen < len)
break;
if (type == UBT_INTEL_TLV_IMAGE_TYPE && len == 1) {
img_type = *data;
break;
}
datalen -= len;
data += len;
}
exit:
free(evt, M_TEMP);
return (img_type);
}
static int
ubt_intel_probe(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
struct ubt_intel_version_rp version;
ng_hci_reset_rp reset;
int error;
uint8_t img_type;
if (uaa->usb_mode != USB_MODE_HOST)
return (ENXIO);
if (uaa->info.bIfaceIndex != 0)
return (ENXIO);
error = usbd_lookup_id_by_uaa(ubt_intel_devs, sizeof(ubt_intel_devs),
uaa);
if (error != 0)
return (error);
switch (USB_GET_DRIVER_INFO(uaa)) {
case UBT_INTEL_DEVICE_7260:
if (ubt_intel_do_hci_request(uaa->device,
NG_HCI_OPCODE(NG_HCI_OGF_HC_BASEBAND, NG_HCI_OCF_RESET),
&reset, sizeof(reset)) != USB_ERR_NORMAL_COMPLETION)
return (ENXIO);
if (reset.status != 0)
return (ENXIO);
if (ubt_intel_do_hci_request(uaa->device,
NG_HCI_OPCODE(NG_HCI_OGF_VENDOR, 0x05),
&version, sizeof(version)) != USB_ERR_NORMAL_COMPLETION)
return (ENXIO);
if (version.fw_patch_num == 0)
return (ENXIO);
break;
case UBT_INTEL_DEVICE_8260:
if (ubt_intel_do_hci_request(uaa->device,
NG_HCI_OPCODE(NG_HCI_OGF_VENDOR, 0x05),
&version, sizeof(version)) != USB_ERR_NORMAL_COMPLETION)
return (ENXIO);
if (version.fw_variant != 0x23)
return (ENXIO);
break;
case UBT_INTEL_DEVICE_9260:
img_type = ubt_intel_get_img_type(uaa->device);
if (img_type != 0x03)
return (ENXIO);
break;
default:
KASSERT(0 == 1, ("Unknown DRIVER_INFO"));
}
return (BUS_PROBE_DEFAULT);
}
static device_method_t ubt_intel_methods[] =
{
DEVMETHOD(device_probe, ubt_intel_probe),
DEVMETHOD_END
};
DEFINE_CLASS_1(ubt, ubt_intel_driver, ubt_intel_methods,
sizeof(struct ubt_softc), ubt_driver);
DRIVER_MODULE(ng_ubt_intel, uhub, ubt_intel_driver, 0, 0);
MODULE_VERSION(ng_ubt_intel, NG_BLUETOOTH_VERSION);
MODULE_DEPEND(ng_ubt_intel, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION);
MODULE_DEPEND(ng_ubt_intel, ng_hci, NG_BLUETOOTH_VERSION, NG_BLUETOOTH_VERSION, NG_BLUETOOTH_VERSION);
MODULE_DEPEND(ng_ubt_intel, usb, 1, 1, 1);