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