← Back to branch summary

~ubuntu-branches/ubuntu/intrepid/bluez/intrepid

« back to all changes in this revision

Viewing changes to tools/csr_hci.c

  • Committer: Bazaar Package Importer
  • Author(s): Mario Limonciello
  • Date: 2008-10-07 12:10:29 UTC
  • Revision ID: james.westby@ubuntu.com-20081007121029-4gup4fmmh2vfo5nh
Tags: upstream-4.12
Import upstream version 4.12

Show diffs side-by-side

added added

removed removed

Lines of Context:
tools/csr_hci.c
 
1
/*
 
2
 *
 
3
 *  BlueZ - Bluetooth protocol stack for Linux
 
4
 *
 
5
 *  Copyright (C) 2004-2008  Marcel Holtmann <marcel@holtmann.org>
 
6
 *
 
7
 *
 
8
 *  This program is free software; you can redistribute it and/or modify
 
9
 *  it under the terms of the GNU General Public License as published by
 
10
 *  the Free Software Foundation; either version 2 of the License, or
 
11
 *  (at your option) any later version.
 
12
 *
 
13
 *  This program is distributed in the hope that it will be useful,
 
14
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 
15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 
16
 *  GNU General Public License for more details.
 
17
 *
 
18
 *  You should have received a copy of the GNU General Public License
 
19
 *  along with this program; if not, write to the Free Software
 
20
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 
21
 *
 
22
 */
 
23
 
 
24
#ifdef HAVE_CONFIG_H
 
25
#include <config.h>
 
26
#endif
 
27
 
 
28
#include <stdio.h>
 
29
#include <errno.h>
 
30
#include <string.h>
 
31
#include <sys/socket.h>
 
32
 
 
33
#include <bluetooth/bluetooth.h>
 
34
#include <bluetooth/hci.h>
 
35
#include <bluetooth/hci_lib.h>
 
36
 
 
37
#include "csr.h"
 
38
 
 
39
static uint16_t seqnum = 0x0000;
 
40
 
 
41
static int dd = -1;
 
42
 
 
43
int csr_open_hci(char *device)
 
44
{
 
45
        struct hci_dev_info di;
 
46
        struct hci_version ver;
 
47
        int dev = 0;
 
48
 
 
49
        if (device) {
 
50
                dev = hci_devid(device);
 
51
                if (dev < 0) {
 
52
                        fprintf(stderr, "Device not available\n");
 
53
                        return -1;
 
54
                }
 
55
        }
 
56
 
 
57
        dd = hci_open_dev(dev);
 
58
        if (dd < 0) {
 
59
                fprintf(stderr, "Can't open device hci%d: %s (%d)\n",
 
60
                                                dev, strerror(errno), errno);
 
61
                return -1;
 
62
        }
 
63
 
 
64
        if (hci_devinfo(dev, &di) < 0) {
 
65
                fprintf(stderr, "Can't get device info for hci%d: %s (%d)\n",
 
66
                                                dev, strerror(errno), errno);
 
67
                hci_close_dev(dd);
 
68
                return -1;
 
69
        }
 
70
 
 
71
        if (hci_read_local_version(dd, &ver, 1000) < 0) {
 
72
                fprintf(stderr, "Can't read version info for hci%d: %s (%d)\n",
 
73
                                                dev, strerror(errno), errno);
 
74
                hci_close_dev(dd);
 
75
                return -1;
 
76
        }
 
77
 
 
78
        if (ver.manufacturer != 10) {
 
79
                fprintf(stderr, "Unsupported manufacturer\n");
 
80
                hci_close_dev(dd);
 
81
                return -1;
 
82
        }
 
83
 
 
84
        return 0;
 
85
}
 
86
 
 
87
static int do_command(uint16_t command, uint16_t seqnum, uint16_t varid, uint8_t *value, uint16_t length)
 
88
{
 
89
        unsigned char cp[254], rp[254];
 
90
        struct hci_request rq;
 
91
        uint8_t cmd[10];
 
92
        uint16_t size;
 
93
 
 
94
        size = (length < 8) ? 9 : ((length + 1) / 2) + 5;
 
95
 
 
96
        cmd[0] = command & 0xff;
 
97
        cmd[1] = command >> 8;
 
98
        cmd[2] = size & 0xff;
 
99
        cmd[3] = size >> 8;
 
100
        cmd[4] = seqnum & 0xff;
 
101
        cmd[5] = seqnum >> 8;
 
102
        cmd[6] = varid & 0xff;
 
103
        cmd[7] = varid >> 8;
 
104
        cmd[8] = 0x00;
 
105
        cmd[9] = 0x00;
 
106
 
 
107
        memset(cp, 0, sizeof(cp));
 
108
        cp[0] = 0xc2;
 
109
        memcpy(cp + 1, cmd, sizeof(cmd));
 
110
        memcpy(cp + 11, value, length);
 
111
 
 
112
        switch (varid) {
 
113
        case CSR_VARID_COLD_RESET:
 
114
        case CSR_VARID_WARM_RESET:
 
115
        case CSR_VARID_COLD_HALT:
 
116
        case CSR_VARID_WARM_HALT:
 
117
                return hci_send_cmd(dd, OGF_VENDOR_CMD, 0x00, (size * 2) + 1, cp);
 
118
        }
 
119
 
 
120
        memset(&rq, 0, sizeof(rq));
 
121
        rq.ogf    = OGF_VENDOR_CMD;
 
122
        rq.ocf    = 0x00;
 
123
        rq.event  = EVT_VENDOR;
 
124
        rq.cparam = cp;
 
125
        rq.clen   = (size * 2) + 1;
 
126
        rq.rparam = rp;
 
127
        rq.rlen   = sizeof(rp);
 
128
 
 
129
        if (hci_send_req(dd, &rq, 2000) < 0)
 
130
                return -1;
 
131
 
 
132
        if (rp[0] != 0xc2) {
 
133
                errno = EIO;
 
134
                return -1;
 
135
        }
 
136
 
 
137
        if ((rp[9] + (rp[10] << 8)) != 0) {
 
138
                errno = ENXIO;
 
139
                return -1;
 
140
        }
 
141
 
 
142
        memcpy(value, rp + 11, length);
 
143
 
 
144
        return 0;
 
145
}
 
146
 
 
147
int csr_read_hci(uint16_t varid, uint8_t *value, uint16_t length)
 
148
{
 
149
        return do_command(0x0000, seqnum++, varid, value, length);
 
150
}
 
151
 
 
152
int csr_write_hci(uint16_t varid, uint8_t *value, uint16_t length)
 
153
{
 
154
        return do_command(0x0002, seqnum++, varid, value, length);
 
155
}
 
156
 
 
157
void csr_close_hci(void)
 
158
{
 
159
        hci_close_dev(dd);
 
160
}