• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 #include <linux/firewire-constants.h>
2 #include <stdio.h>
3 #include <stdlib.h>
4 
5 #include "list.h"
6 #include "nosy-dump.h"
7 
8 #define CSR_FCP_COMMAND			0xfffff0000b00ull
9 #define CSR_FCP_RESPONSE		0xfffff0000d00ull
10 
11 static const char * const ctype_names[] = {
12 	[0x0] = "control",		[0x8] = "not implemented",
13 	[0x1] = "status",		[0x9] = "accepted",
14 	[0x2] = "specific inquiry",	[0xa] = "rejected",
15 	[0x3] = "notify",		[0xb] = "in transition",
16 	[0x4] = "general inquiry",	[0xc] = "stable",
17 	[0x5] = "(reserved 0x05)",	[0xd] = "changed",
18 	[0x6] = "(reserved 0x06)",	[0xe] = "(reserved 0x0e)",
19 	[0x7] = "(reserved 0x07)",	[0xf] = "interim",
20 };
21 
22 static const char * const subunit_type_names[] = {
23 	[0x00] = "monitor",		[0x10] = "(reserved 0x10)",
24 	[0x01] = "audio",		[0x11] = "(reserved 0x11)",
25 	[0x02] = "printer",		[0x12] = "(reserved 0x12)",
26 	[0x03] = "disc",		[0x13] = "(reserved 0x13)",
27 	[0x04] = "tape recorder/player",[0x14] = "(reserved 0x14)",
28 	[0x05] = "tuner",		[0x15] = "(reserved 0x15)",
29 	[0x06] = "ca",			[0x16] = "(reserved 0x16)",
30 	[0x07] = "camera",		[0x17] = "(reserved 0x17)",
31 	[0x08] = "(reserved 0x08)",	[0x18] = "(reserved 0x18)",
32 	[0x09] = "panel",		[0x19] = "(reserved 0x19)",
33 	[0x0a] = "bulletin board",	[0x1a] = "(reserved 0x1a)",
34 	[0x0b] = "camera storage",	[0x1b] = "(reserved 0x1b)",
35 	[0x0c] = "(reserved 0x0c)",	[0x1c] = "vendor unique",
36 	[0x0d] = "(reserved 0x0d)",	[0x1d] = "all subunit types",
37 	[0x0e] = "(reserved 0x0e)",	[0x1e] = "subunit_type extended to next byte",
38 	[0x0f] = "(reserved 0x0f)",	[0x1f] = "unit",
39 };
40 
41 struct avc_enum {
42 	int value;
43 	const char *name;
44 };
45 
46 struct avc_field {
47 	const char *name;	/* Short name for field. */
48 	int offset;		/* Location of field, specified in bits; */
49 				/* negative means from end of packet.    */
50 	int width;		/* Width of field, 0 means use data_length. */
51 	struct avc_enum *names;
52 };
53 
54 struct avc_opcode_info {
55 	const char *name;
56 	struct avc_field fields[8];
57 };
58 
59 struct avc_enum power_field_names[] = {
60 	{ 0x70, "on" },
61 	{ 0x60, "off" },
62 	{ }
63 };
64 
65 static const struct avc_opcode_info opcode_info[256] = {
66 
67 	/* TA Document 1999026 */
68 	/* AV/C Digital Interface Command Set General Specification 4.0 */
69 	[0xb2] = { "power", {
70 			{ "state", 0, 8, power_field_names }
71 		}
72 	},
73 	[0x30] = { "unit info", {
74 			{ "foo", 0, 8 },
75 			{ "unit_type", 8, 5 },
76 			{ "unit", 13, 3 },
77 			{ "company id", 16, 24 },
78 		}
79 	},
80 	[0x31] = { "subunit info" },
81 	[0x01] = { "reserve" },
82 	[0xb0] = { "version" },
83 	[0x00] = { "vendor dependent" },
84 	[0x02] = { "plug info" },
85 	[0x12] = { "channel usage" },
86 	[0x24] = { "connect" },
87 	[0x20] = { "connect av" },
88 	[0x22] = { "connections" },
89 	[0x11] = { "digital input" },
90 	[0x10] = { "digital output" },
91 	[0x25] = { "disconnect" },
92 	[0x21] = { "disconnect av" },
93 	[0x19] = { "input plug signal format" },
94 	[0x18] = { "output plug signal format" },
95 	[0x1f] = { "general bus setup" },
96 
97 	/* TA Document 1999025 */
98 	/* AV/C Descriptor Mechanism Specification Version 1.0 */
99 	[0x0c] = { "create descriptor" },
100 	[0x08] = { "open descriptor" },
101 	[0x09] = { "read descriptor" },
102 	[0x0a] = { "write descriptor" },
103 	[0x05] = { "open info block" },
104 	[0x06] = { "read info block" },
105 	[0x07] = { "write info block" },
106 	[0x0b] = { "search descriptor" },
107 	[0x0d] = { "object number select" },
108 
109 	/* TA Document 1999015 */
110 	/* AV/C Command Set for Rate Control of Isochronous Data Flow 1.0 */
111 	[0xb3] = { "rate", {
112 			{ "subfunction", 0, 8 },
113 			{ "result", 8, 8 },
114 			{ "plug_type", 16, 8 },
115 			{ "plug_id", 16, 8 },
116 		}
117 	},
118 
119 	/* TA Document 1999008 */
120 	/* AV/C Audio Subunit Specification 1.0 */
121 	[0xb8] = { "function block" },
122 
123 	/* TA Document 2001001 */
124 	/* AV/C Panel Subunit Specification 1.1 */
125 	[0x7d] = { "gui update" },
126 	[0x7e] = { "push gui data" },
127 	[0x7f] = { "user action" },
128 	[0x7c] = { "pass through" },
129 
130 	/* */
131 	[0x26] = { "asynchronous connection" },
132 };
133 
134 struct avc_frame {
135 	uint32_t operand0:8;
136 	uint32_t opcode:8;
137 	uint32_t subunit_id:3;
138 	uint32_t subunit_type:5;
139 	uint32_t ctype:4;
140 	uint32_t cts:4;
141 };
142 
143 static void
decode_avc(struct link_transaction * t)144 decode_avc(struct link_transaction *t)
145 {
146 	struct avc_frame *frame =
147 	    (struct avc_frame *) t->request->packet.write_block.data;
148 	const struct avc_opcode_info *info;
149 	const char *name;
150 	char buffer[32];
151 	int i;
152 
153 	info = &opcode_info[frame->opcode];
154 	if (info->name == NULL) {
155 		snprintf(buffer, sizeof(buffer),
156 			 "(unknown opcode 0x%02x)", frame->opcode);
157 		name = buffer;
158 	} else {
159 		name = info->name;
160 	}
161 
162 	printf("av/c %s, subunit_type=%s, subunit_id=%d, opcode=%s",
163 	    ctype_names[frame->ctype], subunit_type_names[frame->subunit_type],
164 	    frame->subunit_id, name);
165 
166 	for (i = 0; info->fields[i].name != NULL; i++)
167 		printf(", %s", info->fields[i].name);
168 
169 	printf("\n");
170 }
171 
172 int
decode_fcp(struct link_transaction * t)173 decode_fcp(struct link_transaction *t)
174 {
175 	struct avc_frame *frame =
176 	    (struct avc_frame *) t->request->packet.write_block.data;
177 	unsigned long long offset =
178 	    ((unsigned long long) t->request->packet.common.offset_high << 32) |
179 	    t->request->packet.common.offset_low;
180 
181 	if (t->request->packet.common.tcode != TCODE_WRITE_BLOCK_REQUEST)
182 		return 0;
183 
184 	if (offset == CSR_FCP_COMMAND || offset == CSR_FCP_RESPONSE) {
185 		switch (frame->cts) {
186 		case 0x00:
187 			decode_avc(t);
188 			break;
189 		case 0x01:
190 			printf("cal fcp frame (cts=0x01)\n");
191 			break;
192 		case 0x02:
193 			printf("ehs fcp frame (cts=0x02)\n");
194 			break;
195 		case 0x03:
196 			printf("havi fcp frame (cts=0x03)\n");
197 			break;
198 		case 0x0e:
199 			printf("vendor specific fcp frame (cts=0x0e)\n");
200 			break;
201 		case 0x0f:
202 			printf("extended cts\n");
203 			break;
204 		default:
205 			printf("reserved fcp frame (ctx=0x%02x)\n", frame->cts);
206 			break;
207 		}
208 		return 1;
209 	}
210 
211 	return 0;
212 }
213 
214