i2p/haiku-beta6
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

bluetooth: Refactor debugging and trace calls

Browse Source 
* The old debug system was too complex and made
  troubleshooring difficult. (it also was unique
  like a snowflake... which we don't want)
* Move to the classic TRACE / ERROR a large majority
  of the code has changed to.
* I like trace statements, but drop some obvious ones
* Fix style issues along the way
This commit is contained in:
Alexander von Gluck IV
2016-04-09 23:40:54 -05:00
parent a4a85baea1
commit 1f2fa6cd09
10 changed files with 200 additions and 215 deletions
Download Patch File Download Diff File Expand all files Collapse all files
headers/private/bluetooth/btDebug.h
+12 -42
View File
@@ -1,52 +1,22 @@
/* /*
* Copyright 2007 Oliver Ruiz Dorantes, oliver.ruiz.dorantes_at_gmail.com * Copyright 2015-2016 Haiku, Inc. All rights reserved.
* * Distributed under the terms of the MIT License.
* All rights reserved. Distributed under the terms of the MIT License.
* *
*/ */
#ifndef _BTDEBUG_H
#define _BTDEBUG_H
#ifdef BT_DEBUG_THIS_MODULE // XXX: Remove once things get "better"
#ifndef MODULE_NAME #define DEBUG
//#warning MODULE_NAME not defined for Haiku BT debugging tools #ifdef DEBUG
#define MODULE_NAME "BT" # define TRACE(x...) dprintf("bt: " x)
#endif
#ifndef SUBMODULE_NAME
//#warning SUBMODULE_NAME not defined for Haiku BT debugging tools
#define SUBMODULE_NAME ""
#endif
#ifndef SUBMODULE_COLOR
//#warning SUBMODULE_COLOR not defined for Haiku BT debugging tools
#define SUBMODULE_COLOR 38
#endif
#define debugf(a,param...) dprintf("\x1b[%dm" MODULE_NAME " " SUBMODULE_NAME " " "%s\x1b[0m: " a,SUBMODULE_COLOR,__FUNCTION__, param);
#define flowf(a) dprintf("\x1b[%dm" MODULE_NAME " " SUBMODULE_NAME " " "%s\x1b[0m: " a,SUBMODULE_COLOR,__FUNCTION__);
#else #else
#define debugf(a,param...) # define TRACE(x...) ;
#define flowf(a,param...)
#endif
#undef BT_DEBUG_THIS_MODULE
#define TOUCH(x) ((void)(x))
/* */
#if 0
#pragma mark - Kernel Auxiliary Stuff -
#endif #endif
static inline uint32 TEST_AND_SET(uint32 *byte, uint32 bit_mask) { #define ERROR(x...) dprintf("bt: " x)
#define CALLED(x...) TRACE("bt: CALLED %s\n", __PRETTY_FUNCTION__)
uint32 val = (*byte&bit_mask)!=0;
*byte |= bit_mask;
return val;
}
static inline uint32 TEST_AND_CLEAR(uint32* byte, uint32 bit_mask) { #endif /* _BTDEBUG_H */
uint32 val = (*byte&bit_mask)!=0;
*byte &= ~bit_mask;
return val;
}
src/add-ons/kernel/bluetooth/btCoreData/BTCoreData.cpp
+6 -4
View File
@@ -114,7 +114,8 @@ PostEvent(bluetooth_device* ndev, void* event, size_t size)
if (conn == NULL) if (conn == NULL)
panic("no mem for conn desc"); panic("no mem for conn desc");
conn->ndevice = ndev; conn->ndevice = ndev;
debugf("Registered connection handle=%#x\n",data->handle); TRACE("%s: Registered connection handle=%#x\n", __func__,
data->handle);
break; break;
} }
@@ -126,7 +127,8 @@ PostEvent(bluetooth_device* ndev, void* event, size_t size)
(outgoingEvent + 1); (outgoingEvent + 1);
RemoveConnection(data->handle, ndev->index); RemoveConnection(data->handle, ndev->index);
debugf("unRegistered connection handle=%#x\n",data->handle); TRACE("%s: unRegistered connection handle=%#x\n", __func__,
data->handle);
break; break;
} }
@@ -140,10 +142,10 @@ PostEvent(bluetooth_device* ndev, void* event, size_t size)
event, size, B_TIMEOUT, 1 * 1000 * 1000); event, size, B_TIMEOUT, 1 * 1000 * 1000);
if (err != B_OK) if (err != B_OK)
debugf("Error posting userland %s\n", strerror(err)); ERROR("%s: Error posting userland %s\n", __func__, strerror(err));
} else { } else {
flowf("ERROR:bluetooth_server not found for posting\n"); ERROR("%s: bluetooth_server not found for posting!\n", __func__);
err = B_NAME_NOT_FOUND; err = B_NAME_NOT_FOUND;
} }
src/add-ons/kernel/bluetooth/btCoreData/ChannelInterface.cpp
+4 -4
View File
@@ -36,7 +36,7 @@ uint16
ChannelAllocateCid(HciConnection* conn) ChannelAllocateCid(HciConnection* conn)
{ {
uint16 cid = conn->lastCid; uint16 cid = conn->lastCid;
debugf("Starting search cid %d\n",cid); TRACE("%s: Starting search cid %d\n", __func__, cid);
do { do {
cid = (cid == L2CAP_LAST_CID) ? L2CAP_FIRST_CID : cid + 1; cid = (cid == L2CAP_LAST_CID) ? L2CAP_FIRST_CID : cid + 1;
@@ -81,7 +81,7 @@ AddChannel(HciConnection* conn, uint16 psm)
L2capChannel* channel = new (std::nothrow) L2capChannel; L2capChannel* channel = new (std::nothrow) L2capChannel;
if (channel == NULL) { if (channel == NULL) {
flowf ("no mem for channel"); ERROR("%s: Unable to allocate memory for channel!\n", __func__);
return NULL; return NULL;
} }
@@ -96,7 +96,7 @@ AddChannel(HciConnection* conn, uint16 psm)
channel->cfgState = 0; channel->cfgState = 0;
channel->endpoint = NULL; channel->endpoint = NULL;
// the last assigned CID should be the last in the list // the last assigned CID should be the last in the list
// Think if keeping an ordered list will improve the search method // Think if keeping an ordered list will improve the search method
// as it is called in every reception // as it is called in every reception
conn->ChannelList.Add(channel); conn->ChannelList.Add(channel);
@@ -105,7 +105,7 @@ AddChannel(HciConnection* conn, uint16 psm)
// Any constance of the new channel created ...? ng_l2cap_con_ref(con); // Any constance of the new channel created ...? ng_l2cap_con_ref(con);
} else { } else {
flowf("no CID available\n"); ERROR("%s: no CID available\n", __func__);
delete channel; delete channel;
channel = NULL; channel = NULL;
} }
src/add-ons/kernel/bluetooth/hci/acl.cpp
+23 -17
View File
@@ -40,7 +40,8 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
// Check ACL data packet. Driver should ensure report complete ACL packets // Check ACL data packet. Driver should ensure report complete ACL packets
if (nbuf->size < sizeof(struct hci_acl_header)) { if (nbuf->size < sizeof(struct hci_acl_header)) {
debugf("Invalid ACL data packet, small length=%ld\n", nbuf->size); ERROR("%s: Invalid ACL data packet, small length=%" B_PRIu32 "\n",
__func__, nbuf->size);
gBufferModule->free(nbuf); gBufferModule->free(nbuf);
return (EMSGSIZE); return (EMSGSIZE);
} }
@@ -63,7 +64,7 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
aclHeader.Remove(); aclHeader.Remove();
debugf("ACL data packet, handle=%#x, PB=%#x, length=%d\n", TRACE("%s: ACL data packet, handle=%#x, PB=%#x, length=%d\n", __func__,
con_handle, pb, length); con_handle, pb, length);
// a) Ensure there is HCI connection // a) Ensure there is HCI connection
@@ -72,13 +73,15 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
HciConnection* conn = btCoreData->ConnectionByHandle(con_handle, hid); HciConnection* conn = btCoreData->ConnectionByHandle(con_handle, hid);
if (conn == NULL) { if (conn == NULL) {
debugf("Uexpected handle=%#x does not exist!\n", con_handle); ERROR("%s: expected handle=%#x does not exist!\n", __func__,
con_handle);
conn = btCoreData->AddConnection(con_handle, BT_ACL, BDADDR_NULL, hid); conn = btCoreData->AddConnection(con_handle, BT_ACL, BDADDR_NULL, hid);
} }
// Verify connection state // Verify connection state
if (conn->status!= HCI_CONN_OPEN) { if (conn->status!= HCI_CONN_OPEN) {
flowf("unexpected ACL data packet. Connection not open\n"); ERROR("%s: unexpected ACL data packet. Connection not open\n",
__func__);
gBufferModule->free(nbuf); gBufferModule->free(nbuf);
return EHOSTDOWN; return EHOSTDOWN;
} }
@@ -87,8 +90,8 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
// Process packet // Process packet
if (pb == HCI_ACL_PACKET_START) { if (pb == HCI_ACL_PACKET_START) {
if (conn->currentRxPacket != NULL) { if (conn->currentRxPacket != NULL) {
debugf("Dropping incomplete L2CAP packet, got %ld want %d \n", TRACE("%s: Dropping incomplete L2CAP packet, got %" B_PRIu32
conn->currentRxPacket->size, length ); " want %d \n", __func__, conn->currentRxPacket->size, length );
gBufferModule->free(conn->currentRxPacket); gBufferModule->free(conn->currentRxPacket);
conn->currentRxPacket = NULL; conn->currentRxPacket = NULL;
conn->currentRxExpectedLength = 0; conn->currentRxExpectedLength = 0;
@@ -96,8 +99,8 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
// Get L2CAP header, ACL header was dimissed // Get L2CAP header, ACL header was dimissed
if (nbuf->size < sizeof(l2cap_hdr_t)) { if (nbuf->size < sizeof(l2cap_hdr_t)) {
debugf("Invalid L2CAP start fragment, small, length=%ld\n", TRACE("%s: Invalid L2CAP start fragment, small, length=%" B_PRIu32
nbuf->size); "\n", __func__, nbuf->size);
gBufferModule->free(nbuf); gBufferModule->free(nbuf);
return (EMSGSIZE); return (EMSGSIZE);
} }
@@ -113,7 +116,7 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
l2capHeader->length = le16toh(l2capHeader->length); l2capHeader->length = le16toh(l2capHeader->length);
l2capHeader->dcid = le16toh(l2capHeader->dcid); l2capHeader->dcid = le16toh(l2capHeader->dcid);
debugf("New L2CAP, handle=%#x length=%d\n", con_handle, TRACE("%s: New L2CAP, handle=%#x length=%d\n", __func__, con_handle,
le16toh(l2capHeader->length)); le16toh(l2capHeader->length));
// Start new L2CAP packet // Start new L2CAP packet
@@ -131,7 +134,8 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
gBufferModule->merge(conn->currentRxPacket, nbuf, true); gBufferModule->merge(conn->currentRxPacket, nbuf, true);
} else { } else {
debugf("invalid ACL data packet. Invalid PB flag=%#x\n", pb); ERROR("%s: invalid ACL data packet. Invalid PB flag=%#x\n", __func__,
pb);
gBufferModule->free(nbuf); gBufferModule->free(nbuf);
return (EINVAL); return (EINVAL);
} }
@@ -140,9 +144,9 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
conn->currentRxExpectedLength -= length; conn->currentRxExpectedLength -= length;
if (conn->currentRxExpectedLength < 0) { if (conn->currentRxExpectedLength < 0) {
TRACE("%s: Mismatch. Got %" B_PRIu32 ", expected %" B_PRIuSIZE "\n",
debugf("Mismatch. Got %ld, expected %ld\n", __func__, conn->currentRxPacket->size,
conn->currentRxPacket->size, conn->currentRxExpectedLength); conn->currentRxExpectedLength);
gBufferModule->free(conn->currentRxPacket); gBufferModule->free(conn->currentRxPacket);
conn->currentRxPacket = NULL; conn->currentRxPacket = NULL;
@@ -150,13 +154,14 @@ AclAssembly(net_buffer* nbuf, hci_id hid)
} else if (conn->currentRxExpectedLength == 0) { } else if (conn->currentRxExpectedLength == 0) {
// OK, we have got complete L2CAP packet, so process it // OK, we have got complete L2CAP packet, so process it
debugf("L2cap packet ready %ld bytes\n", conn->currentRxPacket->size); TRACE("%s: L2cap packet ready %" B_PRIu32 " bytes\n", __func__,
conn->currentRxPacket->size);
error = PostToUpper(conn, conn->currentRxPacket); error = PostToUpper(conn, conn->currentRxPacket);
// clean // clean
conn->currentRxPacket = NULL; conn->currentRxPacket = NULL;
conn->currentRxExpectedLength = 0; conn->currentRxExpectedLength = 0;
} else { } else {
debugf("Expected %ld current adds %d\n", TRACE("%s: Expected %ld current adds %d\n", __func__,
conn->currentRxExpectedLength, length); conn->currentRxExpectedLength, length);
} }
@@ -169,8 +174,9 @@ PostToUpper(HciConnection* conn, net_buffer* buf)
{ {
if (L2cap == NULL) if (L2cap == NULL)
if (get_module(NET_BLUETOOTH_L2CAP_NAME,(module_info**)&L2cap) != B_OK) { if (get_module(NET_BLUETOOTH_L2CAP_NAME, (module_info**)&L2cap) != B_OK) {
debugf("cannot get module \"%s\"\n", NET_BLUETOOTH_L2CAP_NAME); ERROR("%s: cannot get module \"%s\"\n", __func__,
NET_BLUETOOTH_L2CAP_NAME);
return B_ERROR; return B_ERROR;
} // TODO: someone put it } // TODO: someone put it
src/add-ons/kernel/bluetooth/hci/bluetooth.cpp
+24 -27
View File
@@ -119,7 +119,7 @@ Assemble(bluetooth_device* bluetoothDevice, bt_packet_t type, void* data,
if (count >= bluetoothDevice->fExpectedPacketSize[type]) { if (count >= bluetoothDevice->fExpectedPacketSize[type]) {
// the whole packet is here so it can be already posted. // the whole packet is here so it can be already posted.
flowf("EVENT posted in HCI!!!\n"); ERROR("%s: EVENT posted in HCI!!!\n", __func__);
btCoreData->PostEvent(bluetoothDevice, data, btCoreData->PostEvent(bluetoothDevice, data,
bluetoothDevice->fExpectedPacketSize[type]); bluetoothDevice->fExpectedPacketSize[type]);
@@ -188,7 +188,7 @@ Assemble(bluetooth_device* bluetoothDevice, bt_packet_t type, void* data,
case BT_ACL: case BT_ACL:
// TODO: device descriptor has been fetched better not // TODO: device descriptor has been fetched better not
// pass id again // pass id again
flowf("ACL parsed in ACL!\n"); TRACE("%s: ACL parsed in ACL!\n", __func__);
AclAssembly(nbuf, bluetoothDevice->index); AclAssembly(nbuf, bluetoothDevice->index);
break; break;
default: default:
@@ -199,13 +199,11 @@ Assemble(bluetooth_device* bluetoothDevice, bt_packet_t type, void* data,
bluetoothDevice->fBuffersRx[type] = nbuf = NULL; bluetoothDevice->fBuffersRx[type] = nbuf = NULL;
bluetoothDevice->fExpectedPacketSize[type] = 0; bluetoothDevice->fExpectedPacketSize[type] = 0;
} else { } else {
#if DEBUG_ACL
if (type == BT_ACL) { if (type == BT_ACL) {
debugf("ACL Packet not filled size=%" B_PRIuSIZE TRACE("%s: ACL Packet not filled size %" B_PRIu32
" expected=%" B_PRIuSIZE "\n", nbuf->size, " expected=%" B_PRIuSIZE "\n", __func__, nbuf->size,
bluetoothDevice->fExpectedPacketSize[type]); bluetoothDevice->fExpectedPacketSize[type]);
} }
#endif
} }
} }
@@ -225,14 +223,15 @@ HciPacketHandler(void* data, int32 code, size_t size)
bluetooth_device* bluetoothDevice = FindDeviceByID(deviceId); bluetooth_device* bluetoothDevice = FindDeviceByID(deviceId);
debugf("to assemble %" B_PRIuSIZE " bytes of 0x%" B_PRIx32 "\n", size, TRACE("%s: to assemble %" B_PRIuSIZE " bytes of 0x%" B_PRIx32 "\n",
deviceId); __func__, size, deviceId);
if (bluetoothDevice != NULL) if (bluetoothDevice != NULL) {
return Assemble(bluetoothDevice, Bluetooth::CodeHandler::Protocol(code), return Assemble(bluetoothDevice, Bluetooth::CodeHandler::Protocol(code),
data, size); data, size);
else { } else {
debugf("Device 0x%" B_PRIx32 " could not be matched\n", deviceId); ERROR("%s: Device 0x%" B_PRIx32 " could not be matched\n", __func__,
deviceId);
} }
return B_ERROR; return B_ERROR;
@@ -267,12 +266,12 @@ RegisterDriver(bt_hci_transport_hooks* hooks, bluetooth_device** _device)
device->index = HCI_DEVICE_INDEX_OFFSET; // REVIEW: dev index device->index = HCI_DEVICE_INDEX_OFFSET; // REVIEW: dev index
else { else {
device->index = (sDeviceList.Tail())->index + 1; // REVIEW! device->index = (sDeviceList.Tail())->index + 1; // REVIEW!
flowf("List not empty\n"); TRACE("%s: List not empty\n", __func__);
} }
sDeviceList.Add(device); sDeviceList.Add(device);
debugf("Device %" B_PRIx32 "\n", device->index); TRACE("%s: Device %" B_PRIx32 "\n", __func__, device->index);
*_device = device; *_device = device;
@@ -315,13 +314,13 @@ PostACL(hci_id hciId, net_buffer* buffer)
bluetooth_device* device = FindDeviceByID(hciId); bluetooth_device* device = FindDeviceByID(hciId);
if (device == NULL) { if (device == NULL) {
debugf("No device 0x%" B_PRIx32 "\n", hciId); ERROR("%s: No device 0x%" B_PRIx32 "\n", __func__, hciId);
return B_ERROR; return B_ERROR;
} }
debugf("index 0x%" B_PRIx32 " try to send bt packet of %" B_PRIu32 TRACE("%s: index 0x%" B_PRIx32 " try to send bt packet of %" B_PRIu32
" bytes (flags 0x%" B_PRIx32 "):\n", device->index, buffer->size, " bytes (flags 0x%" B_PRIx32 "):\n", __func__, device->index,
buffer->flags); buffer->size, buffer->flags);
// TODO: ATOMIC! any other thread should stop here // TODO: ATOMIC! any other thread should stop here
do { do {
@@ -350,7 +349,7 @@ PostACL(hci_id hciId, net_buffer* buffer)
// Send to driver // Send to driver
curr_frame->protocol = BT_ACL; curr_frame->protocol = BT_ACL;
debugf("Tolower nbuf %p!\n", curr_frame); TRACE("%s: Tolower nbuf %p!\n", __func__, curr_frame);
// We could pass a cookie and avoid the driver fetch the Id // We could pass a cookie and avoid the driver fetch the Id
device->hooks->SendACL(device->index, curr_frame); device->hooks->SendACL(device->index, curr_frame);
flag = HCI_ACL_PACKET_FRAGMENT; flag = HCI_ACL_PACKET_FRAGMENT;
@@ -396,9 +395,6 @@ dump_bluetooth_devices(int argc, char** argv)
static status_t static status_t
bluetooth_std_ops(int32 op, ...) bluetooth_std_ops(int32 op, ...)
{ {
flowf("\n");
switch (op) { switch (op) {
case B_MODULE_INIT: case B_MODULE_INIT:
{ {
@@ -412,9 +408,10 @@ bluetooth_std_ops(int32 op, ...)
return status; return status;
} }
status = get_module(BT_CORE_DATA_MODULE_NAME,(module_info**)&btCoreData); status = get_module(BT_CORE_DATA_MODULE_NAME,
(module_info**)&btCoreData);
if (status < B_OK) { if (status < B_OK) {
flowf("problem getting datacore\n"); ERROR("%s: problem getting bt core data module\n", __func__);
return status; return status;
} }
@@ -425,23 +422,23 @@ bluetooth_std_ops(int32 op, ...)
(BluetoothRawDataPort::port_listener_func)&HciPacketHandler); (BluetoothRawDataPort::port_listener_func)&HciPacketHandler);
if (BluetoothRXPort->Launch() != B_OK) { if (BluetoothRXPort->Launch() != B_OK) {
flowf("RX thread creation failed!\n"); ERROR("%s: RX thread creation failed!\n", __func__);
// we Cannot do much here ... avoid registering // we Cannot do much here ... avoid registering
} else { } else {
flowf("RX thread launched!\n"); TRACE("%s: RX thread launched!\n", __func__);
} }
sLinkChangeSemaphore = create_sem(0, "bt sem"); sLinkChangeSemaphore = create_sem(0, "bt sem");
if (sLinkChangeSemaphore < B_OK) { if (sLinkChangeSemaphore < B_OK) {
put_module(NET_STACK_MODULE_NAME); put_module(NET_STACK_MODULE_NAME);
flowf("sem failed\n"); ERROR("%s: Link change semaphore failed\n", __func__);
return sLinkChangeSemaphore; return sLinkChangeSemaphore;
} }
mutex_init(&sListLock, "bluetooth devices"); mutex_init(&sListLock, "bluetooth devices");
// status = InitializeAclConnectionThread(); // status = InitializeAclConnectionThread();
debugf("%s: Connection Thread error\n", __func__); ERROR("%s: Connection Thread error\n", __func__);
add_debugger_command("btLocalDevices", &dump_bluetooth_devices, add_debugger_command("btLocalDevices", &dump_bluetooth_devices,
"Lists Bluetooth LocalDevices registered in the Stack"); "Lists Bluetooth LocalDevices registered in the Stack");
src/add-ons/kernel/drivers/bluetooth/h2/h2generic/h2generic.cpp
+87 -102
View File
@@ -29,6 +29,7 @@
#include "h2cfg.h" #include "h2cfg.h"
int32 api_version = B_CUR_DRIVER_API_VERSION; int32 api_version = B_CUR_DRIVER_API_VERSION;
// Modules // Modules
@@ -83,22 +84,22 @@ spawn_device(usb_device* usb_dev)
#endif #endif
{ {
CALLED();
int32 i; int32 i;
status_t err = B_OK; status_t err = B_OK;
bt_usb_dev* new_bt_dev = NULL; bt_usb_dev* new_bt_dev = NULL;
flowf("add_device()\n");
// 16 usb dongles... // 16 usb dongles...
if (dev_count >= MAX_BT_GENERIC_USB_DEVICES) { if (dev_count >= MAX_BT_GENERIC_USB_DEVICES) {
flowf("device table full\n"); ERROR("%s: Device table full\n", __func__);
goto exit; goto exit;
} }
// try the allocation // try the allocation
new_bt_dev = (bt_usb_dev*)malloc(sizeof(bt_usb_dev)); new_bt_dev = (bt_usb_dev*)malloc(sizeof(bt_usb_dev));
if (new_bt_dev == NULL) { if (new_bt_dev == NULL) {
flowf("no memory\n"); ERROR("%s: Unable to malloc new bt device\n", __func__);
goto exit; goto exit;
} }
memset(new_bt_dev, 0, sizeof(bt_usb_dev)); memset(new_bt_dev, 0, sizeof(bt_usb_dev));
@@ -126,8 +127,8 @@ spawn_device(usb_device* usb_dev)
sprintf(new_bt_dev->name, "%s/%" B_PRId32, sprintf(new_bt_dev->name, "%s/%" B_PRId32,
BLUETOOTH_DEVICE_PATH, i); BLUETOOTH_DEVICE_PATH, i);
new_bt_dev->num = i; new_bt_dev->num = i;
debugf("added device %p %" B_PRId32 " %s\n", bt_usb_devices[i], TRACE("%s: added device %p %" B_PRId32 " %s\n", __func__,
new_bt_dev->num, new_bt_dev->name); bt_usb_devices[i], new_bt_dev->num, new_bt_dev->name);
break; break;
} }
} }
@@ -135,7 +136,7 @@ spawn_device(usb_device* usb_dev)
// In the case we cannot us // In the case we cannot us
if (bt_usb_devices[i] != new_bt_dev) { if (bt_usb_devices[i] != new_bt_dev) {
flowf("Device could not be added\n"); ERROR("%s: Device could not be added\n", __func__);
goto bail2; goto bail2;
} }
@@ -162,7 +163,7 @@ static void
kill_device(bt_usb_dev* bdev) kill_device(bt_usb_dev* bdev)
{ {
if (bdev != NULL) { if (bdev != NULL) {
debugf("(%p)\n", bdev); TRACE("%s: (%p)\n", __func__, bdev);
delete_sem(bdev->lock); delete_sem(bdev->lock);
delete_sem(bdev->cmd_complete); delete_sem(bdev->cmd_complete);
@@ -181,7 +182,7 @@ fetch_device(bt_usb_dev* dev, hci_id hid)
{ {
int i; int i;
// debugf("(%p) or %d\n", dev, hid); // TRACE("%s: (%p) or %d\n", __func__, dev, hid);
acquire_sem(dev_table_sem); acquire_sem(dev_table_sem);
if (dev != NULL) { if (dev != NULL) {
@@ -228,10 +229,10 @@ device_added(usb_device* dev, void** cookie)
bt_usb_dev* new_bt_dev = spawn_device(dev); bt_usb_dev* new_bt_dev = spawn_device(dev);
int e; int e;
debugf("device_added(%p)\n", new_bt_dev); TRACE("%s: device_added(%p)\n", __func__, new_bt_dev);
if (new_bt_dev == NULL) { if (new_bt_dev == NULL) {
flowf("Couldn't allocate device record.\n"); ERROR("%s: Couldn't allocate device record.\n", __func__);
err = ENOMEM; err = ENOMEM;
goto bail_no_mem; goto bail_no_mem;
} }
@@ -240,12 +241,12 @@ device_added(usb_device* dev, void** cookie)
config = usb->get_nth_configuration(dev, 0); config = usb->get_nth_configuration(dev, 0);
// dump_usb_configuration_info(config); // dump_usb_configuration_info(config);
if (config == NULL) { if (config == NULL) {
flowf("couldn't get default config.\n"); ERROR("%s: Couldn't get default USB config.\n", __func__);
err = B_ERROR; err = B_ERROR;
goto bail; goto bail;
} }
debugf("found %" B_PRIuSIZE " alt interfaces.\n", TRACE("%s: found %" B_PRIuSIZE " alt interfaces.\n", __func__,
config->interface->alt_count); config->interface->alt_count);
// set first interface // set first interface
@@ -253,14 +254,14 @@ device_added(usb_device* dev, void** cookie)
err = usb->set_alt_interface(new_bt_dev->dev, interface); err = usb->set_alt_interface(new_bt_dev->dev, interface);
if (err != B_OK) { if (err != B_OK) {
debugf("%s: set_alt_interface() error.\n", __func__); ERROR("%s: set_alt_interface() error.\n", __func__);
goto bail; goto bail;
} }
// call set_configuration() only after calling set_alt_interface() // call set_configuration() only after calling set_alt_interface()
err = usb->set_configuration(dev, config); err = usb->set_configuration(dev, config);
if (err != B_OK) { if (err != B_OK) {
debugf("%s: set_configuration() error.\n", __func__); ERROR("%s: set_configuration() error.\n", __func__);
goto bail; goto bail;
} }
@@ -290,13 +291,13 @@ device_added(usb_device* dev, void** cookie)
// security check // security check
if (config->interface->active->descr->interface_number > 0) { if (config->interface->active->descr->interface_number > 0) {
debugf("Strange condition happened %d\n", ERROR("%s: Strange condition happened %d\n", __func__,
config->interface->active->descr->interface_number); config->interface->active->descr->interface_number);
err = B_ERROR; err = B_ERROR;
goto bail; goto bail;
} }
debugf("Found %" B_PRIuSIZE " interfaces. Expected 3\n", TRACE("%s: Found %" B_PRIuSIZE " interfaces. Expected 3\n", __func__,
config->interface_count); config->interface_count);
// Find endpoints that we need // Find endpoints that we need
@@ -309,22 +310,25 @@ device_added(usb_device* dev, void** cookie)
if (ep->descr->endpoint_address & USB_ENDPOINT_ADDR_DIR_IN) if (ep->descr->endpoint_address & USB_ENDPOINT_ADDR_DIR_IN)
{ {
new_bt_dev->intr_in_ep = ep; new_bt_dev->intr_in_ep = ep;
new_bt_dev->max_packet_size_intr_in = ep->descr->max_packet_size; new_bt_dev->max_packet_size_intr_in
flowf("INT in\n"); = ep->descr->max_packet_size;
TRACE("%s: INT in\n", __func__);
} else { } else {
flowf("INT out\n"); TRACE("%s: INT out\n", __func__);
} }
break; break;
case USB_ENDPOINT_ATTR_BULK: case USB_ENDPOINT_ATTR_BULK:
if (ep->descr->endpoint_address & USB_ENDPOINT_ADDR_DIR_IN) { if (ep->descr->endpoint_address & USB_ENDPOINT_ADDR_DIR_IN) {
new_bt_dev->bulk_in_ep = ep; new_bt_dev->bulk_in_ep = ep;
new_bt_dev->max_packet_size_bulk_in = ep->descr->max_packet_size; new_bt_dev->max_packet_size_bulk_in
flowf("BULK int\n"); = ep->descr->max_packet_size;
TRACE("%s: BULK int\n", __func__);
} else { } else {
new_bt_dev->bulk_out_ep = ep; new_bt_dev->bulk_out_ep = ep;
new_bt_dev->max_packet_size_bulk_out = ep->descr->max_packet_size; new_bt_dev->max_packet_size_bulk_out
flowf("BULK out\n"); = ep->descr->max_packet_size;
TRACE("%s: BULK out\n", __func__);
} }
break; break;
} }
@@ -332,7 +336,7 @@ device_added(usb_device* dev, void** cookie)
if (!new_bt_dev->bulk_in_ep || !new_bt_dev->bulk_out_ep if (!new_bt_dev->bulk_in_ep || !new_bt_dev->bulk_out_ep
|| !new_bt_dev->intr_in_ep) { || !new_bt_dev->intr_in_ep) {
flowf("Minimal # endpoints for BT not found\n"); ERROR("%s: Minimal # endpoints for BT not found\n", __func__);
goto bail; goto bail;
} }
@@ -347,7 +351,7 @@ device_added(usb_device* dev, void** cookie)
// set the cookie that will be passed to other USB // set the cookie that will be passed to other USB
// hook functions (currently device_removed() is the only other) // hook functions (currently device_removed() is the only other)
*cookie = new_bt_dev; *cookie = new_bt_dev;
debugf("Ok %p\n", new_bt_dev); TRACE("%s: Ok %p\n", __func__, new_bt_dev);
return B_OK; return B_OK;
bail: bail:
@@ -365,31 +369,23 @@ device_removed(void* cookie)
{ {
bt_usb_dev* bdev = fetch_device((bt_usb_dev*)cookie, 0); bt_usb_dev* bdev = fetch_device((bt_usb_dev*)cookie, 0);
debugf("device_removed(%p)\n", bdev); TRACE("%s: device_removed(%p)\n", __func__, bdev);
if (bdev == NULL) { if (bdev == NULL) {
flowf(" not present in driver?\n"); ERROR("%s: Device not present in driver.\n", __func__);
return B_ERROR; return B_ERROR;
} }
if (!TEST_AND_CLEAR(&bdev->state, RUNNING)) if (!TEST_AND_CLEAR(&bdev->state, RUNNING))
flowf("wasnt running?\n"); ERROR("%s: wasnt running?\n", __func__);
flowf("Cancelling queues...\n"); TRACE("%s: Cancelling queues...\n", __func__);
if (bdev->intr_in_ep != NULL) { if (bdev->intr_in_ep != NULL)
usb->cancel_queued_transfers(bdev->intr_in_ep->handle); usb->cancel_queued_transfers(bdev->intr_in_ep->handle);
flowf("Cancelling possible EVENTS\n"); if (bdev->bulk_in_ep != NULL)
}
if (bdev->bulk_in_ep!=NULL) {
usb->cancel_queued_transfers(bdev->bulk_in_ep->handle); usb->cancel_queued_transfers(bdev->bulk_in_ep->handle);
flowf("Cancelling possible ACL in\n"); if (bdev->bulk_out_ep != NULL)
}
if (bdev->bulk_out_ep!=NULL) {
usb->cancel_queued_transfers(bdev->bulk_out_ep->handle); usb->cancel_queued_transfers(bdev->bulk_out_ep->handle);
flowf("Cancelling possible ACL out\n");
}
bdev->connected = false; bdev->connected = false;
@@ -423,7 +419,8 @@ submit_nbuffer(hci_id hid, net_buffer* nbuf)
bdev = fetch_device(NULL, hid); bdev = fetch_device(NULL, hid);
debugf("index=%" B_PRId32 " nbuf=%p bdev=%p\n", hid, nbuf, bdev); TRACE("%s: index=%" B_PRId32 " nbuf=%p bdev=%p\n", __func__, hid,
nbuf, bdev);
if (bdev != NULL) { if (bdev != NULL) {
switch (nbuf->protocol) { switch (nbuf->protocol) {
@@ -451,13 +448,13 @@ submit_nbuffer(hci_id hid, net_buffer* nbuf)
static status_t static status_t
device_open(const char* name, uint32 flags, void **cookie) device_open(const char* name, uint32 flags, void **cookie)
{ {
CALLED();
status_t err = ENODEV; status_t err = ENODEV;
bt_usb_dev* bdev = NULL; bt_usb_dev* bdev = NULL;
hci_id hdev; hci_id hdev;
int i; int i;
flowf("device_open()\n");
acquire_sem(dev_table_sem); acquire_sem(dev_table_sem);
for (i = 0; i < MAX_BT_GENERIC_USB_DEVICES; i++) { for (i = 0; i < MAX_BT_GENERIC_USB_DEVICES; i++) {
if (bt_usb_devices[i] && !strcmp(name, bt_usb_devices[i]->name)) { if (bt_usb_devices[i] && !strcmp(name, bt_usb_devices[i]->name)) {
@@ -468,14 +465,14 @@ device_open(const char* name, uint32 flags, void **cookie)
release_sem_etc(dev_table_sem, 1, B_DO_NOT_RESCHEDULE); release_sem_etc(dev_table_sem, 1, B_DO_NOT_RESCHEDULE);
if (bdev == NULL) { if (bdev == NULL) {
flowf("Device not found in the open list!"); ERROR("%s: Device not found in the open list!", __func__);
*cookie = NULL; *cookie = NULL;
return B_ERROR; return B_ERROR;
} }
// Set RUNNING // Set RUNNING
if (TEST_AND_SET(&bdev->state, RUNNING)) { if (TEST_AND_SET(&bdev->state, RUNNING)) {
flowf("dev already running! - reOpened device!\n"); ERROR("%s: dev already running! - reOpened device!\n", __func__);
return B_ERROR; return B_ERROR;
} }
@@ -509,9 +506,9 @@ device_open(const char* name, uint32 flags, void **cookie)
bdev->hdev = hdev = ndev->index; // Get the index bdev->hdev = hdev = ndev->index; // Get the index
bdev->ndev = ndev; // Get the net_device bdev->ndev = ndev; // Get the net_device
} else { } else {
hdev = bdev->num; // XXX: Lets try to go on hdev = bdev->num; // XXX: Lets try to go on
} }
} else { } else {
hdev = bdev->num; // XXX: Lets try to go on hdev = bdev->num; // XXX: Lets try to go on
} }
@@ -521,7 +518,6 @@ device_open(const char* name, uint32 flags, void **cookie)
*cookie = bdev; *cookie = bdev;
release_sem(bdev->lock); release_sem(bdev->lock);
flowf(" successful\n");
return B_OK; return B_OK;
} }
@@ -533,6 +529,8 @@ device_open(const char* name, uint32 flags, void **cookie)
static status_t static status_t
device_close(void* cookie) device_close(void* cookie)
{ {
CALLED();
int32 i; int32 i;
void* item; void* item;
bt_usb_dev* bdev = (bt_usb_dev*)cookie; bt_usb_dev* bdev = (bt_usb_dev*)cookie;
@@ -540,26 +538,19 @@ device_close(void* cookie)
if (bdev == NULL) if (bdev == NULL)
panic("bad cookie"); panic("bad cookie");
debugf("%s: device_close() called\n", __func__);
// Clean queues // Clean queues
if (bdev->connected == true) { if (bdev->connected == true) {
flowf("Cancelling queues...\n"); TRACE("%s: Cancelling queues...\n", __func__);
if (bdev->intr_in_ep != NULL) {
if (bdev->intr_in_ep != NULL)
usb->cancel_queued_transfers(bdev->intr_in_ep->handle); usb->cancel_queued_transfers(bdev->intr_in_ep->handle);
flowf("Cancelling possible EVENTS\n");
}
if (bdev->bulk_in_ep!=NULL) { if (bdev->bulk_in_ep!=NULL)
usb->cancel_queued_transfers(bdev->bulk_in_ep->handle); usb->cancel_queued_transfers(bdev->bulk_in_ep->handle);
flowf("Cancelling possible ACL in\n");
}
if (bdev->bulk_out_ep!=NULL) { if (bdev->bulk_out_ep!=NULL)
usb->cancel_queued_transfers(bdev->bulk_out_ep->handle); usb->cancel_queued_transfers(bdev->bulk_out_ep->handle);
flowf("Cancelling possible ACL out\n");
}
} }
// TX // TX
@@ -587,7 +578,7 @@ device_close(void* cookie)
// unSet RUNNING // unSet RUNNING
if (TEST_AND_CLEAR(&bdev->state, RUNNING)) { if (TEST_AND_CLEAR(&bdev->state, RUNNING)) {
debugf(" %s not running?\n", bdev->name); ERROR("%s: %s not running?\n", __func__, bdev->name);
return B_ERROR; return B_ERROR;
} }
@@ -599,15 +590,13 @@ device_close(void* cookie)
static status_t static status_t
device_free(void* cookie) device_free(void* cookie)
{ {
CALLED();
status_t err = B_OK; status_t err = B_OK;
bt_usb_dev* bdev = (bt_usb_dev*)cookie; bt_usb_dev* bdev = (bt_usb_dev*)cookie;
debugf("device_free() called on %s \n", BLUETOOTH_DEVICE_PATH); if (!bdev->connected)
if (!bdev->connected) {
flowf("Device not present can be killed\n");
kill_device(bdev); kill_device(bdev);
}
return err; return err;
} }
@@ -625,15 +614,16 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
#endif #endif
TOUCH(size); TOUCH(size);
debugf("ioctl() opcode %" B_PRId32 " size %" B_PRIuSIZE ".\n", msg, size); TRACE("%s: ioctl() opcode %" B_PRId32 " size %" B_PRIuSIZE ".\n", __func__,
msg, size);
if (bdev == NULL) { if (bdev == NULL) {
flowf("Bad cookie\n"); TRACE("%s: Bad cookie\n", __func__);
return B_BAD_VALUE; return B_BAD_VALUE;
} }
if (params == NULL) { if (params == NULL) {
flowf("Invalid pointer control\n"); TRACE("%s: Invalid pointer control\n", __func__);
return B_BAD_VALUE; return B_BAD_VALUE;
} }
@@ -643,7 +633,7 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
case ISSUE_BT_COMMAND: case ISSUE_BT_COMMAND:
#ifdef BT_IOCTLS_PASS_SIZE #ifdef BT_IOCTLS_PASS_SIZE
if (size == 0) { if (size == 0) {
flowf("Invalid size control\n"); TRACE("%s: Invalid size control\n", __func__);
err = B_BAD_VALUE; err = B_BAD_VALUE;
break; break;
} }
@@ -658,7 +648,7 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
snb_put(snbuf, params, size); snb_put(snbuf, params, size);
err = submit_tx_command(bdev, snbuf); err = submit_tx_command(bdev, snbuf);
debugf("%s: command launched\n", __func__); TRACE("%s: command launched\n", __func__);
break; break;
case BT_UP: case BT_UP:
@@ -667,7 +657,7 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
err = submit_rx_event(bdev); err = submit_rx_event(bdev);
if (err != B_OK) { if (err != B_OK) {
bdev->state = CLEAR_BIT(bdev->state, ANCILLYANT); bdev->state = CLEAR_BIT(bdev->state, ANCILLYANT);
flowf("Queuing failed device stops running\n"); ERROR("%s: Queuing failed device stops running\n", __func__);
break; break;
} }
@@ -677,7 +667,8 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
if (err != B_OK && i == 0) { if (err != B_OK && i == 0) {
bdev->state = CLEAR_BIT(bdev->state, ANCILLYANT); bdev->state = CLEAR_BIT(bdev->state, ANCILLYANT);
// Set the flaq in the HCI world // Set the flaq in the HCI world
flowf("Queuing failed device stops running\n"); ERROR("%s: Queuing failed device stops running\n",
__func__);
break; break;
} }
} }
@@ -688,7 +679,8 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
#if BT_DRIVER_SUPPORTS_SCO #if BT_DRIVER_SUPPORTS_SCO
// TODO: SCO / eSCO // TODO: SCO / eSCO
#endif #endif
flowf("device launched\n");
ERROR("%s: Device online\n", __func__);
break; break;
case GET_STATS: case GET_STATS:
@@ -703,7 +695,7 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
default: default:
debugf("%s: Invalid opcode.\n", __func__); ERROR("%s: Invalid opcode.\n", __func__);
err = B_DEV_INVALID_IOCTL; err = B_DEV_INVALID_IOCTL;
break; break;
} }
@@ -717,7 +709,7 @@ device_control(void* cookie, uint32 msg, void* params, size_t size)
static status_t static status_t
device_read(void* cookie, off_t pos, void* buffer, size_t* count) device_read(void* cookie, off_t pos, void* buffer, size_t* count)
{ {
debugf("Reading... count = %" B_PRIuSIZE "\n", *count); TRACE("%s: Reading... count = %" B_PRIuSIZE "\n", __func__, *count);
*count = 0; *count = 0;
return B_OK; return B_OK;
@@ -728,7 +720,7 @@ device_read(void* cookie, off_t pos, void* buffer, size_t* count)
static status_t static status_t
device_write(void* cookie, off_t pos, const void* buffer, size_t* count) device_write(void* cookie, off_t pos, const void* buffer, size_t* count)
{ {
flowf("device_write()\n"); CALLED();
return B_ERROR; return B_ERROR;
} }
@@ -768,48 +760,42 @@ dump_driver(int argc, char** argv)
status_t status_t
init_driver(void) init_driver(void)
{ {
CALLED();
int j; int j;
flowf("init_driver()\n");
if (get_module(BT_CORE_DATA_MODULE_NAME, if (get_module(BT_CORE_DATA_MODULE_NAME,
(module_info**)&btCoreData) != B_OK) { (module_info**)&btCoreData) != B_OK) {
debugf("cannot get module \"%s\"\n", BT_CORE_DATA_MODULE_NAME); ERROR("%s: cannot get module '%s'\n", __func__,
BT_CORE_DATA_MODULE_NAME);
return B_ERROR; return B_ERROR;
} else }
debugf("btCoreData module at %p\n", btCoreData);
// BT devices MODULE INITS // BT devices MODULE INITS
if (get_module(btDevices_name, (module_info**)&btDevices) != B_OK) { if (get_module(btDevices_name, (module_info**)&btDevices) != B_OK) {
debugf("cannot get module \"%s\"\n", btDevices_name); ERROR("%s: cannot get module '%s'\n", __func__, btDevices_name);
goto err_release3; goto err_release3;
} else }
debugf("btDevices module at %p\n", btDevices);
// HCI MODULE INITS // HCI MODULE INITS
if (get_module(hci_name, (module_info**)&hci) != B_OK) { if (get_module(hci_name, (module_info**)&hci) != B_OK) {
debugf("cannot get module \"%s\"\n", hci_name); ERROR("%s: cannot get module '%s'\n", __func__, hci_name);
#ifndef BT_SURVIVE_WITHOUT_HCI #ifndef BT_SURVIVE_WITHOUT_HCI
goto err_release2; goto err_release2;
#endif #endif
} else {
debugf("hci module at %p\n", hci);
} }
// USB MODULE INITS // USB MODULE INITS
if (get_module(usb_name, (module_info**)&usb) != B_OK) { if (get_module(usb_name, (module_info**)&usb) != B_OK) {
debugf("cannot get module \"%s\"\n", usb_name); ERROR("%s: cannot get module '%s'\n", __func__, usb_name);
goto err_release1; goto err_release1;
} else {
debugf("usb module at %p\n", usb);
} }
if (get_module(NET_BUFFER_MODULE_NAME, (module_info**)&nb) != B_OK) { if (get_module(NET_BUFFER_MODULE_NAME, (module_info**)&nb) != B_OK) {
debugf("cannot get module \"%s\"\n", NET_BUFFER_MODULE_NAME); ERROR("%s: cannot get module '%s'\n", __func__,
NET_BUFFER_MODULE_NAME);
#ifndef BT_SURVIVE_WITHOUT_NET_BUFFERS #ifndef BT_SURVIVE_WITHOUT_NET_BUFFERS
goto err_release; goto err_release;
#endif #endif
} else {
debugf("nb module at %p\n", nb);
} }
// GENERAL INITS // GENERAL INITS
@@ -852,9 +838,9 @@ err_release3:
void void
uninit_driver(void) uninit_driver(void)
{ {
int32 j; CALLED();
flowf("uninit_driver()\n"); int32 j;
for (j = 0; j < MAX_BT_GENERIC_USB_DEVICES; j++) { for (j = 0; j < MAX_BT_GENERIC_USB_DEVICES; j++) {
@@ -865,7 +851,7 @@ uninit_driver(void)
// if (connected_dev != NULL) { // if (connected_dev != NULL) {
// debugf("Device %p still exists.\n", connected_dev); // debugf("Device %p still exists.\n", connected_dev);
// } // }
debugf("%s still present?\n", bt_usb_devices[j]->name); ERROR("%s: %s still present?\n", __func__, bt_usb_devices[j]->name);
kill_device(bt_usb_devices[j]); kill_device(bt_usb_devices[j]);
} }
} }
@@ -886,13 +872,12 @@ uninit_driver(void)
const char** const char**
publish_devices(void) publish_devices(void)
{ {
CALLED();
int32 j; int32 j;
int32 i = 0; int32 i = 0;
char* str; char* str;
flowf("publish_devices()\n");
for (j = 0; j < MAX_BT_GENERIC_USB_DEVICES; j++) { for (j = 0; j < MAX_BT_GENERIC_USB_DEVICES; j++) {
if (publish_names[j]) { if (publish_names[j]) {
free(publish_names[j]); free(publish_names[j]);
@@ -906,14 +891,14 @@ publish_devices(void)
str = strdup(bt_usb_devices[j]->name); str = strdup(bt_usb_devices[j]->name);
if (str) { if (str) {
publish_names[i++] = str; publish_names[i++] = str;
debugf("publishing %s\n", bt_usb_devices[j]->name); TRACE("%s: publishing %s\n", __func__, bt_usb_devices[j]->name);
} }
} }
} }
release_sem_etc(dev_table_sem, 1, B_DO_NOT_RESCHEDULE); release_sem_etc(dev_table_sem, 1, B_DO_NOT_RESCHEDULE);
publish_names[i] = NULL; publish_names[i] = NULL;
debugf("published %" B_PRId32 " devices\n", i); TRACE("%s: published %" B_PRId32 " devices\n", __func__, i);
// TODO: this method might make better memory use // TODO: this method might make better memory use
// dev_names = (char**)malloc(sizeof(char*) * (dev_count + 1)); // dev_names = (char**)malloc(sizeof(char*) * (dev_count + 1));
@@ -947,7 +932,7 @@ static device_hooks hooks = {
device_hooks* device_hooks*
find_device(const char* name) find_device(const char* name)
{ {
debugf("find_device(%s)\n", name); CALLED();
return &hooks; return &hooks;
} }
src/add-ons/kernel/drivers/bluetooth/h2/h2generic/h2generic.h
+20 -1
View File
@@ -4,7 +4,6 @@
* All rights reserved. Distributed under the terms of the MIT License. * All rights reserved. Distributed under the terms of the MIT License.
* *
*/ */
#ifndef _H2GENERIC_H_ #ifndef _H2GENERIC_H_
#define _H2GENERIC_H_ #define _H2GENERIC_H_
@@ -39,6 +38,7 @@
#define USB_TYPE_CLASS (0x01 << 5) /// Check if it is in some other header #define USB_TYPE_CLASS (0x01 << 5) /// Check if it is in some other header
#define USB_TYPE_VENDOR (0x02 << 5) #define USB_TYPE_VENDOR (0x02 << 5)
#define TOUCH(x) ((void)(x))
// Expecting nobody is gonna have 16 USB-BT dongles connected in their system // Expecting nobody is gonna have 16 USB-BT dongles connected in their system
#define MAX_BT_GENERIC_USB_DEVICES 16 #define MAX_BT_GENERIC_USB_DEVICES 16
@@ -118,4 +118,23 @@ struct bt_usb_dev {
bt_usb_dev* fetch_device(bt_usb_dev* dev, hci_id hid); bt_usb_dev* fetch_device(bt_usb_dev* dev, hci_id hid);
static inline uint32
TEST_AND_SET(uint32 *byte, uint32 bit_mask)
{
uint32 val = (*byte&bit_mask)!=0;
*byte |= bit_mask;
return val;
}
static inline uint32
TEST_AND_CLEAR(uint32* byte, uint32 bit_mask)
{
uint32 val = (*byte&bit_mask)!=0;
*byte &= ~bit_mask;
return val;
}
#endif #endif
src/add-ons/kernel/drivers/bluetooth/h2/h2generic/h2transactions.cpp
+9 -7
View File
@@ -63,7 +63,7 @@ event_complete(void* cookie, status_t status, void* data, size_t actual_len)
// bt_usb_dev* bdev = fetch_device(cookie, 0); -> safer / slower option // bt_usb_dev* bdev = fetch_device(cookie, 0); -> safer / slower option
status_t error; status_t error;
debugf("cookie@%p status=%s len=%" B_PRIuSIZE "\n", cookie, TRACE("%s: cookie@%p status=%s len=%" B_PRIuSIZE "\n", __func__, cookie,
strerror(status), actual_len); strerror(status), actual_len);
if (bdev == NULL) if (bdev == NULL)
@@ -84,12 +84,14 @@ event_complete(void* cookie, status_t status, void* data, size_t actual_len)
resubmit: resubmit:
error = usb->queue_interrupt(bdev->intr_in_ep->handle, data, error = usb->queue_interrupt(bdev->intr_in_ep->handle, data,
max_c(HCI_MAX_EVENT_SIZE, bdev->max_packet_size_intr_in), event_complete, bdev); max_c(HCI_MAX_EVENT_SIZE, bdev->max_packet_size_intr_in),
event_complete, bdev);
if (error != B_OK) { if (error != B_OK) {
reuse_room(&bdev->eventRoom, data); reuse_room(&bdev->eventRoom, data);
bdev->stat.rejectedRX++; bdev->stat.rejectedRX++;
debugf("RX event resubmittion failed %s\n", strerror(error)); ERROR("%s: RX event resubmittion failed %s\n", __func__,
strerror(error));
} else { } else {
bdev->stat.acceptedRX++; bdev->stat.acceptedRX++;
} }
@@ -131,7 +133,7 @@ resubmit:
if (error != B_OK) { if (error != B_OK) {
reuse_room(&bdev->aclRoom, data); reuse_room(&bdev->aclRoom, data);
bdev->stat.rejectedRX++; bdev->stat.rejectedRX++;
debugf("RX acl resubmittion failed %s\n", strerror(error)); ERROR("%s: RX acl resubmittion failed %s\n", __func__, strerror(error));
} else { } else {
bdev->stat.acceptedRX++; bdev->stat.acceptedRX++;
} }
@@ -160,7 +162,7 @@ submit_rx_event(bt_usb_dev* bdev)
bdev->stat.rejectedRX++; bdev->stat.rejectedRX++;
} else { } else {
bdev->stat.acceptedRX++; bdev->stat.acceptedRX++;
debugf("Accepted RX Event %d\n", bdev->stat.acceptedRX); TRACE("%s: Accepted RX Event %d\n", __func__, bdev->stat.acceptedRX);
} }
return status; return status;
@@ -213,7 +215,7 @@ command_complete(void* cookie, status_t status, void* data, size_t actual_len)
snet_buffer* snbuf = (snet_buffer*)cookie; snet_buffer* snbuf = (snet_buffer*)cookie;
bt_usb_dev* bdev = (bt_usb_dev*)snb_cookie(snbuf); bt_usb_dev* bdev = (bt_usb_dev*)snb_cookie(snbuf);
debugf("len = %" B_PRIuSIZE " @%p\n", actual_len, data); TRACE("%s: len = %" B_PRIuSIZE " @%p\n", __func__, actual_len, data);
if (status == B_OK) { if (status == B_OK) {
bdev->stat.successfulTX++; bdev->stat.successfulTX++;
@@ -281,7 +283,7 @@ submit_tx_command(bt_usb_dev* bdev, snet_buffer* snbuf)
// set cookie // set cookie
snb_set_cookie(snbuf, bdev); snb_set_cookie(snbuf, bdev);
debugf("@%p\n", snb_get(snbuf)); TRACE("%s: @%p\n", __func__, snb_get(snbuf));
error = usb->queue_request(bdev->dev, bRequestType, bRequest, error = usb->queue_request(bdev->dev, bRequestType, bRequest,
value, wIndex, wLength, snb_get(snbuf), value, wIndex, wLength, snb_get(snbuf),
src/add-ons/kernel/drivers/bluetooth/h2/h2generic/h2upper.cpp
+10 -9
View File
@@ -27,7 +27,7 @@ sched_tx_processing(bt_usb_dev* bdev)
snet_buffer* snbuf; snet_buffer* snbuf;
status_t err; status_t err;
debugf("(%p)\n", bdev) TRACE("%s: (%p)\n", __func__, bdev);
if (!TEST_AND_SET(&bdev->state, PROCESSING)) { if (!TEST_AND_SET(&bdev->state, PROCESSING)) {
// We are not processing in another thread so... START!! // We are not processing in another thread so... START!!
@@ -106,7 +106,7 @@ post_packet_up(bt_usb_dev* bdev, bt_packet_t type, void* buf)
net_buffer* nbuf = (net_buffer*) buf; net_buffer* nbuf = (net_buffer*) buf;
// No need to free the buffer at allocation is gonna be reused // No need to free the buffer at allocation is gonna be reused
btDevices->receive_data(bdev->ndev, &nbuf); btDevices->receive_data(bdev->ndev, &nbuf);
flowf("to net_device\n"); TRACE("to net_device\n");
} }
return err; return err;
@@ -134,23 +134,24 @@ send_packet(hci_id hid, bt_packet_t type, net_buffer* nbuf)
case BT_COMMAND: case BT_COMMAND:
case BT_ACL: case BT_ACL:
case BT_SCO: case BT_SCO:
list_add_item(&bdev->nbuffersTx[type],nbuf); list_add_item(&bdev->nbuffersTx[type], nbuf);
bdev->nbuffersPendingTx[type]++; bdev->nbuffersPendingTx[type]++;
break; break;
default: default:
debugf("Unknown packet type for sending %d\n",type); ERROR("%s: Unknown packet type for sending %d\n", __func__,
type);
// TODO: free the net_buffer -> no, allow upper layer // TODO: free the net_buffer -> no, allow upper layer
// handle it with the given error // handle it with the given error
err = B_BAD_VALUE; err = B_BAD_VALUE;
break; break;
} }
} else { } else {
flowf("tx sched provoked"); TRACE("%s: tx sched provoked", __func__);
} }
// TODO: check if device is actually ready for this // TODO: check if device is actually ready for this
// TODO: unlock device // TODO: unlock device
// sched in any case even if nbuf is null (provoke re-scheduling) // sched in any case even if nbuf is null (provoke re-scheduling)
sched_tx_processing(bdev); sched_tx_processing(bdev);
@@ -171,16 +172,16 @@ send_command(hci_id hid, snet_buffer* snbuf)
// TODO: mutex // TODO: mutex
if (snbuf != NULL) { if (snbuf != NULL) {
list_add_item(&bdev->nbuffersTx[BT_COMMAND],snbuf); list_add_item(&bdev->nbuffersTx[BT_COMMAND], snbuf);
bdev->nbuffersPendingTx[BT_COMMAND]++; bdev->nbuffersPendingTx[BT_COMMAND]++;
} else { } else {
err = B_BAD_VALUE; err = B_BAD_VALUE;
flowf("tx sched provoked"); TRACE("%s: tx sched provoked", __func__);
} }
// TODO: check if device is actually ready for this // TODO: check if device is actually ready for this
// TODO: mutex // TODO: mutex
/* sched in All cases even if nbuf is null (hidden way to provoke /* sched in All cases even if nbuf is null (hidden way to provoke
* re-scheduling) * re-scheduling)
*/ */
src/add-ons/kernel/drivers/bluetooth/h2/h2generic/h2util.h
+5 -2
View File
@@ -5,17 +5,20 @@
#ifndef _H2UTIL_H_ #ifndef _H2UTIL_H_
#define _H2UTIL_H_ #define _H2UTIL_H_
#include <util/list.h> #include <util/list.h>
#include "h2generic.h" #include "h2generic.h"
/* net buffer utils for ACL, to be reviewed */ /* net buffer utils for ACL, to be reviewed */
#define DEVICEFIELD type #define DEVICEFIELD type
#define SET_DEVICE(nbuf, hid) \ #define SET_DEVICE(nbuf, hid) \
(nbuf->DEVICEFIELD=(nbuf->DEVICEFIELD & 0xFFFFFF00) | (hid & 0xFF)) (nbuf->DEVICEFIELD=(nbuf->DEVICEFIELD & 0xFFFFFF00) | (hid & 0xFF))
#define GET_DEVICE(nbuf) fetch_device(NULL,(nbuf->DEVICEFIELD&0xFF)) #define GET_DEVICE(nbuf) fetch_device(NULL, (nbuf->DEVICEFIELD&0xFF))
#define COOKIEFIELD flags
#define COOKIEFIELD flags
void* nb_get_whole_buffer(net_buffer* nbuf); void* nb_get_whole_buffer(net_buffer* nbuf);
void nb_destroy(net_buffer* nbuf); void nb_destroy(net_buffer* nbuf);
size_t get_expected_size(net_buffer* nbuf); size_t get_expected_size(net_buffer* nbuf);