1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * oxfw_command.c - a part of driver for OXFW970/971 based devices
4 *
5 * Copyright (c) 2014 Takashi Sakamoto
6 */
7
8 #include "oxfw.h"
9
avc_stream_set_format(struct fw_unit * unit,enum avc_general_plug_dir dir,unsigned int pid,u8 * format,unsigned int len)10 int avc_stream_set_format(struct fw_unit *unit, enum avc_general_plug_dir dir,
11 unsigned int pid, u8 *format, unsigned int len)
12 {
13 u8 *buf;
14 int err;
15
16 buf = kmalloc(len + 10, GFP_KERNEL);
17 if (buf == NULL)
18 return -ENOMEM;
19
20 buf[0] = 0x00; /* CONTROL */
21 buf[1] = 0xff; /* UNIT */
22 buf[2] = 0xbf; /* EXTENDED STREAM FORMAT INFORMATION */
23 buf[3] = 0xc0; /* SINGLE subfunction */
24 buf[4] = dir; /* Plug Direction */
25 buf[5] = 0x00; /* UNIT */
26 buf[6] = 0x00; /* PCR (Isochronous Plug) */
27 buf[7] = 0xff & pid; /* Plug ID */
28 buf[8] = 0xff; /* Padding */
29 buf[9] = 0xff; /* Support status in response */
30 memcpy(buf + 10, format, len);
31
32 /* do transaction and check buf[1-8] are the same against command */
33 err = fcp_avc_transaction(unit, buf, len + 10, buf, len + 10,
34 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
35 BIT(6) | BIT(7) | BIT(8));
36 if (err < 0)
37 ;
38 else if (err < len + 10)
39 err = -EIO;
40 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
41 err = -ENXIO;
42 else if (buf[0] == 0x0a) /* REJECTED */
43 err = -EINVAL;
44 else
45 err = 0;
46
47 kfree(buf);
48
49 return err;
50 }
51
avc_stream_get_format(struct fw_unit * unit,enum avc_general_plug_dir dir,unsigned int pid,u8 * buf,unsigned int * len,unsigned int eid)52 int avc_stream_get_format(struct fw_unit *unit,
53 enum avc_general_plug_dir dir, unsigned int pid,
54 u8 *buf, unsigned int *len, unsigned int eid)
55 {
56 unsigned int subfunc;
57 int err;
58
59 if (eid == 0xff)
60 subfunc = 0xc0; /* SINGLE */
61 else
62 subfunc = 0xc1; /* LIST */
63
64 buf[0] = 0x01; /* STATUS */
65 buf[1] = 0xff; /* UNIT */
66 buf[2] = 0xbf; /* EXTENDED STREAM FORMAT INFORMATION */
67 buf[3] = subfunc; /* SINGLE or LIST */
68 buf[4] = dir; /* Plug Direction */
69 buf[5] = 0x00; /* Unit */
70 buf[6] = 0x00; /* PCR (Isochronous Plug) */
71 buf[7] = 0xff & pid; /* Plug ID */
72 buf[8] = 0xff; /* Padding */
73 buf[9] = 0xff; /* support status in response */
74 buf[10] = 0xff & eid; /* entry ID for LIST subfunction */
75 buf[11] = 0xff; /* padding */
76
77 /* do transaction and check buf[1-7] are the same against command */
78 err = fcp_avc_transaction(unit, buf, 12, buf, *len,
79 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
80 BIT(6) | BIT(7));
81 if (err < 0)
82 ;
83 else if (err < 12)
84 err = -EIO;
85 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
86 err = -ENXIO;
87 else if (buf[0] == 0x0a) /* REJECTED */
88 err = -EINVAL;
89 else if (buf[0] == 0x0b) /* IN TRANSITION */
90 err = -EAGAIN;
91 /* LIST subfunction has entry ID */
92 else if ((subfunc == 0xc1) && (buf[10] != eid))
93 err = -EIO;
94 if (err < 0)
95 goto end;
96
97 /* keep just stream format information */
98 if (subfunc == 0xc0) {
99 memmove(buf, buf + 10, err - 10);
100 *len = err - 10;
101 } else {
102 memmove(buf, buf + 11, err - 11);
103 *len = err - 11;
104 }
105
106 err = 0;
107 end:
108 return err;
109 }
110
avc_general_inquiry_sig_fmt(struct fw_unit * unit,unsigned int rate,enum avc_general_plug_dir dir,unsigned short pid)111 int avc_general_inquiry_sig_fmt(struct fw_unit *unit, unsigned int rate,
112 enum avc_general_plug_dir dir,
113 unsigned short pid)
114 {
115 unsigned int sfc;
116 u8 *buf;
117 int err;
118
119 for (sfc = 0; sfc < CIP_SFC_COUNT; sfc++) {
120 if (amdtp_rate_table[sfc] == rate)
121 break;
122 }
123 if (sfc == CIP_SFC_COUNT)
124 return -EINVAL;
125
126 buf = kzalloc(8, GFP_KERNEL);
127 if (buf == NULL)
128 return -ENOMEM;
129
130 buf[0] = 0x02; /* SPECIFIC INQUIRY */
131 buf[1] = 0xff; /* UNIT */
132 if (dir == AVC_GENERAL_PLUG_DIR_IN)
133 buf[2] = 0x19; /* INPUT PLUG SIGNAL FORMAT */
134 else
135 buf[2] = 0x18; /* OUTPUT PLUG SIGNAL FORMAT */
136 buf[3] = 0xff & pid; /* plug id */
137 buf[4] = 0x90; /* EOH_1, Form_1, FMT. AM824 */
138 buf[5] = 0x07 & sfc; /* FDF-hi. AM824, frequency */
139 buf[6] = 0xff; /* FDF-mid. AM824, SYT hi (not used) */
140 buf[7] = 0xff; /* FDF-low. AM824, SYT lo (not used) */
141
142 /* do transaction and check buf[1-5] are the same against command */
143 err = fcp_avc_transaction(unit, buf, 8, buf, 8,
144 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5));
145 if (err < 0)
146 ;
147 else if (err < 8)
148 err = -EIO;
149 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
150 err = -ENXIO;
151 if (err < 0)
152 goto end;
153
154 err = 0;
155 end:
156 kfree(buf);
157 return err;
158 }
159