1da607e19SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
25b59d809STakashi Sakamoto /*
35b59d809STakashi Sakamoto * oxfw_command.c - a part of driver for OXFW970/971 based devices
45b59d809STakashi Sakamoto *
55b59d809STakashi Sakamoto * Copyright (c) 2014 Takashi Sakamoto
65b59d809STakashi Sakamoto */
75b59d809STakashi Sakamoto
85b59d809STakashi Sakamoto #include "oxfw.h"
95b59d809STakashi Sakamoto
avc_stream_set_format(struct fw_unit * unit,enum avc_general_plug_dir dir,unsigned int pid,u8 * format,unsigned int len)105b59d809STakashi Sakamoto int avc_stream_set_format(struct fw_unit *unit, enum avc_general_plug_dir dir,
115b59d809STakashi Sakamoto unsigned int pid, u8 *format, unsigned int len)
125b59d809STakashi Sakamoto {
135b59d809STakashi Sakamoto u8 *buf;
145b59d809STakashi Sakamoto int err;
155b59d809STakashi Sakamoto
165b59d809STakashi Sakamoto buf = kmalloc(len + 10, GFP_KERNEL);
175b59d809STakashi Sakamoto if (buf == NULL)
185b59d809STakashi Sakamoto return -ENOMEM;
195b59d809STakashi Sakamoto
205b59d809STakashi Sakamoto buf[0] = 0x00; /* CONTROL */
215b59d809STakashi Sakamoto buf[1] = 0xff; /* UNIT */
225b59d809STakashi Sakamoto buf[2] = 0xbf; /* EXTENDED STREAM FORMAT INFORMATION */
235b59d809STakashi Sakamoto buf[3] = 0xc0; /* SINGLE subfunction */
245b59d809STakashi Sakamoto buf[4] = dir; /* Plug Direction */
255b59d809STakashi Sakamoto buf[5] = 0x00; /* UNIT */
265b59d809STakashi Sakamoto buf[6] = 0x00; /* PCR (Isochronous Plug) */
275b59d809STakashi Sakamoto buf[7] = 0xff & pid; /* Plug ID */
285b59d809STakashi Sakamoto buf[8] = 0xff; /* Padding */
295b59d809STakashi Sakamoto buf[9] = 0xff; /* Support status in response */
305b59d809STakashi Sakamoto memcpy(buf + 10, format, len);
315b59d809STakashi Sakamoto
325b59d809STakashi Sakamoto /* do transaction and check buf[1-8] are the same against command */
335b59d809STakashi Sakamoto err = fcp_avc_transaction(unit, buf, len + 10, buf, len + 10,
345b59d809STakashi Sakamoto BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
355b59d809STakashi Sakamoto BIT(6) | BIT(7) | BIT(8));
367e1621deSTakashi Sakamoto if (err < 0)
377e1621deSTakashi Sakamoto ;
387e1621deSTakashi Sakamoto else if (err < len + 10)
395b59d809STakashi Sakamoto err = -EIO;
405b59d809STakashi Sakamoto else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
4103be63b2STakashi Sakamoto err = -ENXIO;
425b59d809STakashi Sakamoto else if (buf[0] == 0x0a) /* REJECTED */
435b59d809STakashi Sakamoto err = -EINVAL;
445b59d809STakashi Sakamoto else
455b59d809STakashi Sakamoto err = 0;
465b59d809STakashi Sakamoto
475b59d809STakashi Sakamoto kfree(buf);
485b59d809STakashi Sakamoto
495b59d809STakashi Sakamoto return err;
505b59d809STakashi Sakamoto }
515b59d809STakashi Sakamoto
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)525b59d809STakashi Sakamoto int avc_stream_get_format(struct fw_unit *unit,
535b59d809STakashi Sakamoto enum avc_general_plug_dir dir, unsigned int pid,
545b59d809STakashi Sakamoto u8 *buf, unsigned int *len, unsigned int eid)
555b59d809STakashi Sakamoto {
565b59d809STakashi Sakamoto unsigned int subfunc;
575b59d809STakashi Sakamoto int err;
585b59d809STakashi Sakamoto
595b59d809STakashi Sakamoto if (eid == 0xff)
605b59d809STakashi Sakamoto subfunc = 0xc0; /* SINGLE */
615b59d809STakashi Sakamoto else
625b59d809STakashi Sakamoto subfunc = 0xc1; /* LIST */
635b59d809STakashi Sakamoto
645b59d809STakashi Sakamoto buf[0] = 0x01; /* STATUS */
655b59d809STakashi Sakamoto buf[1] = 0xff; /* UNIT */
665b59d809STakashi Sakamoto buf[2] = 0xbf; /* EXTENDED STREAM FORMAT INFORMATION */
675b59d809STakashi Sakamoto buf[3] = subfunc; /* SINGLE or LIST */
685b59d809STakashi Sakamoto buf[4] = dir; /* Plug Direction */
695b59d809STakashi Sakamoto buf[5] = 0x00; /* Unit */
705b59d809STakashi Sakamoto buf[6] = 0x00; /* PCR (Isochronous Plug) */
715b59d809STakashi Sakamoto buf[7] = 0xff & pid; /* Plug ID */
725b59d809STakashi Sakamoto buf[8] = 0xff; /* Padding */
735b59d809STakashi Sakamoto buf[9] = 0xff; /* support status in response */
745b59d809STakashi Sakamoto buf[10] = 0xff & eid; /* entry ID for LIST subfunction */
755b59d809STakashi Sakamoto buf[11] = 0xff; /* padding */
765b59d809STakashi Sakamoto
775b59d809STakashi Sakamoto /* do transaction and check buf[1-7] are the same against command */
785b59d809STakashi Sakamoto err = fcp_avc_transaction(unit, buf, 12, buf, *len,
795b59d809STakashi Sakamoto BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) |
805b59d809STakashi Sakamoto BIT(6) | BIT(7));
817e1621deSTakashi Sakamoto if (err < 0)
827e1621deSTakashi Sakamoto ;
837e1621deSTakashi Sakamoto else if (err < 12)
845b59d809STakashi Sakamoto err = -EIO;
855b59d809STakashi Sakamoto else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
8603be63b2STakashi Sakamoto err = -ENXIO;
875b59d809STakashi Sakamoto else if (buf[0] == 0x0a) /* REJECTED */
885b59d809STakashi Sakamoto err = -EINVAL;
895b59d809STakashi Sakamoto else if (buf[0] == 0x0b) /* IN TRANSITION */
905b59d809STakashi Sakamoto err = -EAGAIN;
915b59d809STakashi Sakamoto /* LIST subfunction has entry ID */
925b59d809STakashi Sakamoto else if ((subfunc == 0xc1) && (buf[10] != eid))
935b59d809STakashi Sakamoto err = -EIO;
945b59d809STakashi Sakamoto if (err < 0)
955b59d809STakashi Sakamoto goto end;
965b59d809STakashi Sakamoto
975b59d809STakashi Sakamoto /* keep just stream format information */
985b59d809STakashi Sakamoto if (subfunc == 0xc0) {
995b59d809STakashi Sakamoto memmove(buf, buf + 10, err - 10);
1005b59d809STakashi Sakamoto *len = err - 10;
1015b59d809STakashi Sakamoto } else {
1025b59d809STakashi Sakamoto memmove(buf, buf + 11, err - 11);
1035b59d809STakashi Sakamoto *len = err - 11;
1045b59d809STakashi Sakamoto }
1055b59d809STakashi Sakamoto
1065b59d809STakashi Sakamoto err = 0;
1075b59d809STakashi Sakamoto end:
1085b59d809STakashi Sakamoto return err;
1095b59d809STakashi Sakamoto }
1105b59d809STakashi Sakamoto
avc_general_inquiry_sig_fmt(struct fw_unit * unit,unsigned int rate,enum avc_general_plug_dir dir,unsigned short pid)1115b59d809STakashi Sakamoto int avc_general_inquiry_sig_fmt(struct fw_unit *unit, unsigned int rate,
1125b59d809STakashi Sakamoto enum avc_general_plug_dir dir,
1135b59d809STakashi Sakamoto unsigned short pid)
1145b59d809STakashi Sakamoto {
1155b59d809STakashi Sakamoto unsigned int sfc;
1165b59d809STakashi Sakamoto u8 *buf;
1175b59d809STakashi Sakamoto int err;
1185b59d809STakashi Sakamoto
1195b59d809STakashi Sakamoto for (sfc = 0; sfc < CIP_SFC_COUNT; sfc++) {
1205b59d809STakashi Sakamoto if (amdtp_rate_table[sfc] == rate)
1215b59d809STakashi Sakamoto break;
1225b59d809STakashi Sakamoto }
1235b59d809STakashi Sakamoto if (sfc == CIP_SFC_COUNT)
1245b59d809STakashi Sakamoto return -EINVAL;
1255b59d809STakashi Sakamoto
1265b59d809STakashi Sakamoto buf = kzalloc(8, GFP_KERNEL);
1275b59d809STakashi Sakamoto if (buf == NULL)
1285b59d809STakashi Sakamoto return -ENOMEM;
1295b59d809STakashi Sakamoto
1305b59d809STakashi Sakamoto buf[0] = 0x02; /* SPECIFIC INQUIRY */
1315b59d809STakashi Sakamoto buf[1] = 0xff; /* UNIT */
1325b59d809STakashi Sakamoto if (dir == AVC_GENERAL_PLUG_DIR_IN)
1335b59d809STakashi Sakamoto buf[2] = 0x19; /* INPUT PLUG SIGNAL FORMAT */
1345b59d809STakashi Sakamoto else
1355b59d809STakashi Sakamoto buf[2] = 0x18; /* OUTPUT PLUG SIGNAL FORMAT */
1365b59d809STakashi Sakamoto buf[3] = 0xff & pid; /* plug id */
1375b59d809STakashi Sakamoto buf[4] = 0x90; /* EOH_1, Form_1, FMT. AM824 */
1385b59d809STakashi Sakamoto buf[5] = 0x07 & sfc; /* FDF-hi. AM824, frequency */
1395b59d809STakashi Sakamoto buf[6] = 0xff; /* FDF-mid. AM824, SYT hi (not used) */
1405b59d809STakashi Sakamoto buf[7] = 0xff; /* FDF-low. AM824, SYT lo (not used) */
1415b59d809STakashi Sakamoto
1425b59d809STakashi Sakamoto /* do transaction and check buf[1-5] are the same against command */
1435b59d809STakashi Sakamoto err = fcp_avc_transaction(unit, buf, 8, buf, 8,
1445b59d809STakashi Sakamoto BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5));
1457e1621deSTakashi Sakamoto if (err < 0)
1467e1621deSTakashi Sakamoto ;
1477e1621deSTakashi Sakamoto else if (err < 8)
1485b59d809STakashi Sakamoto err = -EIO;
1495b59d809STakashi Sakamoto else if (buf[0] == 0x08) /* NOT IMPLEMENTED */
15003be63b2STakashi Sakamoto err = -ENXIO;
1515b59d809STakashi Sakamoto if (err < 0)
1525b59d809STakashi Sakamoto goto end;
1535b59d809STakashi Sakamoto
1545b59d809STakashi Sakamoto err = 0;
1555b59d809STakashi Sakamoto end:
1565b59d809STakashi Sakamoto kfree(buf);
1575b59d809STakashi Sakamoto return err;
1585b59d809STakashi Sakamoto }
159