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