status_t submit_tx_command(bt_usb_dev* bdev, snet_buffer* snbuf) { uint8 bRequestType = bdev->ctrl_req; uint8 bRequest = 0; uint16 wIndex = 0; uint16 value = 0; uint16 wLength = B_HOST_TO_LENDIAN_INT16(snb_size(snbuf)); status_t error; if (!GET_BIT(bdev->state, RUNNING)) { return B_DEV_NOT_READY; } // set cookie snb_set_cookie(snbuf, bdev); debugf("@%p\n", snb_get(snbuf)); error = usb->queue_request(bdev->dev, bRequestType, bRequest, value, wIndex, wLength, snb_get(snbuf), #ifndef HAIKU_TARGET_PLATFORM_HAIKU wLength, #endif command_complete, (void*) snbuf); if (error != B_OK) { bdev->stat.rejectedTX++; } else { bdev->stat.acceptedTX++; } return error; }
// TODO: split for commands and comunication (ACL & SCO) void sched_tx_processing(bt_usb_dev* bdev) { net_buffer* nbuf; snet_buffer* snbuf; status_t err; TRACE("%s: (%p)\n", __func__, bdev); if (!TEST_AND_SET(&bdev->state, PROCESSING)) { // We are not processing in another thread so... START!! do { /* Do while this bit is on... so someone should set it before we * stop the iterations */ bdev->state = CLEAR_BIT(bdev->state, SENDING); // check Commands #ifdef EMPTY_COMMAND_QUEUE while (!list_is_empty(&bdev->nbuffersTx[BT_COMMAND])) { #else if (!list_is_empty(&bdev->nbuffersTx[BT_COMMAND])) { #endif snbuf = (snet_buffer*) list_remove_head_item(&bdev->nbuffersTx[BT_COMMAND]); err = submit_tx_command(bdev, snbuf); if (err != B_OK) { // re-head it list_insert_item_before(&bdev->nbuffersTx[BT_COMMAND], list_get_first_item(&bdev->nbuffersTx[BT_COMMAND]), snbuf); } } // check ACl #define EMPTY_ACL_QUEUE #ifdef EMPTY_ACL_QUEUE while (!list_is_empty(&bdev->nbuffersTx[BT_ACL])) { #else if (!list_is_empty(&bdev->nbuffersTx[BT_ACL])) { #endif nbuf = (net_buffer*) list_remove_head_item(&bdev->nbuffersTx[BT_ACL]); err = submit_tx_acl(bdev, nbuf); if (err != B_OK) { // re-head it list_insert_item_before(&bdev->nbuffersTx[BT_ACL], list_get_first_item(&bdev->nbuffersTx[BT_ACL]), nbuf); } } if (!list_is_empty(&bdev->nbuffersTx[BT_SCO])) { // TODO to be implemented } } while (GET_BIT(bdev->state, SENDING)); bdev->state = CLEAR_BIT(bdev->state, PROCESSING); } else { // We are processing so MARK that we need to still go on with that bdev->state = SET_BIT(bdev->state, SENDING); } } #if 0 // DEPRECATED status_t post_packet_up(bt_usb_dev* bdev, bt_packet_t type, void* buf) { status_t err = B_ERROR; debugf("Frame up type=%d\n", type); if (type == BT_EVENT) { snet_buffer* snbuf = (snet_buffer*)buf; btCoreData->PostEvent(bdev->ndev, snb_get(snbuf), (size_t)snb_size(snbuf)); snb_park(&bdev->snetBufferRecycleTrash, snbuf); debugf("to btDataCore len=%d\n", snb_size(snbuf)); } else { net_buffer* nbuf = (net_buffer*) buf; // No need to free the buffer at allocation is gonna be reused btDevices->receive_data(bdev->ndev, &nbuf); TRACE("to net_device\n"); } return err; }