#include <byteswap.h>
#include <endian.h>
#include <fcntl.h>
+#include <linux/firewire-constants.h>
#include <poll.h>
#include <popt.h>
#include <signal.h>
};
static int
-handle_packet(uint32_t *data, size_t length)
+handle_request_packet(uint32_t *data, size_t length)
{
- if (length == 0) {
- printf("bus reset\r\n");
- clear_pending_transaction_list();
- } else if (length > sizeof(struct phy_packet)) {
- struct link_packet *p = (struct link_packet *) data;
- struct subaction *sa, *prev;
- struct link_transaction *t;
+ struct link_packet *p = (struct link_packet *) data;
+ struct subaction *sa, *prev;
+ struct link_transaction *t;
- switch (packet_info[p->common.tcode].type) {
- case PACKET_REQUEST:
- t = link_transaction_lookup(p->common.source, p->common.destination,
- p->common.tlabel);
- sa = subaction_create(data, length);
- t->request = sa;
-
- if (!list_empty(&t->request_list)) {
- prev = list_tail(&t->request_list,
- struct subaction, link);
-
- if (!ACK_BUSY(prev->ack)) {
- /*
- * error, we should only see ack_busy_* before the
- * ack_pending/ack_complete -- this is an ack_pending
- * instead (ack_complete would have finished the
- * transaction).
- */
- }
+ t = link_transaction_lookup(p->common.source, p->common.destination,
+ p->common.tlabel);
+ sa = subaction_create(data, length);
+ t->request = sa;
+
+ if (!list_empty(&t->request_list)) {
+ prev = list_tail(&t->request_list,
+ struct subaction, link);
+
+ if (!ACK_BUSY(prev->ack)) {
+ /*
+ * error, we should only see ack_busy_* before the
+ * ack_pending/ack_complete -- this is an ack_pending
+ * instead (ack_complete would have finished the
+ * transaction).
+ */
+ }
- if (prev->packet.common.tcode != sa->packet.common.tcode ||
- prev->packet.common.tlabel != sa->packet.common.tlabel) {
- /* memcmp() ? */
- /* error, these should match for retries. */
- }
- }
+ if (prev->packet.common.tcode != sa->packet.common.tcode ||
+ prev->packet.common.tlabel != sa->packet.common.tlabel) {
+ /* memcmp() ? */
+ /* error, these should match for retries. */
+ }
+ }
- list_append(&t->request_list, &sa->link);
-
- switch (sa->ack) {
- case ACK_COMPLETE:
- if (p->common.tcode != TCODE_WRITE_QUADLET &&
- p->common.tcode != TCODE_WRITE_BLOCK)
- /* error, unified transactions only allowed for write */;
- list_remove(&t->link);
- handle_transaction(t);
- break;
-
- case ACK_NO_ACK:
- case ACK_DATA_ERROR:
- case ACK_TYPE_ERROR:
- list_remove(&t->link);
- handle_transaction(t);
- break;
-
- case ACK_PENDING:
- /* request subaction phase over, wait for response. */
- break;
-
- case ACK_BUSY_X:
- case ACK_BUSY_A:
- case ACK_BUSY_B:
- /* ok, wait for retry. */
- /* check that retry protocol is respected. */
- break;
- }
- break;
+ list_append(&t->request_list, &sa->link);
- case PACKET_RESPONSE:
- t = link_transaction_lookup(p->common.destination, p->common.source,
- p->common.tlabel);
- if (list_empty(&t->request_list)) {
- /* unsolicited response */
- }
+ switch (sa->ack) {
+ case ACK_COMPLETE:
+ if (p->common.tcode != TCODE_WRITE_QUADLET_REQUEST &&
+ p->common.tcode != TCODE_WRITE_BLOCK_REQUEST)
+ /* error, unified transactions only allowed for write */;
+ list_remove(&t->link);
+ handle_transaction(t);
+ break;
- sa = subaction_create(data, length);
- t->response = sa;
+ case ACK_NO_ACK:
+ case ACK_DATA_ERROR:
+ case ACK_TYPE_ERROR:
+ list_remove(&t->link);
+ handle_transaction(t);
+ break;
+
+ case ACK_PENDING:
+ /* request subaction phase over, wait for response. */
+ break;
+
+ case ACK_BUSY_X:
+ case ACK_BUSY_A:
+ case ACK_BUSY_B:
+ /* ok, wait for retry. */
+ /* check that retry protocol is respected. */
+ break;
+ }
- if (!list_empty(&t->response_list)) {
- prev = list_tail(&t->response_list, struct subaction, link);
+ return 1;
+}
- if (!ACK_BUSY(prev->ack)) {
- /*
- * error, we should only see ack_busy_* before the
- * ack_pending/ack_complete
- */
- }
+static int
+handle_response_packet(uint32_t *data, size_t length)
+{
+ struct link_packet *p = (struct link_packet *) data;
+ struct subaction *sa, *prev;
+ struct link_transaction *t;
- if (prev->packet.common.tcode != sa->packet.common.tcode ||
- prev->packet.common.tlabel != sa->packet.common.tlabel) {
- /* use memcmp() instead? */
- /* error, these should match for retries. */
- }
- } else {
- prev = list_tail(&t->request_list, struct subaction, link);
- if (prev->ack != ACK_PENDING) {
- /*
- * error, should not get response unless last request got
- * ack_pending.
- */
- }
+ t = link_transaction_lookup(p->common.destination, p->common.source,
+ p->common.tlabel);
+ if (list_empty(&t->request_list)) {
+ /* unsolicited response */
+ }
- if (packet_info[prev->packet.common.tcode].response_tcode !=
- sa->packet.common.tcode) {
- /* error, tcode mismatch */
- }
- }
+ sa = subaction_create(data, length);
+ t->response = sa;
- list_append(&t->response_list, &sa->link);
-
- switch (sa->ack) {
- case ACK_COMPLETE:
- case ACK_NO_ACK:
- case ACK_DATA_ERROR:
- case ACK_TYPE_ERROR:
- list_remove(&t->link);
- handle_transaction(t);
- /* transaction complete, remove t from pending list. */
- break;
-
- case ACK_PENDING:
- /* error for responses. */
- break;
-
- case ACK_BUSY_X:
- case ACK_BUSY_A:
- case ACK_BUSY_B:
- /* no problem, wait for next retry */
- break;
- }
+ if (!list_empty(&t->response_list)) {
+ prev = list_tail(&t->response_list, struct subaction, link);
- break;
+ if (!ACK_BUSY(prev->ack)) {
+ /*
+ * error, we should only see ack_busy_* before the
+ * ack_pending/ack_complete
+ */
+ }
+
+ if (prev->packet.common.tcode != sa->packet.common.tcode ||
+ prev->packet.common.tlabel != sa->packet.common.tlabel) {
+ /* use memcmp() instead? */
+ /* error, these should match for retries. */
+ }
+ } else {
+ prev = list_tail(&t->request_list, struct subaction, link);
+ if (prev->ack != ACK_PENDING) {
+ /*
+ * error, should not get response unless last request got
+ * ack_pending.
+ */
+ }
+
+ if (packet_info[prev->packet.common.tcode].response_tcode !=
+ sa->packet.common.tcode) {
+ /* error, tcode mismatch */
+ }
+ }
+
+ list_append(&t->response_list, &sa->link);
+
+ switch (sa->ack) {
+ case ACK_COMPLETE:
+ case ACK_NO_ACK:
+ case ACK_DATA_ERROR:
+ case ACK_TYPE_ERROR:
+ list_remove(&t->link);
+ handle_transaction(t);
+ /* transaction complete, remove t from pending list. */
+ break;
+
+ case ACK_PENDING:
+ /* error for responses. */
+ break;
+
+ case ACK_BUSY_X:
+ case ACK_BUSY_A:
+ case ACK_BUSY_B:
+ /* no problem, wait for next retry */
+ break;
+ }
+
+ return 1;
+}
+
+static int
+handle_packet(uint32_t *data, size_t length)
+{
+ if (length == 0) {
+ printf("bus reset\r\n");
+ clear_pending_transaction_list();
+ } else if (length > sizeof(struct phy_packet)) {
+ struct link_packet *p = (struct link_packet *) data;
+
+ switch (packet_info[p->common.tcode].type) {
+ case PACKET_REQUEST:
+ return handle_request_packet(data, length);
+
+ case PACKET_RESPONSE:
+ return handle_response_packet(data, length);
case PACKET_OTHER:
case PACKET_RESERVED:
int main(int argc, const char *argv[])
{
+ uint32_t buf[128 * 1024];
+ uint32_t filter;
+ int length, retval, view;
int fd = -1;
FILE *output = NULL, *input = NULL;
poptContext con;
- int retval;
- int view;
char c;
struct pollfd pollfds[2];
setvbuf(stdout, NULL, _IOLBF, BUFSIZ);
- if (1) {
- uint32_t buf[128 * 1024];
- uint32_t filter;
- int length;
+ filter = ~0;
+ if (!option_iso)
+ filter &= ~(1 << TCODE_STREAM_DATA);
+ if (!option_cycle_start)
+ filter &= ~(1 << TCODE_CYCLE_START);
+ if (view == VIEW_STATS)
+ filter = ~(1 << TCODE_CYCLE_START);
- filter = ~0;
- if (!option_iso)
- filter &= ~(1 << TCODE_ISO_DATA);
- if (!option_cycle_start)
- filter &= ~(1 << TCODE_CYCLE_START);
- if (view == VIEW_STATS)
- filter = ~(1 << TCODE_CYCLE_START);
+ ioctl(fd, NOSY_IOC_FILTER, filter);
- ioctl(fd, NOSY_IOC_FILTER, filter);
+ ioctl(fd, NOSY_IOC_START);
- ioctl(fd, NOSY_IOC_START);
+ pollfds[0].fd = fd;
+ pollfds[0].events = POLLIN;
+ pollfds[1].fd = STDIN_FILENO;
+ pollfds[1].events = POLLIN;
- pollfds[0].fd = fd;
- pollfds[0].events = POLLIN;
- pollfds[1].fd = STDIN_FILENO;
- pollfds[1].events = POLLIN;
-
- while (run) {
- if (input != NULL) {
- if (fread(&length, sizeof length, 1, input) != 1)
+ while (run) {
+ if (input != NULL) {
+ if (fread(&length, sizeof length, 1, input) != 1)
+ return 0;
+ fread(buf, 1, length, input);
+ } else {
+ poll(pollfds, 2, -1);
+ if (pollfds[1].revents) {
+ read(STDIN_FILENO, &c, sizeof c);
+ switch (c) {
+ case 'q':
+ if (output != NULL)
+ fclose(output);
return 0;
- fread(buf, 1, length, input);
- } else {
- poll(pollfds, 2, -1);
- if (pollfds[1].revents) {
- read(STDIN_FILENO, &c, sizeof c);
- switch (c) {
- case 'q':
- if (output != NULL)
- fclose(output);
- return 0;
- }
}
-
- if (pollfds[0].revents)
- length = read(fd, buf, sizeof buf);
- else
- continue;
}
- if (output != NULL) {
- fwrite(&length, sizeof length, 1, output);
- fwrite(buf, 1, length, output);
- }
+ if (pollfds[0].revents)
+ length = read(fd, buf, sizeof buf);
+ else
+ continue;
+ }
- switch (view) {
- case VIEW_TRANSACTION:
- handle_packet(buf, length);
- break;
- case VIEW_PACKET:
- print_packet(buf, length);
- break;
- case VIEW_STATS:
- print_stats(buf, length);
- break;
- }
+ if (output != NULL) {
+ fwrite(&length, sizeof length, 1, output);
+ fwrite(buf, 1, length, output);
+ }
+
+ switch (view) {
+ case VIEW_TRANSACTION:
+ handle_packet(buf, length);
+ break;
+ case VIEW_PACKET:
+ print_packet(buf, length);
+ break;
+ case VIEW_STATS:
+ print_stats(buf, length);
+ break;
}
- } else {
- poptPrintUsage(con, stdout, 0);
}
if (output != NULL)
projects / ~andy / linux / blobdiff