mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
158 lines
3.9 KiB
158 lines
3.9 KiB
// 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; |
|
}
|
|
|