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