Oliver Ruiz Dorantes
d04eb939af
-Implement Launch method in the accesors regarding previous comment -Fix KDL at removing device git-svn-id: file:///srv/svn/repos/haiku/haiku/trunk@26345 a95241bf-73f2-0310-859d-f6bbb57e9c96
153 lines
2.8 KiB
C
153 lines
2.8 KiB
C
/*
|
|
* Copyright 2007 Oliver Ruiz Dorantes, oliver.ruiz.dorantes_at_gmail.com
|
|
*
|
|
* All rights reserved. Distributed under the terms of the MIT License.
|
|
*
|
|
*/
|
|
|
|
#include <malloc.h>
|
|
|
|
#include "h2upper.h"
|
|
#include "h2util.h"
|
|
#include "h2transactions.h"
|
|
|
|
#include <bluetooth/HCI/btHCI_acl.h>
|
|
#include <bluetooth/HCI/btHCI_command.h>
|
|
#include <bluetooth/HCI/btHCI_event.h>
|
|
|
|
#define BT_DEBUG_THIS_MODULE
|
|
#include <btDebug.h>
|
|
|
|
|
|
void*
|
|
nb_get_whole_buffer(net_buffer* nbuf)
|
|
{
|
|
void* conPointer;
|
|
status_t err;
|
|
|
|
/* the job could be already done */
|
|
// !!! it could be trash from other upper protocols...
|
|
if (nbuf->COOKIEFIELD != NULL)
|
|
return (void*)nbuf->COOKIEFIELD;
|
|
|
|
if (nb == NULL)
|
|
goto fail;
|
|
|
|
err = nb->direct_access(nbuf, 0, nbuf->size, &conPointer);
|
|
|
|
if (err != B_OK) {
|
|
|
|
/* pity, we are gonna need a realocation */
|
|
nbuf->COOKIEFIELD = (uint32) malloc(nbuf->size);
|
|
if (nbuf->COOKIEFIELD == NULL)
|
|
goto fail;
|
|
|
|
err = nb->write(nbuf, 0, (void*) nbuf->COOKIEFIELD, nbuf->size);
|
|
if (err != B_OK)
|
|
goto free;
|
|
|
|
conPointer = (void*)nbuf->COOKIEFIELD;
|
|
|
|
}
|
|
|
|
return conPointer;
|
|
|
|
free:
|
|
free((void*) nbuf->COOKIEFIELD);
|
|
fail:
|
|
return NULL;
|
|
}
|
|
|
|
|
|
void
|
|
nb_destroy(net_buffer* nbuf)
|
|
{
|
|
if (nbuf == NULL)
|
|
return;
|
|
|
|
/* Free possible allocated */
|
|
if (nbuf->COOKIEFIELD != NULL)
|
|
free((void*)nbuf->COOKIEFIELD);
|
|
|
|
// TODO check for survivers...
|
|
if (nb != NULL)
|
|
nb->free(nbuf);
|
|
|
|
}
|
|
|
|
|
|
/* Check from the completition if the queue is empty */
|
|
size_t
|
|
get_expected_size(net_buffer* nbuf)
|
|
{
|
|
|
|
if (nbuf == NULL)
|
|
panic("Analizing NULL packet");
|
|
|
|
switch (nbuf->protocol) {
|
|
|
|
case BT_ACL: {
|
|
struct hci_acl_header* header = nb_get_whole_buffer(nbuf);
|
|
return header->alen;
|
|
}
|
|
|
|
case BT_COMMAND: {
|
|
struct hci_command_header* header = nb_get_whole_buffer(nbuf);
|
|
return header->clen;
|
|
}
|
|
|
|
|
|
case BT_EVENT: {
|
|
struct hci_event_header* header = nb_get_whole_buffer(nbuf);
|
|
return header->elen;
|
|
}
|
|
default:
|
|
|
|
break;
|
|
}
|
|
|
|
return B_ERROR;
|
|
}
|
|
|
|
#if 0
|
|
#pragma mark - room util -
|
|
#endif
|
|
|
|
inline void
|
|
init_room(struct list* l)
|
|
{
|
|
list_init(l);
|
|
}
|
|
|
|
|
|
void*
|
|
alloc_room(struct list* l, size_t size)
|
|
{
|
|
|
|
void* item = list_get_first_item(l);
|
|
|
|
if (item == NULL)
|
|
item = (void*) malloc(size);
|
|
|
|
return item;
|
|
|
|
}
|
|
|
|
|
|
inline void
|
|
reuse_room(struct list* l, void* room)
|
|
{
|
|
list_add_item(l, room);
|
|
}
|
|
|
|
|
|
void
|
|
purge_room(struct list* l)
|
|
{
|
|
void* item;
|
|
|
|
while ((item = list_remove_head_item(l)) != NULL) {
|
|
free(item);
|
|
}
|
|
}
|