tools/firewire/nosy-dump.c

33 static void print_packet(uint32_t *data, size_t length);
34 static void decode_link_packet(struct link_packet *packet, size_t length,
134 subaction_create(uint32_t *data, size_t length)
139 	sa = malloc(sizeof *sa - sizeof sa->packet + length);
142 	sa->ack = data[length / 4 - 1];
143 	sa->length = length;
144 	memcpy(&sa->packet, data, length);
230 	decode_link_packet(&t->request->packet, t->request->length,
233 		decode_link_packet(&t->response->packet, t->request->length,
240 			print_packet((uint32_t *) &sa->packet, sa->length);
242 			print_packet((uint32_t *) &sa->packet, sa->length);
482 handle_request_packet(uint32_t *data, size_t length)
490 	sa = subaction_create(data, length);
547 handle_response_packet(uint32_t *data, size_t length)
559 	sa = subaction_create(data, length);
619 handle_packet(uint32_t *data, size_t length)
621 	if (length == 0) {
624 	} else if (length > sizeof(struct phy_packet)) {
629 			return handle_request_packet(data, length);
632 			return handle_response_packet(data, length);
665 dump_data(unsigned char *data, int length)
669 	if (length > 128)
672 		print_length = length;
679 	if (print_length < length)
680 		printf(" (%d more bytes)", length - print_length);
684 decode_link_packet(struct link_packet *packet, size_t length,
703 			offset = length * 8 + f->offset - 32;
744 print_packet(uint32_t *data, size_t length)
750 	if (length == 4) {
752 	} else if (length < sizeof(struct phy_packet)) {
754 		for (i = 1; i < length / 4; i++)
758 	} else if (length == sizeof(struct phy_packet) && data[1] == ~data[2]) {
801 			for (i = 1; i < length / 4; i++)
809 		decode_link_packet(packet, length, 0,
815 		dump_data((unsigned char *) data + 4, length - 4);
827 print_stats(uint32_t *data, size_t length)
835 	if (length == 0)
837 	else if (length < sizeof(struct phy_packet))
839 	else if (length == sizeof(struct phy_packet) && data[1] == ~data[2])
899 	int length, retval, view;
975 			if (fread(&length, sizeof length, 1, input) != 1)
977 			fread(buf, 1, length, input);
991 				length = read(fd, buf, sizeof buf);
997 			fwrite(&length, sizeof length, 1, output);
998 			fwrite(buf, 1, length, output);
1003 			handle_packet(buf, length);
1006 			print_packet(buf, length);
1009 			print_stats(buf, length);