1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
|
/*
* libraw1394 - library for raw access to the 1394 bus with the Linux subsystem.
*
* Copyright (C) 1999,2000 Andreas Bombe
*
* This library is licensed under the GNU Lesser General Public License (LGPL),
* version 2.1 or later. See the file COPYING.LIB in the distribution for
* details.
*/
#include <config.h>
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.h>
#include <unistd.h>
#include "raw1394.h"
#include "kernel-raw1394.h"
#include "raw1394_private.h"
static int bus_reset_default(struct raw1394_handle *handle)
{
return 0;
}
static int tag_handler_default(struct raw1394_handle *handle, unsigned long tag,
int error)
{
struct raw1394_reqhandle *rh;
if (tag) {
rh = (struct raw1394_reqhandle *)tag;
return rh->callback(handle, rh->data, error);
} else {
return -1;
}
}
int _raw1394_sync_cb(struct raw1394_handle *unused, struct sync_cb_data *data,
int error)
{
data->errcode = error;
data->done = 1;
return 0;
}
static unsigned int init_rawdevice(struct raw1394_handle *h)
{
struct raw1394_request *req = &h->req;
CLEAR_REQ(req);
req->type = RAW1394_REQ_INITIALIZE;
req->misc = RAW1394_KERNELAPI_VERSION;
h->protocol_version = RAW1394_KERNELAPI_VERSION;
if (write(h->fd, req, sizeof(*req)) < 0) return -1;
if (read(h->fd, req, sizeof(*req)) < 0) return -1;
if (req->error == RAW1394_ERROR_COMPAT && req->misc == 3) {
h->protocol_version = 3;
if (write(h->fd, req, sizeof(*req)) < 0) return -1;
if (read(h->fd, req, sizeof(*req)) < 0) return -1;
}
if (req->error) {
errno = 0;
return -1;
}
return req->generation;
}
struct raw1394_handle *raw1394_get_handle(void)
{
struct raw1394_handle *handle;
handle = malloc(sizeof(struct raw1394_handle));
if (!handle) {
errno = ENOMEM;
return NULL;
}
handle->fd = open("/dev/raw1394", O_RDWR);
if (handle->fd < 0) {
free(handle);
return NULL;
}
handle->generation = init_rawdevice(handle);
if (handle->generation == -1) {
close(handle->fd);
free(handle);
return NULL;
}
handle->bus_reset_handler = bus_reset_default;
handle->tag_handler = tag_handler_default;
memset(handle->iso_handler, 0, sizeof(handle->iso_handler));
return handle;
}
void raw1394_destroy_handle(struct raw1394_handle *handle)
{
if (handle) {
close(handle->fd);
free(handle);
}
}
int raw1394_get_fd(struct raw1394_handle *handle)
{
return handle->fd;
}
unsigned int raw1394_get_generation(struct raw1394_handle *handle)
{
return handle->generation;
}
int raw1394_get_nodecount(struct raw1394_handle *handle)
{
return handle->num_of_nodes;
}
nodeid_t raw1394_get_local_id(struct raw1394_handle *handle)
{
return handle->local_id;
}
nodeid_t raw1394_get_irm_id(struct raw1394_handle *handle)
{
return handle->irm_id;
}
void *raw1394_get_userdata(struct raw1394_handle *handle)
{
return handle->userdata;
}
void raw1394_set_userdata(struct raw1394_handle *handle, void *data)
{
handle->userdata = data;
}
int raw1394_get_port_info(struct raw1394_handle *handle,
struct raw1394_portinfo *pinf, int maxports)
{
int num;
struct raw1394_request *req = &handle->req;
struct raw1394_khost_list *khl;
CLEAR_REQ(req);
req->type = RAW1394_REQ_LIST_CARDS;
req->generation = handle->generation;
req->recvb = ptr2int(handle->buffer);
req->length = HBUF_SIZE;
while (1) {
if (write(handle->fd, req, sizeof(*req)) < 0) return -1;
if (read(handle->fd, req, sizeof(*req)) < 0) return -1;
if (!req->error) break;
if (req->error == RAW1394_ERROR_GENERATION) {
handle->generation = req->generation;
continue;
}
return -1;
}
for (num = req->misc, khl = (struct raw1394_khost_list *)handle->buffer;
num && maxports; num--, maxports--, pinf++, khl++) {
pinf->nodes = khl->nodes;
strcpy(pinf->name, khl->name);
}
return req->misc;
}
int raw1394_set_port(struct raw1394_handle *handle, int port)
{
struct raw1394_request *req = &handle->req;
CLEAR_REQ(req);
req->type = RAW1394_REQ_SET_CARD;
req->generation = handle->generation;
req->misc = port;
if (write(handle->fd, req, sizeof(*req)) < 0) return -1;
if (read(handle->fd, req, sizeof(*req)) < 0) return -1;
switch (req->error) {
case RAW1394_ERROR_GENERATION:
handle->generation = req->generation;
errno = ESTALE;
return -1;
case RAW1394_ERROR_INVALID_ARG:
errno = EINVAL;
return -1;
case RAW1394_ERROR_NONE:
if (handle->protocol_version == 3) {
handle->num_of_nodes = req->misc & 0xffff;
handle->local_id = req->misc >> 16;
} else {
handle->num_of_nodes = req->misc & 0xff;
handle->irm_id = ((req->misc >> 8) & 0xff) | 0xffc0;
handle->local_id = req->misc >> 16;
}
return 0;
default:
errno = 0;
return -1;
}
}
int raw1394_reset_bus(struct raw1394_handle *handle)
{
struct raw1394_request *req = &handle->req;
CLEAR_REQ(req);
req->type = RAW1394_REQ_RESET_BUS;
req->generation = handle->generation;
if (write(handle->fd, req, sizeof(*req)) < 0) return -1;
return 0;
}
|
