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 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 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