|
@@ -6,234 +6,206 @@
|
|
|
#define CSR_FCP_COMMAND 0xfffff0000b00ull
|
|
|
#define CSR_FCP_RESPONSE 0xfffff0000d00ull
|
|
|
|
|
|
-static const char * const ctype_names[16] = {
|
|
|
- "control",
|
|
|
- "status",
|
|
|
- "specific inquiry",
|
|
|
- "notify",
|
|
|
- "general inquiry",
|
|
|
- "(reserved 0x05)",
|
|
|
- "(reserved 0x06)",
|
|
|
- "(reserved 0x07)",
|
|
|
- "not implemented",
|
|
|
- "accepted",
|
|
|
- "rejected",
|
|
|
- "in transition",
|
|
|
- "stable",
|
|
|
- "changed",
|
|
|
- "(reserved 0x0e)",
|
|
|
- "interim"
|
|
|
+static const char * const ctype_names[] = {
|
|
|
+ [0x0] = "control", [0x8] = "not implemented",
|
|
|
+ [0x1] = "status", [0x9] = "accepted",
|
|
|
+ [0x2] = "specific inquiry", [0xa] = "rejected",
|
|
|
+ [0x3] = "notify", [0xb] = "in transition",
|
|
|
+ [0x4] = "general inquiry", [0xc] = "stable",
|
|
|
+ [0x5] = "(reserved 0x05)", [0xd] = "changed",
|
|
|
+ [0x6] = "(reserved 0x06)", [0xe] = "(reserved 0x0e)",
|
|
|
+ [0x7] = "(reserved 0x07)", [0xf] = "interim",
|
|
|
};
|
|
|
|
|
|
-static const char * const subunit_type_names[32] = {
|
|
|
- "monitor",
|
|
|
- "audio",
|
|
|
- "printer",
|
|
|
- "disc",
|
|
|
- "tape recorder/player",
|
|
|
- "tuner",
|
|
|
- "ca",
|
|
|
- "camera",
|
|
|
- "(reserved 0x08)",
|
|
|
- "panel",
|
|
|
- "bulletin board",
|
|
|
- "camera storage",
|
|
|
- "(reserved 0x0c)",
|
|
|
- "(reserved 0x0d)",
|
|
|
- "(reserved 0x0e)",
|
|
|
- "(reserved 0x0f)",
|
|
|
- "(reserved 0x10)",
|
|
|
- "(reserved 0x11)",
|
|
|
- "(reserved 0x12)",
|
|
|
- "(reserved 0x13)",
|
|
|
- "(reserved 0x14)",
|
|
|
- "(reserved 0x15)",
|
|
|
- "(reserved 0x16)",
|
|
|
- "(reserved 0x17)",
|
|
|
- "(reserved 0x18)",
|
|
|
- "(reserved 0x19)",
|
|
|
- "(reserved 0x1a)",
|
|
|
- "(reserved 0x1b)",
|
|
|
- "vendor unique",
|
|
|
- "all subunit types",
|
|
|
- "subunit_type extended to next byte",
|
|
|
- "unit"
|
|
|
+static const char * const subunit_type_names[] = {
|
|
|
+ [0x00] = "monitor", [0x10] = "(reserved 0x10)",
|
|
|
+ [0x01] = "audio", [0x11] = "(reserved 0x11)",
|
|
|
+ [0x02] = "printer", [0x12] = "(reserved 0x12)",
|
|
|
+ [0x03] = "disc", [0x13] = "(reserved 0x13)",
|
|
|
+ [0x04] = "tape recorder/player",[0x14] = "(reserved 0x14)",
|
|
|
+ [0x05] = "tuner", [0x15] = "(reserved 0x15)",
|
|
|
+ [0x06] = "ca", [0x16] = "(reserved 0x16)",
|
|
|
+ [0x07] = "camera", [0x17] = "(reserved 0x17)",
|
|
|
+ [0x08] = "(reserved 0x08)", [0x18] = "(reserved 0x18)",
|
|
|
+ [0x09] = "panel", [0x19] = "(reserved 0x19)",
|
|
|
+ [0x0a] = "bulletin board", [0x1a] = "(reserved 0x1a)",
|
|
|
+ [0x0b] = "camera storage", [0x1b] = "(reserved 0x1b)",
|
|
|
+ [0x0c] = "(reserved 0x0c)", [0x1c] = "vendor unique",
|
|
|
+ [0x0d] = "(reserved 0x0d)", [0x1d] = "all subunit types",
|
|
|
+ [0x0e] = "(reserved 0x0e)", [0x1e] = "subunit_type extended to next byte",
|
|
|
+ [0x0f] = "(reserved 0x0f)", [0x1f] = "unit",
|
|
|
};
|
|
|
|
|
|
struct avc_enum {
|
|
|
- int value;
|
|
|
- const char *name;
|
|
|
+ int value;
|
|
|
+ const char *name;
|
|
|
};
|
|
|
|
|
|
struct avc_field {
|
|
|
- const char *name; /* Short name for field. */
|
|
|
- int offset; /* Location of field, specified in bits.
|
|
|
- * Negative means from end of packet */
|
|
|
- int width; /* Width of field, 0 means use data_length. */
|
|
|
- struct avc_enum *names;
|
|
|
+ const char *name; /* Short name for field. */
|
|
|
+ int offset; /* Location of field, specified in bits; */
|
|
|
+ /* negative means from end of packet. */
|
|
|
+ int width; /* Width of field, 0 means use data_length. */
|
|
|
+ struct avc_enum *names;
|
|
|
};
|
|
|
|
|
|
struct avc_opcode_info {
|
|
|
- const char *name;
|
|
|
- struct avc_field fields[8];
|
|
|
+ const char *name;
|
|
|
+ struct avc_field fields[8];
|
|
|
};
|
|
|
|
|
|
struct avc_enum power_field_names[] = {
|
|
|
- { 0x70, "on" },
|
|
|
- { 0x60, "off" },
|
|
|
- { }
|
|
|
+ { 0x70, "on" },
|
|
|
+ { 0x60, "off" },
|
|
|
+ { }
|
|
|
};
|
|
|
|
|
|
static const struct avc_opcode_info opcode_info[256] = {
|
|
|
|
|
|
- /* TA Document 1999026
|
|
|
- * AV/C Digital Interface Command Set General Specification
|
|
|
- * Version 4.0 */
|
|
|
- [0xb2] =
|
|
|
- { "power", {
|
|
|
- { "state", 0, 8, power_field_names }
|
|
|
- }
|
|
|
- },
|
|
|
- [0x30] =
|
|
|
- { "unit info", {
|
|
|
- { "foo", 0, 8 },
|
|
|
- { "unit_type", 8, 5 },
|
|
|
- { "unit", 13, 3 },
|
|
|
- { "company id", 16, 24 },
|
|
|
- }
|
|
|
- },
|
|
|
- [0x31] = { "subunit info" },
|
|
|
- [0x01] = { "reserve" },
|
|
|
- [0xb0] = { "version" },
|
|
|
- [0x00] = { "vendor dependent" },
|
|
|
-
|
|
|
- [0x02] = { "plug info" },
|
|
|
- [0x12] = { "channel usage" },
|
|
|
- [0x24] = { "connect" },
|
|
|
- [0x20] = { "connect av" },
|
|
|
- [0x22] = { "connections" },
|
|
|
- [0x11] = { "digital input" },
|
|
|
- [0x10] = { "digital output" },
|
|
|
- [0x25] = { "disconnect" },
|
|
|
- [0x21] = { "disconnect av" },
|
|
|
- [0x19] = { "input plug signal format" },
|
|
|
- [0x18] = { "output plug signal format" },
|
|
|
- [0x1f] = { "general bus setup" },
|
|
|
-
|
|
|
- /* TA Document 1999025
|
|
|
- * AV/C Descriptor Mechanism Specification Version 1.0 */
|
|
|
- [0x0c] = { "create descriptor" },
|
|
|
- [0x08] = { "open descriptor" },
|
|
|
- [0x09] = { "read descriptor" },
|
|
|
- [0x0a] = { "write descriptor" },
|
|
|
- [0x05] = { "open info block" },
|
|
|
- [0x06] = { "read info block" },
|
|
|
- [0x07] = { "write info block" },
|
|
|
- [0x0b] = { "search descriptor" },
|
|
|
- [0x0d] = { "object number select" },
|
|
|
-
|
|
|
- /* TA Document 1999015
|
|
|
- * AV/C Command Set for Rate Control of Isochronous Data Flow 1.0 */
|
|
|
- [0xb3] = { "rate", {
|
|
|
- { "subfunction", 0, 8 },
|
|
|
- { "result", 8, 8 },
|
|
|
- { "plug_type", 16, 8 },
|
|
|
- { "plug_id", 16, 8 },
|
|
|
- }
|
|
|
- },
|
|
|
-
|
|
|
- /* TA Document 1999008
|
|
|
- * AV/C Audio Subunit Specification 1.0 */
|
|
|
- [0xb8] = { "function block" },
|
|
|
-
|
|
|
- /* TA Document 2001001
|
|
|
- * AV/C Panel Subunit Specification 1.1 */
|
|
|
- [0x7d] = { "gui update" },
|
|
|
- [0x7e] = { "push gui data" },
|
|
|
- [0x7f] = { "user action" },
|
|
|
- [0x7c] = { "pass through" },
|
|
|
-
|
|
|
- /* */
|
|
|
- [0x26] = { "asynchronous connection" },
|
|
|
+ /* TA Document 1999026 */
|
|
|
+ /* AV/C Digital Interface Command Set General Specification 4.0 */
|
|
|
+ [0xb2] = { "power", {
|
|
|
+ { "state", 0, 8, power_field_names }
|
|
|
+ }
|
|
|
+ },
|
|
|
+ [0x30] = { "unit info", {
|
|
|
+ { "foo", 0, 8 },
|
|
|
+ { "unit_type", 8, 5 },
|
|
|
+ { "unit", 13, 3 },
|
|
|
+ { "company id", 16, 24 },
|
|
|
+ }
|
|
|
+ },
|
|
|
+ [0x31] = { "subunit info" },
|
|
|
+ [0x01] = { "reserve" },
|
|
|
+ [0xb0] = { "version" },
|
|
|
+ [0x00] = { "vendor dependent" },
|
|
|
+ [0x02] = { "plug info" },
|
|
|
+ [0x12] = { "channel usage" },
|
|
|
+ [0x24] = { "connect" },
|
|
|
+ [0x20] = { "connect av" },
|
|
|
+ [0x22] = { "connections" },
|
|
|
+ [0x11] = { "digital input" },
|
|
|
+ [0x10] = { "digital output" },
|
|
|
+ [0x25] = { "disconnect" },
|
|
|
+ [0x21] = { "disconnect av" },
|
|
|
+ [0x19] = { "input plug signal format" },
|
|
|
+ [0x18] = { "output plug signal format" },
|
|
|
+ [0x1f] = { "general bus setup" },
|
|
|
+
|
|
|
+ /* TA Document 1999025 */
|
|
|
+ /* AV/C Descriptor Mechanism Specification Version 1.0 */
|
|
|
+ [0x0c] = { "create descriptor" },
|
|
|
+ [0x08] = { "open descriptor" },
|
|
|
+ [0x09] = { "read descriptor" },
|
|
|
+ [0x0a] = { "write descriptor" },
|
|
|
+ [0x05] = { "open info block" },
|
|
|
+ [0x06] = { "read info block" },
|
|
|
+ [0x07] = { "write info block" },
|
|
|
+ [0x0b] = { "search descriptor" },
|
|
|
+ [0x0d] = { "object number select" },
|
|
|
+
|
|
|
+ /* TA Document 1999015 */
|
|
|
+ /* AV/C Command Set for Rate Control of Isochronous Data Flow 1.0 */
|
|
|
+ [0xb3] = { "rate", {
|
|
|
+ { "subfunction", 0, 8 },
|
|
|
+ { "result", 8, 8 },
|
|
|
+ { "plug_type", 16, 8 },
|
|
|
+ { "plug_id", 16, 8 },
|
|
|
+ }
|
|
|
+ },
|
|
|
+
|
|
|
+ /* TA Document 1999008 */
|
|
|
+ /* AV/C Audio Subunit Specification 1.0 */
|
|
|
+ [0xb8] = { "function block" },
|
|
|
+
|
|
|
+ /* TA Document 2001001 */
|
|
|
+ /* AV/C Panel Subunit Specification 1.1 */
|
|
|
+ [0x7d] = { "gui update" },
|
|
|
+ [0x7e] = { "push gui data" },
|
|
|
+ [0x7f] = { "user action" },
|
|
|
+ [0x7c] = { "pass through" },
|
|
|
+
|
|
|
+ /* */
|
|
|
+ [0x26] = { "asynchronous connection" },
|
|
|
};
|
|
|
|
|
|
struct avc_frame {
|
|
|
- uint32_t operand0:8;
|
|
|
- uint32_t opcode:8;
|
|
|
- uint32_t subunit_id:3;
|
|
|
- uint32_t subunit_type:5;
|
|
|
- uint32_t ctype:4;
|
|
|
- uint32_t cts:4;
|
|
|
+ uint32_t operand0:8;
|
|
|
+ uint32_t opcode:8;
|
|
|
+ uint32_t subunit_id:3;
|
|
|
+ uint32_t subunit_type:5;
|
|
|
+ uint32_t ctype:4;
|
|
|
+ uint32_t cts:4;
|
|
|
};
|
|
|
|
|
|
static void
|
|
|
decode_avc(struct link_transaction *t)
|
|
|
{
|
|
|
- struct avc_frame *frame = (struct avc_frame *) t->request->packet.write_block.data;
|
|
|
- const struct avc_opcode_info *info;
|
|
|
- const char *name;
|
|
|
- char buffer[32];
|
|
|
- int i;
|
|
|
-
|
|
|
- info = &opcode_info[frame->opcode];
|
|
|
- if (info->name == NULL) {
|
|
|
- snprintf(buffer, sizeof buffer, "(unknown opcode 0x%02x)", frame->opcode);
|
|
|
- name = buffer;
|
|
|
- } else {
|
|
|
- name = info->name;
|
|
|
- }
|
|
|
-
|
|
|
- printf("av/c %s, subunit_type=%s, subunit_id=%d, opcode=%s",
|
|
|
- ctype_names[frame->ctype], subunit_type_names[frame->subunit_type],
|
|
|
- frame->subunit_id, name);
|
|
|
-
|
|
|
- for (i = 0; info->fields[i].name != NULL; i++) {
|
|
|
- printf(", %s", info->fields[i].name);
|
|
|
- }
|
|
|
-
|
|
|
- printf("\n");
|
|
|
-}
|
|
|
+ struct avc_frame *frame =
|
|
|
+ (struct avc_frame *) t->request->packet.write_block.data;
|
|
|
+ const struct avc_opcode_info *info;
|
|
|
+ const char *name;
|
|
|
+ char buffer[32];
|
|
|
+ int i;
|
|
|
+
|
|
|
+ info = &opcode_info[frame->opcode];
|
|
|
+ if (info->name == NULL) {
|
|
|
+ snprintf(buffer, sizeof(buffer),
|
|
|
+ "(unknown opcode 0x%02x)", frame->opcode);
|
|
|
+ name = buffer;
|
|
|
+ } else {
|
|
|
+ name = info->name;
|
|
|
+ }
|
|
|
|
|
|
+ printf("av/c %s, subunit_type=%s, subunit_id=%d, opcode=%s",
|
|
|
+ ctype_names[frame->ctype], subunit_type_names[frame->subunit_type],
|
|
|
+ frame->subunit_id, name);
|
|
|
+
|
|
|
+ for (i = 0; info->fields[i].name != NULL; i++)
|
|
|
+ printf(", %s", info->fields[i].name);
|
|
|
+
|
|
|
+ printf("\n");
|
|
|
+}
|
|
|
|
|
|
int
|
|
|
decode_fcp(struct link_transaction *t)
|
|
|
{
|
|
|
- struct avc_frame *frame = (struct avc_frame *) t->request->packet.write_block.data;
|
|
|
- unsigned long long offset;
|
|
|
-
|
|
|
- offset = ((unsigned long long) t->request->packet.common.offset_high << 32) |
|
|
|
- t->request->packet.common.offset_low;
|
|
|
-
|
|
|
- if (t->request->packet.common.tcode != TCODE_WRITE_BLOCK)
|
|
|
- return 0;
|
|
|
-
|
|
|
- if (offset == CSR_FCP_COMMAND || offset == CSR_FCP_RESPONSE) {
|
|
|
- switch (frame->cts) {
|
|
|
- case 0x00:
|
|
|
- decode_avc(t);
|
|
|
- break;
|
|
|
- case 0x01:
|
|
|
- printf("cal fcp frame (cts=0x01)\n");
|
|
|
- break;
|
|
|
- case 0x02:
|
|
|
- printf("ehs fcp frame (cts=0x02)\n");
|
|
|
- break;
|
|
|
- case 0x03:
|
|
|
- printf("havi fcp frame (cts=0x03)\n");
|
|
|
- break;
|
|
|
- case 0x0e:
|
|
|
- printf("vendor specific fcp frame (cts=0x0e)\n");
|
|
|
- break;
|
|
|
- case 0x0f:
|
|
|
- printf("extended cts\n");
|
|
|
- break;
|
|
|
- default:
|
|
|
- printf("reserved fcp frame (ctx=0x%02x)\n", frame->cts);
|
|
|
- break;
|
|
|
+ struct avc_frame *frame =
|
|
|
+ (struct avc_frame *) t->request->packet.write_block.data;
|
|
|
+ unsigned long long offset =
|
|
|
+ ((unsigned long long) t->request->packet.common.offset_high << 32) |
|
|
|
+ t->request->packet.common.offset_low;
|
|
|
+
|
|
|
+ if (t->request->packet.common.tcode != TCODE_WRITE_BLOCK)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ if (offset == CSR_FCP_COMMAND || offset == CSR_FCP_RESPONSE) {
|
|
|
+ switch (frame->cts) {
|
|
|
+ case 0x00:
|
|
|
+ decode_avc(t);
|
|
|
+ break;
|
|
|
+ case 0x01:
|
|
|
+ printf("cal fcp frame (cts=0x01)\n");
|
|
|
+ break;
|
|
|
+ case 0x02:
|
|
|
+ printf("ehs fcp frame (cts=0x02)\n");
|
|
|
+ break;
|
|
|
+ case 0x03:
|
|
|
+ printf("havi fcp frame (cts=0x03)\n");
|
|
|
+ break;
|
|
|
+ case 0x0e:
|
|
|
+ printf("vendor specific fcp frame (cts=0x0e)\n");
|
|
|
+ break;
|
|
|
+ case 0x0f:
|
|
|
+ printf("extended cts\n");
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ printf("reserved fcp frame (ctx=0x%02x)\n", frame->cts);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return 1;
|
|
|
}
|
|
|
- return 1;
|
|
|
- }
|
|
|
|
|
|
- return 0;
|
|
|
+ return 0;
|
|
|
}
|
|
|
|