This repository has been archived on 2022-09-20. You can view files and clone it, but cannot push or open issues or pull requests.
libraw1394/tools/testlibraw.c

172 lines
5.3 KiB
C

/*
* 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 <stdio.h>
#include <errno.h>
#include <string.h>
#include <sys/poll.h>
#include "../src/raw1394.h"
#include "../src/csr.h"
#define TESTADDR (CSR_REGISTER_BASE + CSR_CYCLE_TIME)
const char not_compatible[] = "\
This libraw1394 does not work with your version of Linux. You need a different
version that matches your kernel (see kernel help text for the raw1394 option to
find out which is the correct version).\n";
const char not_loaded[] = "\
This probably means that you don't have raw1394 support in the kernel or that
you haven't loaded the raw1394 module.\n";
quadlet_t buffer;
int my_tag_handler(raw1394handle_t handle, unsigned long tag,
raw1394_errcode_t errcode)
{
int err = raw1394_errcode_to_errno(errcode);
if (err) {
printf("failed with error: %s\n", strerror(err));
} else {
printf("completed with value 0x%08x\n", buffer);
}
return 0;
}
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);
while (length) {
printf(" %02x", *data);
data++;
length--;
}
printf("\n");
return 0;
}
int main(int argc, char **argv)
{
raw1394handle_t handle;
int i, numcards;
struct raw1394_portinfo pinf[16];
tag_handler_t std_handler;
int retval;
struct pollfd pfd;
unsigned char fcp_test[] = { 0x1, 0x23, 0x45, 0x67, 0x89, 0xab, 0xcd, 0xef };
handle = raw1394_new_handle();
if (!handle) {
if (!errno) {
printf(not_compatible);
} else {
perror("couldn't get handle");
printf(not_loaded);
}
exit(1);
}
printf("successfully got handle\n");
printf("current generation number: %d\n", raw1394_get_generation(handle));
numcards = raw1394_get_port_info(handle, pinf, 16);
if (numcards < 0) {
perror("couldn't get card info");
exit(1);
} else {
printf("%d card(s) found\n", numcards);
}
if (!numcards) {
exit(0);
}
for (i = 0; i < numcards; i++) {
printf(" nodes on bus: %2d, card name: %s\n", pinf[i].nodes,
pinf[i].name);
}
if (raw1394_set_port(handle, 0) < 0) {
perror("couldn't set port");
exit(1);
}
printf("using first card found: %d nodes on bus, local ID is %d, IRM is %d\n",
raw1394_get_nodecount(handle),
raw1394_get_local_id(handle) & 0x3f,
raw1394_get_irm_id(handle) & 0x3f);
printf("\ndoing transactions with custom tag handler\n");
std_handler = raw1394_set_tag_handler(handle, my_tag_handler);
for (i = 0; i < pinf[0].nodes; i++) {
printf("trying to send read request to node %d... ", i);
fflush(stdout);
buffer = 0;
if (raw1394_start_read(handle, 0xffc0 | i, TESTADDR, 4,
&buffer, 0) < 0) {
perror("failed");
continue;
}
raw1394_loop_iterate(handle);
}
printf("\nusing standard tag handler and synchronous calls\n");
raw1394_set_tag_handler(handle, std_handler);
for (i = 0; i < pinf[0].nodes; i++) {
printf("trying to read from node %d... ", i);
fflush(stdout);
buffer = 0;
retval = raw1394_read(handle, 0xffc0 | i, TESTADDR, 4, &buffer);
if (retval < 0) {
perror("failed with error");
} else {
printf("completed with value 0x%08x\n", buffer);
}
}
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);
printf("\npolling 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);
}
if (retval < 0) perror("poll failed");
exit(0);
}