Add hci_read_clock() function

This commit is contained in:
Marcel Holtmann 2005-01-25 21:36:28 +00:00
parent 654f832d98
commit 1e2dec5679
3 changed files with 46 additions and 0 deletions

View File

@ -821,6 +821,20 @@ typedef struct {
} __attribute__ ((packed)) read_afh_map_rp;
#define READ_AFH_MAP_RP_SIZE 14
#define OCF_READ_CLOCK 0x0007
typedef struct {
uint16_t handle;
uint8_t which_clock;
} __attribute__ ((packed)) read_clock_cp;
#define READ_CLOCK_CP_SIZE 3
typedef struct {
uint8_t status;
uint16_t handle;
uint32_t clock;
uint16_t accuracy;
} __attribute__ ((packed)) read_clock_rp;
#define READ_CLOCK_RP_SIZE 9
/* Testing commands */
#define OGF_TESTING_CMD 0x3e

View File

@ -96,6 +96,7 @@ int hci_set_afh_classification(int dd, uint8_t *map, int to);
int hci_read_link_quality(int dd, uint16_t handle, uint8_t *link_quality, int to);
int hci_read_rssi(int dd, uint16_t handle, int8_t *rssi, int to);
int hci_read_afh_map(int dd, uint16_t handle, uint8_t *mode, uint8_t *map, int to);
int hci_read_clock(int dd, uint16_t handle, uint8_t which, uint32_t *clock, uint16_t *accuracy, int to);
int hci_local_name(int dd, int len, char *name, int to);
int hci_remote_name(int dd, const bdaddr_t *bdaddr, int len, char *name, int to);

View File

@ -1620,6 +1620,37 @@ int hci_read_afh_map(int dd, uint16_t handle, uint8_t *mode, uint8_t *map, int t
return 0;
}
int hci_read_clock(int dd, uint16_t handle, uint8_t which, uint32_t *clock, uint16_t *accuracy, int to)
{
read_clock_cp cp;
read_clock_rp rp;
struct hci_request rq;
memset(&cp, 0, sizeof(cp));
cp.handle = handle;
cp.which_clock = which;
memset(&rq, 0, sizeof(rq));
rq.ogf = OGF_STATUS_PARAM;
rq.ocf = OCF_READ_CLOCK;
rq.cparam = &cp;
rq.clen = READ_CLOCK_CP_SIZE;
rq.rparam = &rp;
rq.rlen = READ_CLOCK_RP_SIZE;
if (hci_send_req(dd, &rq, to) < 0)
return -1;
if (rp.status) {
errno = EIO;
return -1;
}
*clock = rp.clock;
*accuracy = rp.accuracy;
return 0;
}
int hci_local_name(int dd, int len, char *name, int to)
{
return hci_read_local_name(dd, len, name, to);