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
|
#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <fcntl.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;
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 < 0) {
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;
}
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 = 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:
handle->num_of_nodes = req->misc & 0xffff;
handle->local_id = req->misc >> 16;
return 0;
default:
errno = 0;
return -1;
}
}
|
