bebob_command.c (7793B)
1// SPDX-License-Identifier: GPL-2.0-only 2/* 3 * bebob_command.c - driver for BeBoB based devices 4 * 5 * Copyright (c) 2013-2014 Takashi Sakamoto 6 */ 7 8#include "./bebob.h" 9 10int avc_audio_set_selector(struct fw_unit *unit, unsigned int subunit_id, 11 unsigned int fb_id, unsigned int num) 12{ 13 u8 *buf; 14 int err; 15 16 buf = kzalloc(12, GFP_KERNEL); 17 if (buf == NULL) 18 return -ENOMEM; 19 20 buf[0] = 0x00; /* AV/C CONTROL */ 21 buf[1] = 0x08 | (0x07 & subunit_id); /* AUDIO SUBUNIT ID */ 22 buf[2] = 0xb8; /* FUNCTION BLOCK */ 23 buf[3] = 0x80; /* type is 'selector'*/ 24 buf[4] = 0xff & fb_id; /* function block id */ 25 buf[5] = 0x10; /* control attribute is CURRENT */ 26 buf[6] = 0x02; /* selector length is 2 */ 27 buf[7] = 0xff & num; /* input function block plug number */ 28 buf[8] = 0x01; /* control selector is SELECTOR_CONTROL */ 29 30 err = fcp_avc_transaction(unit, buf, 12, buf, 12, 31 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 32 BIT(6) | BIT(7) | BIT(8)); 33 if (err < 0) 34 ; 35 else if (err < 9) 36 err = -EIO; 37 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 38 err = -ENOSYS; 39 else if (buf[0] == 0x0a) /* REJECTED */ 40 err = -EINVAL; 41 else 42 err = 0; 43 44 kfree(buf); 45 return err; 46} 47 48int avc_audio_get_selector(struct fw_unit *unit, unsigned int subunit_id, 49 unsigned int fb_id, unsigned int *num) 50{ 51 u8 *buf; 52 int err; 53 54 buf = kzalloc(12, GFP_KERNEL); 55 if (buf == NULL) 56 return -ENOMEM; 57 58 buf[0] = 0x01; /* AV/C STATUS */ 59 buf[1] = 0x08 | (0x07 & subunit_id); /* AUDIO SUBUNIT ID */ 60 buf[2] = 0xb8; /* FUNCTION BLOCK */ 61 buf[3] = 0x80; /* type is 'selector'*/ 62 buf[4] = 0xff & fb_id; /* function block id */ 63 buf[5] = 0x10; /* control attribute is CURRENT */ 64 buf[6] = 0x02; /* selector length is 2 */ 65 buf[7] = 0xff; /* input function block plug number */ 66 buf[8] = 0x01; /* control selector is SELECTOR_CONTROL */ 67 68 err = fcp_avc_transaction(unit, buf, 12, buf, 12, 69 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 70 BIT(6) | BIT(8)); 71 if (err < 0) 72 ; 73 else if (err < 9) 74 err = -EIO; 75 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 76 err = -ENOSYS; 77 else if (buf[0] == 0x0a) /* REJECTED */ 78 err = -EINVAL; 79 else if (buf[0] == 0x0b) /* IN TRANSITION */ 80 err = -EAGAIN; 81 if (err < 0) 82 goto end; 83 84 *num = buf[7]; 85 err = 0; 86end: 87 kfree(buf); 88 return err; 89} 90 91static inline void 92avc_bridgeco_fill_extension_addr(u8 *buf, u8 *addr) 93{ 94 buf[1] = addr[0]; 95 memcpy(buf + 4, addr + 1, 5); 96} 97 98static inline void 99avc_bridgeco_fill_plug_info_extension_command(u8 *buf, u8 *addr, 100 unsigned int itype) 101{ 102 buf[0] = 0x01; /* AV/C STATUS */ 103 buf[2] = 0x02; /* AV/C GENERAL PLUG INFO */ 104 buf[3] = 0xc0; /* BridgeCo extension */ 105 avc_bridgeco_fill_extension_addr(buf, addr); 106 buf[9] = itype; /* info type */ 107} 108 109int avc_bridgeco_get_plug_type(struct fw_unit *unit, 110 u8 addr[AVC_BRIDGECO_ADDR_BYTES], 111 enum avc_bridgeco_plug_type *type) 112{ 113 u8 *buf; 114 int err; 115 116 buf = kzalloc(12, GFP_KERNEL); 117 if (buf == NULL) 118 return -ENOMEM; 119 120 /* Info type is 'plug type'. */ 121 avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x00); 122 123 err = fcp_avc_transaction(unit, buf, 12, buf, 12, 124 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 125 BIT(6) | BIT(7) | BIT(9)); 126 if (err < 0) 127 ; 128 else if (err < 11) 129 err = -EIO; 130 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 131 err = -ENOSYS; 132 else if (buf[0] == 0x0a) /* REJECTED */ 133 err = -EINVAL; 134 else if (buf[0] == 0x0b) /* IN TRANSITION */ 135 err = -EAGAIN; 136 if (err < 0) 137 goto end; 138 139 *type = buf[10]; 140 err = 0; 141end: 142 kfree(buf); 143 return err; 144} 145 146int avc_bridgeco_get_plug_ch_count(struct fw_unit *unit, u8 addr[AVC_BRIDGECO_ADDR_BYTES], 147 unsigned int *ch_count) 148{ 149 u8 *buf; 150 int err; 151 152 buf = kzalloc(12, GFP_KERNEL); 153 if (buf == NULL) 154 return -ENOMEM; 155 156 // Info type is 'plug type'. 157 avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x02); 158 159 err = fcp_avc_transaction(unit, buf, 12, buf, 12, 160 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 161 BIT(6) | BIT(7) | BIT(9)); 162 if (err < 0) 163 ; 164 else if (err < 11) 165 err = -EIO; 166 else if (buf[0] == 0x08) // NOT IMPLEMENTED 167 err = -ENOSYS; 168 else if (buf[0] == 0x0a) // REJECTED 169 err = -EINVAL; 170 else if (buf[0] == 0x0b) // IN TRANSITION 171 err = -EAGAIN; 172 if (err < 0) 173 goto end; 174 175 *ch_count = buf[10]; 176 err = 0; 177end: 178 kfree(buf); 179 return err; 180} 181 182int avc_bridgeco_get_plug_ch_pos(struct fw_unit *unit, 183 u8 addr[AVC_BRIDGECO_ADDR_BYTES], 184 u8 *buf, unsigned int len) 185{ 186 int err; 187 188 /* Info type is 'channel position'. */ 189 avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x03); 190 191 err = fcp_avc_transaction(unit, buf, 12, buf, 256, 192 BIT(1) | BIT(2) | BIT(3) | BIT(4) | 193 BIT(5) | BIT(6) | BIT(7) | BIT(9)); 194 if (err < 0) 195 ; 196 else if (err < 11) 197 err = -EIO; 198 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 199 err = -ENOSYS; 200 else if (buf[0] == 0x0a) /* REJECTED */ 201 err = -EINVAL; 202 else if (buf[0] == 0x0b) /* IN TRANSITION */ 203 err = -EAGAIN; 204 if (err < 0) 205 goto end; 206 207 /* Pick up specific data. */ 208 memmove(buf, buf + 10, err - 10); 209 err = 0; 210end: 211 return err; 212} 213 214int avc_bridgeco_get_plug_section_type(struct fw_unit *unit, 215 u8 addr[AVC_BRIDGECO_ADDR_BYTES], 216 unsigned int id, u8 *type) 217{ 218 u8 *buf; 219 int err; 220 221 /* section info includes charactors but this module don't need it */ 222 buf = kzalloc(12, GFP_KERNEL); 223 if (buf == NULL) 224 return -ENOMEM; 225 226 /* Info type is 'section info'. */ 227 avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x07); 228 buf[10] = 0xff & ++id; /* section id */ 229 230 err = fcp_avc_transaction(unit, buf, 12, buf, 12, 231 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 232 BIT(6) | BIT(7) | BIT(9) | BIT(10)); 233 if (err < 0) 234 ; 235 else if (err < 12) 236 err = -EIO; 237 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 238 err = -ENOSYS; 239 else if (buf[0] == 0x0a) /* REJECTED */ 240 err = -EINVAL; 241 else if (buf[0] == 0x0b) /* IN TRANSITION */ 242 err = -EAGAIN; 243 if (err < 0) 244 goto end; 245 246 *type = buf[11]; 247 err = 0; 248end: 249 kfree(buf); 250 return err; 251} 252 253int avc_bridgeco_get_plug_input(struct fw_unit *unit, 254 u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 input[7]) 255{ 256 int err; 257 u8 *buf; 258 259 buf = kzalloc(18, GFP_KERNEL); 260 if (buf == NULL) 261 return -ENOMEM; 262 263 /* Info type is 'plug input'. */ 264 avc_bridgeco_fill_plug_info_extension_command(buf, addr, 0x05); 265 266 err = fcp_avc_transaction(unit, buf, 16, buf, 16, 267 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 268 BIT(6) | BIT(7)); 269 if (err < 0) 270 ; 271 else if (err < 16) 272 err = -EIO; 273 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 274 err = -ENOSYS; 275 else if (buf[0] == 0x0a) /* REJECTED */ 276 err = -EINVAL; 277 else if (buf[0] == 0x0b) /* IN TRANSITION */ 278 err = -EAGAIN; 279 if (err < 0) 280 goto end; 281 282 memcpy(input, buf + 10, 5); 283 err = 0; 284end: 285 kfree(buf); 286 return err; 287} 288 289int avc_bridgeco_get_plug_strm_fmt(struct fw_unit *unit, 290 u8 addr[AVC_BRIDGECO_ADDR_BYTES], u8 *buf, 291 unsigned int *len, unsigned int eid) 292{ 293 int err; 294 295 /* check given buffer */ 296 if ((buf == NULL) || (*len < 12)) { 297 err = -EINVAL; 298 goto end; 299 } 300 301 buf[0] = 0x01; /* AV/C STATUS */ 302 buf[2] = 0x2f; /* AV/C STREAM FORMAT SUPPORT */ 303 buf[3] = 0xc1; /* Bridgeco extension - List Request */ 304 avc_bridgeco_fill_extension_addr(buf, addr); 305 buf[10] = 0xff & eid; /* Entry ID */ 306 307 err = fcp_avc_transaction(unit, buf, 12, buf, *len, 308 BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | 309 BIT(6) | BIT(7) | BIT(10)); 310 if (err < 0) 311 ; 312 else if (err < 12) 313 err = -EIO; 314 else if (buf[0] == 0x08) /* NOT IMPLEMENTED */ 315 err = -ENOSYS; 316 else if (buf[0] == 0x0a) /* REJECTED */ 317 err = -EINVAL; 318 else if (buf[0] == 0x0b) /* IN TRANSITION */ 319 err = -EAGAIN; 320 else if (buf[10] != eid) 321 err = -EIO; 322 if (err < 0) 323 goto end; 324 325 /* Pick up 'stream format info'. */ 326 memmove(buf, buf + 11, err - 11); 327 *len = err - 11; 328 err = 0; 329end: 330 return err; 331}