Dan Dennedy
commit
7c4d497054
|
|
@ -1,6 +1,7 @@
|
|||
# process this file with automake to create a Makefile.in
|
||||
|
||||
SUBDIRS = src tools doc debian
|
||||
SUBDIRS = $(LIB_SUBDIR) tools doc debian
|
||||
DIST_SUBDIRS = src juju
|
||||
|
||||
pkgconfigdir = @libdir@/pkgconfig
|
||||
pkgconfig_DATA = libraw1394.pc
|
||||
|
|
|
|||
22
configure.ac
22
configure.ac
|
|
@ -28,7 +28,28 @@ dnl Check to see if valgrind is available
|
|||
AC_ARG_WITH(valgrind, AC_HELP_STRING([--with-valgrind],[compile with valgrind support]))
|
||||
if test x$with_valgrind = xyes ; then
|
||||
AC_CHECK_HEADERS(valgrind/valgrind.h)
|
||||
|
||||
AC_ARG_WITH(juju-dir,[ --with-juju-dir=<dir> Path to juju include files])
|
||||
if ! test -z "$with_juju_dir" ; then
|
||||
JUJU_DIR="$with_juju_dir"
|
||||
LIB_SUBDIR=juju
|
||||
AC_SUBST(JUJU_DIR)
|
||||
else
|
||||
LIB_SUBDIR=src
|
||||
fi
|
||||
AC_SUBST(LIB_SUBDIR)
|
||||
|
||||
AC_ARG_WITH(fw-device-prefix,
|
||||
[ --with-fw-device-prefix=<prefix> Prefix of firewire device file names (default "fw").],
|
||||
[FW_DEVICE_PREFIX="\"$withval\""], [FW_DEVICE_PREFIX="\"fw\""])
|
||||
AC_ARG_WITH(fw-device-dir,
|
||||
[ --with-fw-device-dir=<dir> Directory to watch for firewire device files (default "/dev").],
|
||||
[FW_DEVICE_DIR="\"$withval\""], [FW_DEVICE_DIR="\"/dev\""])
|
||||
|
||||
AC_DEFINE_UNQUOTED(FW_DEVICE_PREFIX, $FW_DEVICE_PREFIX,
|
||||
[Prefix of firewire device file names.])
|
||||
AC_DEFINE_UNQUOTED(FW_DEVICE_DIR, $FW_DEVICE_DIR,
|
||||
[Directory to watch for firewire device files.])
|
||||
|
||||
#CFLAGS=${CFLAGS:-"-Wall"}
|
||||
AC_OUTPUT([
|
||||
|
|
@ -36,6 +57,7 @@ Makefile
|
|||
libraw1394.pc
|
||||
libraw1394.spec
|
||||
src/Makefile
|
||||
juju/Makefile
|
||||
tools/Makefile
|
||||
doc/Makefile
|
||||
doc/testlibraw.1
|
||||
|
|
|
|||
|
|
@ -0,0 +1,8 @@
|
|||
lib_LTLIBRARIES = libraw1394.la
|
||||
|
||||
INCLUDES = -I$(JUJU_DIR)
|
||||
libraw1394_la_LDFLAGS = -version-info @lt_major@:@lt_revision@:@lt_age@
|
||||
|
||||
libraw1394_la_SOURCES = raw1394.c raw1394-iso.c juju.h
|
||||
|
||||
pkginclude_HEADERS = ../src/raw1394.h ../src/csr.h ../src/ieee1394.h
|
||||
|
|
@ -0,0 +1,141 @@
|
|||
/* -*- c-basic-offset: 8 -*-
|
||||
*
|
||||
* juju.h -- Internal header file for raw1394 emulation
|
||||
*
|
||||
* Copyright (C) 2007 Kristian Hoegsberg <krh@bitplanet.net>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software Foundation,
|
||||
* Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
*/
|
||||
|
||||
#ifndef __juju_h
|
||||
#define __juju_h
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <byteswap.h>
|
||||
#include <linux/firewire-cdev.h>
|
||||
#include "../src/raw1394.h"
|
||||
#include "../src/csr.h"
|
||||
#include "config.h"
|
||||
|
||||
#define ptr_to_u64(p) ((__u64)(unsigned long)(p))
|
||||
#define u64_to_ptr(p) ((void *)(unsigned long)(p))
|
||||
|
||||
static inline __u32
|
||||
be32_to_cpu(__u32 q)
|
||||
{
|
||||
union { char c[4]; __u32 q; } u = { { 1, 0, 0, 0 } };
|
||||
|
||||
return u.q == 1 ? bswap_32(q) : q;
|
||||
}
|
||||
|
||||
static inline __u32
|
||||
cpu_to_be32(__u32 q)
|
||||
{
|
||||
return be32_to_cpu(q);
|
||||
}
|
||||
|
||||
#define ARRAY_LENGTH(a) (sizeof (a) / sizeof (a)[0])
|
||||
|
||||
#define BUFFER_SIZE (16 * 1024)
|
||||
|
||||
#define MAX_PORTS 16
|
||||
|
||||
struct epoll_closure {
|
||||
int (*func)(raw1394handle_t handle,
|
||||
struct epoll_closure *closure, __uint32_t events);
|
||||
};
|
||||
|
||||
struct port {
|
||||
char device_file[32];
|
||||
char *name;
|
||||
int node_count;
|
||||
int card;
|
||||
};
|
||||
|
||||
#define MAX_DEVICES 63
|
||||
#define FILENAME_SIZE 16
|
||||
|
||||
struct device {
|
||||
struct epoll_closure closure;
|
||||
int fd;
|
||||
int node_id;
|
||||
int generation;
|
||||
char filename[FILENAME_SIZE];
|
||||
};
|
||||
|
||||
struct request_closure {
|
||||
void *data;
|
||||
size_t length;
|
||||
unsigned long tag;
|
||||
struct raw1394_reqhandle reqhandle;
|
||||
};
|
||||
|
||||
struct allocation;
|
||||
|
||||
struct raw1394_handle {
|
||||
struct port ports[MAX_PORTS];
|
||||
int port_count;
|
||||
int err;
|
||||
int generation;
|
||||
void *user_data;
|
||||
int notify_bus_reset;
|
||||
|
||||
bus_reset_handler_t bus_reset_handler;
|
||||
tag_handler_t tag_handler;
|
||||
arm_tag_handler_t arm_tag_handler;
|
||||
fcp_handler_t fcp_handler;
|
||||
__u32 fcp_allocation_handle;
|
||||
struct allocation *allocations;
|
||||
|
||||
int epoll_fd;
|
||||
int inotify_fd;
|
||||
int inotify_watch;
|
||||
int pipe_fds[2];
|
||||
|
||||
struct epoll_closure pipe_closure;
|
||||
struct epoll_closure inotify_closure;
|
||||
|
||||
struct device devices[MAX_DEVICES];
|
||||
int nodes[MAX_DEVICES];
|
||||
int local_fd;
|
||||
char local_filename[FILENAME_SIZE];
|
||||
|
||||
struct fw_cdev_event_bus_reset reset;
|
||||
|
||||
struct {
|
||||
struct epoll_closure closure;
|
||||
int fd;
|
||||
int type;
|
||||
int irq_interval;
|
||||
int packet_phase;
|
||||
int packet_count;
|
||||
int packet_index;
|
||||
int buf_packets;
|
||||
int max_packet_size;
|
||||
int prebuffer;
|
||||
int start_on_cycle;
|
||||
enum raw1394_iso_dma_recv_mode recv_mode;
|
||||
raw1394_iso_xmit_handler_t xmit_handler;
|
||||
raw1394_iso_recv_handler_t recv_handler;
|
||||
unsigned char *buffer, *buffer_end, *head;
|
||||
unsigned char *tail, *first_payload;
|
||||
|
||||
struct fw_cdev_iso_packet *packets;
|
||||
} iso;
|
||||
|
||||
char buffer[BUFFER_SIZE];
|
||||
};
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,522 @@
|
|||
/* -*- c-basic-offset: 8 -*-
|
||||
*
|
||||
* raw1394-iso.c -- Emulation of the raw1394 rawiso API on the juju stack
|
||||
*
|
||||
* Copyright (C) 2007 Kristian Hoegsberg <krh@bitplanet.net>
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software Foundation,
|
||||
* Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
||||
*/
|
||||
|
||||
#include <string.h>
|
||||
#include <sys/mman.h>
|
||||
#include <errno.h>
|
||||
#include <unistd.h>
|
||||
#include <fcntl.h>
|
||||
#include <stdio.h>
|
||||
#include <sys/epoll.h>
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#include "juju.h"
|
||||
|
||||
static int
|
||||
queue_packet(raw1394handle_t handle,
|
||||
unsigned int length, unsigned int header_length,
|
||||
unsigned char tag, unsigned char sy)
|
||||
{
|
||||
struct fw_cdev_queue_iso queue_iso;
|
||||
struct fw_cdev_iso_packet *p;
|
||||
int err;
|
||||
|
||||
p = &handle->iso.packets[handle->iso.packet_index];
|
||||
p->control =
|
||||
FW_CDEV_ISO_PAYLOAD_LENGTH(length) |
|
||||
FW_CDEV_ISO_TAG(tag) |
|
||||
FW_CDEV_ISO_SY(sy) |
|
||||
FW_CDEV_ISO_HEADER_LENGTH(header_length);
|
||||
|
||||
if (handle->iso.packet_phase == handle->iso.irq_interval - 1)
|
||||
p->control |= FW_CDEV_ISO_INTERRUPT;
|
||||
|
||||
handle->iso.head += length;
|
||||
handle->iso.packet_count++;
|
||||
handle->iso.packet_phase++;
|
||||
handle->iso.packet_index++;
|
||||
|
||||
if (handle->iso.packet_phase == handle->iso.irq_interval)
|
||||
handle->iso.packet_phase = 0;
|
||||
|
||||
if (handle->iso.head + handle->iso.max_packet_size > handle->iso.buffer_end)
|
||||
handle->iso.head = handle->iso.buffer;
|
||||
|
||||
/* Queue the packets in the kernel if we filled up the packets
|
||||
* array or wrapped the payload buffer. */
|
||||
if (handle->iso.packet_index == handle->iso.irq_interval ||
|
||||
handle->iso.head == handle->iso.buffer) {
|
||||
queue_iso.packets = ptr_to_u64(handle->iso.packets);
|
||||
queue_iso.size = handle->iso.packet_index * sizeof handle->iso.packets[0];
|
||||
queue_iso.data = ptr_to_u64(handle->iso.first_payload);
|
||||
queue_iso.handle = 0;
|
||||
handle->iso.packet_index = 0;
|
||||
handle->iso.first_payload = handle->iso.head;
|
||||
|
||||
err = ioctl(handle->iso.fd, FW_CDEV_IOC_QUEUE_ISO, &queue_iso);
|
||||
if (err < 0)
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
static int
|
||||
queue_xmit_packets(raw1394handle_t handle, int limit)
|
||||
{
|
||||
enum raw1394_iso_disposition d;
|
||||
unsigned char tag, sy;
|
||||
int len, cycle, dropped;
|
||||
|
||||
if (handle->iso.xmit_handler == NULL)
|
||||
return 0;
|
||||
|
||||
while (handle->iso.packet_count < limit) {
|
||||
|
||||
d = handle->iso.xmit_handler(handle, handle->iso.head,
|
||||
&len, &tag, &sy, cycle, dropped);
|
||||
|
||||
switch (d) {
|
||||
case RAW1394_ISO_OK:
|
||||
queue_packet(handle, len, 0, tag, sy);
|
||||
break;
|
||||
case RAW1394_ISO_DEFER:
|
||||
case RAW1394_ISO_AGAIN:
|
||||
default:
|
||||
return 0;
|
||||
case RAW1394_ISO_ERROR:
|
||||
return -1;
|
||||
case RAW1394_ISO_STOP:
|
||||
raw1394_iso_stop(handle);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int raw1394_iso_xmit_start(raw1394handle_t handle, int start_on_cycle,
|
||||
int prebuffer_packets)
|
||||
{
|
||||
struct fw_cdev_start_iso start_iso;
|
||||
int retval;
|
||||
|
||||
if (prebuffer_packets == -1)
|
||||
prebuffer_packets = handle->iso.irq_interval;
|
||||
|
||||
handle->iso.prebuffer = prebuffer_packets;
|
||||
handle->iso.start_on_cycle = start_on_cycle;
|
||||
|
||||
queue_xmit_packets(handle, prebuffer_packets);
|
||||
|
||||
if (handle->iso.prebuffer <= handle->iso.packet_count) {
|
||||
start_iso.cycle = start_on_cycle;
|
||||
start_iso.handle = 0;
|
||||
|
||||
retval = ioctl(handle->iso.fd,
|
||||
FW_CDEV_IOC_START_ISO, &start_iso);
|
||||
if (retval < 0)
|
||||
return retval;
|
||||
}
|
||||
|
||||
return queue_xmit_packets(handle, handle->iso.buf_packets);
|
||||
}
|
||||
|
||||
static int
|
||||
queue_recv_packets(raw1394handle_t handle)
|
||||
{
|
||||
while (handle->iso.packet_count <= handle->iso.buf_packets)
|
||||
queue_packet(handle, handle->iso.max_packet_size, 4, 0, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static enum raw1394_iso_disposition
|
||||
flush_recv_packets(raw1394handle_t handle,
|
||||
struct fw_cdev_event_iso_interrupt *interrupt)
|
||||
{
|
||||
enum raw1394_iso_disposition d;
|
||||
quadlet_t header, *p, *end;
|
||||
unsigned int len, cycle, dropped;
|
||||
unsigned char channel, tag, sy;
|
||||
|
||||
p = interrupt->header;
|
||||
end = (void *) interrupt->header + interrupt->header_length;
|
||||
cycle = interrupt->cycle;
|
||||
dropped = 0;
|
||||
d = RAW1394_ISO_OK;
|
||||
|
||||
while (p < end) {
|
||||
header = be32_to_cpu(*p++);
|
||||
len = header >> 16;
|
||||
tag = (header >> 14) & 0x3;
|
||||
channel = (header >> 8) & 0x3f;
|
||||
sy = header & 0x0f;
|
||||
|
||||
d = handle->iso.recv_handler(handle, handle->iso.tail, len,
|
||||
channel, tag, sy, cycle, dropped);
|
||||
if (d != RAW1394_ISO_OK)
|
||||
/* FIXME: we need to save the headers so we
|
||||
* can restart this loop. */
|
||||
break;
|
||||
cycle++;
|
||||
|
||||
handle->iso.tail += handle->iso.max_packet_size;
|
||||
handle->iso.packet_count--;
|
||||
|
||||
if (handle->iso.tail + handle->iso.max_packet_size > handle->iso.buffer_end)
|
||||
handle->iso.tail = handle->iso.buffer;
|
||||
}
|
||||
|
||||
switch (d) {
|
||||
case RAW1394_ISO_OK:
|
||||
case RAW1394_ISO_DEFER:
|
||||
default:
|
||||
break;
|
||||
|
||||
case RAW1394_ISO_ERROR:
|
||||
return -1;
|
||||
|
||||
case RAW1394_ISO_STOP:
|
||||
raw1394_iso_stop(handle);
|
||||
return 0;
|
||||
}
|
||||
|
||||
queue_recv_packets(handle);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_start(raw1394handle_t handle, int start_on_cycle,
|
||||
int tag_mask, int sync)
|
||||
{
|
||||
struct fw_cdev_start_iso start_iso;
|
||||
|
||||
queue_recv_packets(handle);
|
||||
|
||||
start_iso.cycle = start_on_cycle;
|
||||
start_iso.tags =
|
||||
tag_mask == -1 ? FW_CDEV_ISO_CONTEXT_MATCH_ALL_TAGS : tag_mask;
|
||||
/* sync is documented as 'not used' */
|
||||
start_iso.sync = 0;
|
||||
start_iso.handle = 0;
|
||||
|
||||
return ioctl(handle->iso.fd, FW_CDEV_IOC_START_ISO, &start_iso);
|
||||
}
|
||||
|
||||
static int handle_iso_event(raw1394handle_t handle,
|
||||
struct epoll_closure *closure, __uint32_t events)
|
||||
{
|
||||
struct fw_cdev_event_iso_interrupt *interrupt;
|
||||
int len;
|
||||
|
||||
len = read(handle->iso.fd, handle->buffer, sizeof handle->buffer);
|
||||
if (len < 0)
|
||||
return -1;
|
||||
|
||||
interrupt = (struct fw_cdev_event_iso_interrupt *) handle->buffer;
|
||||
if (interrupt->type != FW_CDEV_EVENT_ISO_INTERRUPT)
|
||||
return 0;
|
||||
|
||||
switch (handle->iso.type) {
|
||||
case FW_CDEV_ISO_CONTEXT_TRANSMIT:
|
||||
handle->iso.packet_count -= handle->iso.irq_interval;
|
||||
return queue_xmit_packets(handle, handle->iso.buf_packets);
|
||||
case FW_CDEV_ISO_CONTEXT_RECEIVE:
|
||||
return flush_recv_packets(handle, interrupt);
|
||||
default:
|
||||
/* Doesn't happen. */
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
|
||||
int raw1394_iso_xmit_write(raw1394handle_t handle, unsigned char *data,
|
||||
unsigned int len, unsigned char tag,
|
||||
unsigned char sy)
|
||||
{
|
||||
struct fw_cdev_queue_iso queue_iso;
|
||||
struct fw_cdev_start_iso start_iso;
|
||||
struct fw_cdev_iso_packet *p;
|
||||
|
||||
if (len > handle->iso.max_packet_size) {
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* Block until we have space for another packet. */
|
||||
while (handle->iso.packet_count + handle->iso.irq_interval >
|
||||
handle->iso.buf_packets)
|
||||
raw1394_loop_iterate(handle);
|
||||
|
||||
memcpy(handle->iso.head, data, len);
|
||||
if (queue_packet(handle, len, 0, tag, sy) < 0)
|
||||
return -1;
|
||||
|
||||
/* Start the streaming if it's not already running and if
|
||||
* we've buffered up enough packets. */
|
||||
if (handle->iso.prebuffer > 0 &&
|
||||
handle->iso.packet_count >= handle->iso.prebuffer) {
|
||||
/* Set this to 0 to indicate that we're running. */
|
||||
handle->iso.prebuffer = 0;
|
||||
start_iso.cycle = handle->iso.start_on_cycle;
|
||||
start_iso.handle = 0;
|
||||
|
||||
len = ioctl(handle->iso.fd,
|
||||
FW_CDEV_IOC_START_ISO, &start_iso);
|
||||
if (len < 0)
|
||||
return len;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int raw1394_iso_xmit_sync(raw1394handle_t handle)
|
||||
{
|
||||
struct fw_cdev_iso_packet skip;
|
||||
struct fw_cdev_queue_iso queue_iso;
|
||||
int len;
|
||||
|
||||
skip.control = FW_CDEV_ISO_INTERRUPT | FW_CDEV_ISO_SKIP;
|
||||
queue_iso.packets = ptr_to_u64(&skip);
|
||||
queue_iso.size = sizeof skip;
|
||||
queue_iso.data = 0;
|
||||
queue_iso.handle = 0;
|
||||
|
||||
len = ioctl(handle->iso.fd, FW_CDEV_IOC_QUEUE_ISO, &queue_iso);
|
||||
if (len < 0)
|
||||
return -1;
|
||||
|
||||
/* Now that we've queued the skip packet, we'll get an
|
||||
* interrupt when the transmit buffer is flushed, so all we do
|
||||
* here is wait. */
|
||||
while (handle->iso.packet_count > 0)
|
||||
raw1394_loop_iterate(handle);
|
||||
|
||||
/* The iso mainloop thinks that interrutps indicate another
|
||||
* irq_interval number of packets was sent, so the skip
|
||||
* interrupt makes it go out of whack. We just reset it. */
|
||||
handle->iso.head = handle->iso.buffer;
|
||||
handle->iso.tail = handle->iso.buffer;
|
||||
handle->iso.first_payload = handle->iso.buffer;
|
||||
handle->iso.packet_phase = 0;
|
||||
handle->iso.packet_count = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_flush(raw1394handle_t handle)
|
||||
{
|
||||
/* FIXME: huh, we'll need kernel support here... */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static unsigned int
|
||||
round_to_power_of_two(unsigned int value)
|
||||
{
|
||||
unsigned int pot;
|
||||
|
||||
pot = 1;
|
||||
while (pot < value)
|
||||
pot <<= 1;
|
||||
|
||||
return pot;
|
||||
}
|
||||
|
||||
static int
|
||||
iso_init(raw1394handle_t handle, int type,
|
||||
raw1394_iso_xmit_handler_t xmit_handler,
|
||||
raw1394_iso_recv_handler_t recv_handler,
|
||||
unsigned int buf_packets,
|
||||
unsigned int max_packet_size,
|
||||
unsigned char channel,
|
||||
enum raw1394_iso_speed speed,
|
||||
int irq_interval)
|
||||
{
|
||||
struct fw_cdev_create_iso_context create;
|
||||
struct epoll_event ep;
|
||||
int retval, prot;
|
||||
|
||||
if (handle->iso.fd != -1) {
|
||||
errno = EBUSY;
|
||||
return -1;
|
||||
}
|
||||
|
||||
switch (type) {
|
||||
case FW_CDEV_ISO_CONTEXT_TRANSMIT:
|
||||
prot = PROT_READ | PROT_WRITE;
|
||||
break;
|
||||
case FW_CDEV_ISO_CONTEXT_RECEIVE:
|
||||
prot = PROT_READ;
|
||||
break;
|
||||
default:
|
||||
errno = EINVAL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
handle->iso.type = type;
|
||||
if (irq_interval < 0)
|
||||
handle->iso.irq_interval = 256;
|
||||
else
|
||||
handle->iso.irq_interval = irq_interval;
|
||||
handle->iso.xmit_handler = xmit_handler;
|
||||
handle->iso.recv_handler = recv_handler;
|
||||
handle->iso.buf_packets = buf_packets;
|
||||
handle->iso.max_packet_size = round_to_power_of_two(max_packet_size);
|
||||
handle->iso.packet_phase = 0;
|
||||
handle->iso.packet_count = 0;
|
||||
handle->iso.packets =
|
||||
malloc(handle->iso.irq_interval * sizeof handle->iso.packets[0]);
|
||||
if (handle->iso.packets == NULL)
|
||||
return -1;
|
||||
|
||||
handle->iso.fd = open(handle->local_filename, O_RDWR);
|
||||
if (handle->iso.fd < 0) {
|
||||
free(handle->iso.packets);
|
||||
handle->iso.packets = NULL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
handle->iso.closure.func = handle_iso_event;
|
||||
ep.events = EPOLLIN;
|
||||
ep.data.ptr = &handle->iso.closure;
|
||||
if (epoll_ctl(handle->epoll_fd, EPOLL_CTL_ADD,
|
||||
handle->iso.fd, &ep) < 0) {
|
||||
close(handle->iso.fd);
|
||||
free(handle->iso.packets);
|
||||
handle->iso.packets = NULL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
create.type = type;
|
||||
create.channel = channel;
|
||||
create.speed = speed;
|
||||
create.header_size = 4;
|
||||
|
||||
retval = ioctl(handle->iso.fd,
|
||||
FW_CDEV_IOC_CREATE_ISO_CONTEXT, &create);
|
||||
if (retval < 0) {
|
||||
close(handle->iso.fd);
|
||||
free(handle->iso.packets);
|
||||
handle->iso.packets = NULL;
|
||||
return retval;
|
||||
}
|
||||
|
||||
handle->iso.buffer =
|
||||
mmap(NULL, buf_packets * max_packet_size,
|
||||
prot, MAP_SHARED, handle->iso.fd, 0);
|
||||
|
||||
if (handle->iso.buffer == MAP_FAILED) {
|
||||
close(handle->iso.fd);
|
||||
free(handle->iso.packets);
|
||||
handle->iso.packets = NULL;
|
||||
return -1;
|
||||
}
|
||||
|
||||
handle->iso.buffer_end = handle->iso.buffer +
|
||||
buf_packets * max_packet_size;
|
||||
handle->iso.head = handle->iso.buffer;
|
||||
handle->iso.tail = handle->iso.buffer;
|
||||
handle->iso.first_payload = handle->iso.buffer;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int raw1394_iso_xmit_init(raw1394handle_t handle,
|
||||
raw1394_iso_xmit_handler_t handler,
|
||||
unsigned int buf_packets,
|
||||
unsigned int max_packet_size,
|
||||
unsigned char channel,
|
||||
enum raw1394_iso_speed speed,
|
||||
int irq_interval)
|
||||
{
|
||||
return iso_init(handle, FW_CDEV_ISO_CONTEXT_TRANSMIT,
|
||||
handler, NULL, buf_packets, max_packet_size,
|
||||
channel, speed, irq_interval);
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_init(raw1394handle_t handle,
|
||||
raw1394_iso_recv_handler_t handler,
|
||||
unsigned int buf_packets,
|
||||
unsigned int max_packet_size,
|
||||
unsigned char channel,
|
||||
enum raw1394_iso_dma_recv_mode mode,
|
||||
int irq_interval)
|
||||
{
|
||||
return iso_init(handle, FW_CDEV_ISO_CONTEXT_RECEIVE,
|
||||
NULL, handler, buf_packets, max_packet_size,
|
||||
channel, 0, irq_interval);
|
||||
}
|
||||
|
||||
int raw1394_iso_multichannel_recv_init(raw1394handle_t handle,
|
||||
raw1394_iso_recv_handler_t handler,
|
||||
unsigned int buf_packets,
|
||||
unsigned int max_packet_size,
|
||||
int irq_interval)
|
||||
{
|
||||
/* FIXME: gah */
|
||||
errno = ENOSYS;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_listen_channel(raw1394handle_t handle,
|
||||
unsigned char channel)
|
||||
{
|
||||
/* FIXME: multichannel */
|
||||
errno = ENOSYS;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_unlisten_channel(raw1394handle_t handle,
|
||||
unsigned char channel)
|
||||
{
|
||||
/* FIXME: multichannel */
|
||||
errno = ENOSYS;
|
||||
return -1;
|
||||
}
|
||||
|
||||
int raw1394_iso_recv_set_channel_mask(raw1394handle_t handle, u_int64_t mask)
|
||||
{
|
||||
/* FIXME: multichannel */
|
||||
errno = ENOSYS;
|
||||
return -1;
|
||||
}
|
||||
|
||||
void raw1394_iso_stop(raw1394handle_t handle)
|
||||
{
|
||||
struct fw_cdev_stop_iso stop_iso;
|
||||
|
||||
stop_iso.handle = 0;
|
||||
ioctl(handle->iso.fd, FW_CDEV_IOC_STOP_ISO);
|
||||
|
||||
handle->iso.head = handle->iso.buffer;
|
||||
handle->iso.tail = handle->iso.buffer;
|
||||
handle->iso.first_payload = handle->iso.buffer;
|
||||
handle->iso.packet_phase = 0;
|
||||
handle->iso.packet_count = 0;
|
||||
}
|
||||
|
||||
void raw1394_iso_shutdown(raw1394handle_t handle)
|
||||
{
|
||||
munmap(handle->iso.buffer,
|
||||
handle->iso.buf_packets * handle->iso.max_packet_size);
|
||||
close(handle->iso.fd);
|
||||
free(handle->iso.packets);
|
||||
handle->iso.packets = NULL;
|
||||
}
|
||||
File diff suppressed because it is too large
Load Diff
|
|
@ -2,4 +2,4 @@ MAINTAINERCLEANFILES = Makefile.in
|
|||
|
||||
# testlibraw
|
||||
bin_PROGRAMS = testlibraw sendiso dumpiso
|
||||
LDADD = ../src/libraw1394.la
|
||||
LDADD = ../$(LIB_SUBDIR)/libraw1394.la
|
||||
|
|
|
|||
|
|
@ -1,4 +1,5 @@
|
|||
/*
|
||||
/* -*- c-basic-offset: 8 -*-
|
||||
*
|
||||
* libraw1394 - library for raw access to the 1394 bus with the Linux subsystem.
|
||||
*
|
||||
* Copyright (C) 1999,2000 Andreas Bombe
|
||||
|
|
@ -13,12 +14,13 @@
|
|||
#include <string.h>
|
||||
#include <sys/poll.h>
|
||||
#include <stdlib.h>
|
||||
#include <arpa/inet.h>
|
||||
|
||||
#include "../src/raw1394.h"
|
||||
#include "../src/csr.h"
|
||||
|
||||
|
||||
#define TESTADDR (CSR_REGISTER_BASE + CSR_CYCLE_TIME)
|
||||
#define TESTADDR (CSR_REGISTER_BASE + CSR_CONFIG_ROM)
|
||||
|
||||
const char not_compatible[] = "\
|
||||
This libraw1394 does not work with your version of Linux. You need a different\n\
|
||||
|
|
@ -45,12 +47,18 @@ int my_tag_handler(raw1394handle_t handle, unsigned long tag,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static const unsigned char fcp_data[] =
|
||||
{ 0x1, 0x23, 0x45, 0x67, 0x89, 0xab, 0xcd, 0xef };
|
||||
|
||||
int my_fcp_handler(raw1394handle_t handle, nodeid_t nodeid, int response,
|
||||
size_t length, unsigned char *data)
|
||||
{
|
||||
printf("got fcp %s from node %d of %d bytes:",
|
||||
(response ? "response" : "command"), nodeid & 0x3f, length);
|
||||
|
||||
if (memcmp(fcp_data, data, sizeof fcp_data) != 0)
|
||||
printf("ERROR: fcp payload not correct\n");
|
||||
|
||||
while (length) {
|
||||
printf(" %02x", *data);
|
||||
data++;
|
||||
|
|
@ -62,6 +70,47 @@ int my_fcp_handler(raw1394handle_t handle, nodeid_t nodeid, int response,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void
|
||||
test_fcp(raw1394handle_t handle)
|
||||
{
|
||||
printf("\ntesting FCP monitoring on local node\n");
|
||||
raw1394_set_fcp_handler(handle, my_fcp_handler);
|
||||
raw1394_start_fcp_listen(handle);
|
||||
raw1394_write(handle, raw1394_get_local_id(handle),
|
||||
CSR_REGISTER_BASE + CSR_FCP_COMMAND, sizeof(fcp_data),
|
||||
(quadlet_t *)fcp_data);
|
||||
raw1394_write(handle, raw1394_get_local_id(handle),
|
||||
CSR_REGISTER_BASE + CSR_FCP_RESPONSE, sizeof(fcp_data),
|
||||
(quadlet_t *)fcp_data);
|
||||
}
|
||||
|
||||
static void
|
||||
read_topology_map(raw1394handle_t handle)
|
||||
{
|
||||
quadlet_t map[70];
|
||||
nodeid_t local_id;
|
||||
int node_count, self_id_count, i, retval;
|
||||
|
||||
local_id = raw1394_get_local_id(handle) | 0xffc0;
|
||||
|
||||
retval = raw1394_read(handle, local_id,
|
||||
CSR_REGISTER_BASE + CSR_TOPOLOGY_MAP, 12, &map[0]);
|
||||
if (retval < 0)
|
||||
perror("topology map: raw1394_read failed with error");
|
||||
|
||||
self_id_count = ntohl(map[2]) & 0xffff;
|
||||
node_count = ntohl(map[2]) >> 16;
|
||||
retval = raw1394_read(handle, local_id,
|
||||
CSR_REGISTER_BASE + CSR_TOPOLOGY_MAP + 12,
|
||||
self_id_count * sizeof map[0], &map[3]);
|
||||
if (retval < 0)
|
||||
perror("topology map: raw1394_read failed with error");
|
||||
|
||||
printf("topology map: %d nodes, %d self ids, generation %d\n",
|
||||
node_count, self_id_count, ntohl(map[1]));
|
||||
for (i = 0; i < self_id_count; i++)
|
||||
printf(" 0x%08x\n", ntohl(map[3 + i]));
|
||||
}
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
|
|
@ -73,7 +122,6 @@ int main(int argc, char **argv)
|
|||
int retval;
|
||||
|
||||
struct pollfd pfd;
|
||||
unsigned char fcp_test[] = { 0x1, 0x23, 0x45, 0x67, 0x89, 0xab, 0xcd, 0xef };
|
||||
quadlet_t rom[0x100];
|
||||
size_t rom_size;
|
||||
unsigned char rom_version;
|
||||
|
|
@ -150,17 +198,8 @@ int main(int argc, char **argv)
|
|||
}
|
||||
}
|
||||
|
||||
printf("\ntesting FCP monitoring on local node\n");
|
||||
raw1394_set_fcp_handler(handle, my_fcp_handler);
|
||||
raw1394_start_fcp_listen(handle);
|
||||
raw1394_write(handle, raw1394_get_local_id(handle),
|
||||
CSR_REGISTER_BASE + CSR_FCP_COMMAND, sizeof(fcp_test),
|
||||
(quadlet_t *)fcp_test);
|
||||
raw1394_write(handle, raw1394_get_local_id(handle),
|
||||
CSR_REGISTER_BASE + CSR_FCP_RESPONSE, sizeof(fcp_test),
|
||||
(quadlet_t *)fcp_test);
|
||||
|
||||
|
||||
test_fcp(handle);
|
||||
read_topology_map(handle);
|
||||
|
||||
printf("testing config rom stuff\n");
|
||||
retval=raw1394_get_config_rom(handle, rom, 0x100, &rom_size, &rom_version);
|
||||
|
|
@ -176,16 +215,19 @@ int main(int argc, char **argv)
|
|||
retval=raw1394_update_config_rom(handle, rom, rom_size, rom_version);
|
||||
printf("update_config_rom returned %d\n",retval);
|
||||
|
||||
printf("\nposting 0xdeadbeef as an echo request\n");
|
||||
raw1394_echo_request(handle, 0xdeadbeef);
|
||||
|
||||
|
||||
printf("\npolling for leftover messages\n");
|
||||
printf("polling for leftover messages\n");
|
||||
pfd.fd = raw1394_get_fd(handle);
|
||||
pfd.events = POLLIN;
|
||||
pfd.revents = 0;
|
||||
while (1) {
|
||||
retval = poll(&pfd, 1, 10);
|
||||
if (retval < 1) break;
|
||||
raw1394_loop_iterate(handle);
|
||||
retval = raw1394_loop_iterate(handle);
|
||||
if (retval != 0)
|
||||
printf("raw1394_loop_iterate() returned 0x%08x\n", retval);
|
||||
}
|
||||
|
||||
if (retval < 0) perror("poll failed");
|
||||
|
|
|
|||
Reference in New Issue