Quelle  oxfw-command.c   Sprache: C

// 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;
}