kernel/sound/firewire/oxfw/oxfw-command.c

   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 }