159 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * oxfw_command.c - a part of driver for OXFW970/971 based devices4 *5 * Copyright (c) 2014 Takashi Sakamoto6 */7 8#include "oxfw.h"9 10int 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 else45 err = 0;46 47 kfree(buf);48 49 return err;50}51 52int 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 else62 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;107end:108 return err;109}110 111int 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 else135 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;155end:156 kfree(buf);157 return err;158}159