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
|
#include <unistd.h>
#include "raw1394.h"
#include "kernel-raw1394.h"
#include "raw1394_private.h"
struct sync_cb_data {
int done;
int errcode;
};
static int sync_cb(struct raw1394_handle *unused,
struct sync_cb_data *data, int error)
{
data->errcode = error;
data->done = 1;
return 0;
}
int raw1394_start_read(struct raw1394_handle *handle, nodeid_t node,
nodeaddr_t addr, size_t length, quadlet_t *buffer,
unsigned long tag)
{
struct raw1394_request *req = &handle->req;
CLEAR_REQ(req);
req->type = RAW1394_REQ_ASYNC_READ;
req->generation = handle->generation;
req->tag = tag;
req->address = ((u_int64_t)node << 48) | addr;
req->length = length;
req->recvb = buffer;
return (int)write(handle->fd, req, sizeof(*req));
}
int raw1394_start_write(struct raw1394_handle *handle, nodeid_t node,
nodeaddr_t addr, size_t length, quadlet_t *data,
unsigned long tag)
{
struct raw1394_request *req = &handle->req;
CLEAR_REQ(req);
req->type = RAW1394_REQ_ASYNC_WRITE;
req->generation = handle->generation;
req->tag = tag;
req->address = ((u_int64_t)node << 48) | addr;
req->length = length;
req->sendb = data;
return (int)write(handle->fd, req, sizeof(*req));
}
#define SYNCFUNC_VARS \
struct sync_cb_data sd = { 0, 0 }; \
struct raw1394_reqhandle rh = { (req_callback_t)sync_cb, &sd }; \
int err
#define SYNCFUNC_BODY \
if (err < 0) return err; \
while (!sd.done) raw1394_loop_iterate(handle); \
return sd.errcode
int raw1394_read(struct raw1394_handle *handle, nodeid_t node, nodeaddr_t addr,
size_t length, quadlet_t *buffer)
{
SYNCFUNC_VARS;
err = raw1394_start_read(handle, node, addr, length, buffer,
(unsigned long)&rh);
SYNCFUNC_BODY;
}
int raw1394_write(struct raw1394_handle *handle, nodeid_t node, nodeaddr_t addr,
size_t length, quadlet_t *data)
{
SYNCFUNC_VARS;
err = raw1394_start_write(handle, node, addr, length, data,
(unsigned long)&rh);
SYNCFUNC_BODY;
}
#undef SYNCFUNC_VARS
#undef SYNCFUNC_BODY
|
