LXR linux/sound/firewire/oxfw/oxfw-command.c

   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * oxfw_command.c - a part of driver for OXFW970/971 based devices
   4 *
   5 * Copyright (c) 2014 Takashi Sakamoto
   6 */
   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        else
  45                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        else
  62                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        else
 135                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