54 lines
1.3 KiB
C
54 lines
1.3 KiB
C
|
|
||
|
|
#include <errno.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
#include "raw1394.h"
|
||
|
|
#include "kernel-raw1394.h"
|
||
|
|
#include "raw1394_private.h"
|
||
|
|
|
||
|
|
static int do_fcp_listen(struct raw1394_handle *handle)
|
||
|
|
{
|
||
|
|
struct sync_cb_data sd = { 0, 0 };
|
||
|
|
struct raw1394_reqhandle rh = { (req_callback_t)_raw1394_sync_cb, &sd };
|
||
|
|
int err;
|
||
|
|
struct raw1394_request *req = &handle->req;
|
||
|
|
|
||
|
|
CLEAR_REQ(req);
|
||
|
|
req->type = RAW1394_REQ_FCP_LISTEN;
|
||
|
|
req->generation = handle->generation;
|
||
|
|
req->misc = 0;
|
||
|
|
req->tag = (unsigned long)&rh;
|
||
|
|
req->recvb = handle->buffer;
|
||
|
|
req->length = 512;
|
||
|
|
|
||
|
|
err = write(handle->fd, req, sizeof(*req));
|
||
|
|
while (!sd.done) {
|
||
|
|
if (err < 0) return err;
|
||
|
|
err = raw1394_loop_iterate(handle);
|
||
|
|
}
|
||
|
|
|
||
|
|
switch (sd.errcode) {
|
||
|
|
case RAW1394_ERROR_ALREADY:
|
||
|
|
errno = EALREADY;
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
case RAW1394_ERROR_INVALID_ARG:
|
||
|
|
errno = EINVAL;
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
default:
|
||
|
|
errno = 0;
|
||
|
|
return sd.errcode;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int raw1394_start_fcp_listen(struct raw1394_handle *handle)
|
||
|
|
{
|
||
|
|
return do_fcp_listen(handle);
|
||
|
|
}
|
||
|
|
|
||
|
|
int raw1394_stop_fcp_listen(struct raw1394_handle *handle)
|
||
|
|
{
|
||
|
|
return do_fcp_listen(handle);
|
||
|
|
}
|