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.
376 lines
8.7 KiB
376 lines
8.7 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* fireworks_stream.c - a part of driver for Fireworks based devices |
|
* |
|
* Copyright (c) 2013-2014 Takashi Sakamoto |
|
*/ |
|
#include "./fireworks.h" |
|
|
|
#define READY_TIMEOUT_MS 1000 |
|
|
|
static int init_stream(struct snd_efw *efw, struct amdtp_stream *stream) |
|
{ |
|
struct cmp_connection *conn; |
|
enum cmp_direction c_dir; |
|
enum amdtp_stream_direction s_dir; |
|
int err; |
|
|
|
if (stream == &efw->tx_stream) { |
|
conn = &efw->out_conn; |
|
c_dir = CMP_OUTPUT; |
|
s_dir = AMDTP_IN_STREAM; |
|
} else { |
|
conn = &efw->in_conn; |
|
c_dir = CMP_INPUT; |
|
s_dir = AMDTP_OUT_STREAM; |
|
} |
|
|
|
err = cmp_connection_init(conn, efw->unit, c_dir, 0); |
|
if (err < 0) |
|
return err; |
|
|
|
err = amdtp_am824_init(stream, efw->unit, s_dir, CIP_BLOCKING | CIP_UNAWARE_SYT); |
|
if (err < 0) { |
|
amdtp_stream_destroy(stream); |
|
cmp_connection_destroy(conn); |
|
return err; |
|
} |
|
|
|
if (stream == &efw->tx_stream) { |
|
// Fireworks transmits NODATA packets with TAG0. |
|
efw->tx_stream.flags |= CIP_EMPTY_WITH_TAG0; |
|
// Fireworks has its own meaning for dbc. |
|
efw->tx_stream.flags |= CIP_DBC_IS_END_EVENT; |
|
// Fireworks reset dbc at bus reset. |
|
efw->tx_stream.flags |= CIP_SKIP_DBC_ZERO_CHECK; |
|
// But Recent firmwares starts packets with non-zero dbc. |
|
// Driver version 5.7.6 installs firmware version 5.7.3. |
|
if (efw->is_fireworks3 && |
|
(efw->firmware_version == 0x5070000 || |
|
efw->firmware_version == 0x5070300 || |
|
efw->firmware_version == 0x5080000)) |
|
efw->tx_stream.flags |= CIP_UNALIGHED_DBC; |
|
// AudioFire9 always reports wrong dbs. |
|
if (efw->is_af9) |
|
efw->tx_stream.flags |= CIP_WRONG_DBS; |
|
// Firmware version 5.5 reports fixed interval for dbc. |
|
if (efw->firmware_version == 0x5050000) |
|
efw->tx_stream.ctx_data.tx.dbc_interval = 8; |
|
} |
|
|
|
return err; |
|
} |
|
|
|
static int start_stream(struct snd_efw *efw, struct amdtp_stream *stream, |
|
unsigned int rate) |
|
{ |
|
struct cmp_connection *conn; |
|
int err; |
|
|
|
if (stream == &efw->tx_stream) |
|
conn = &efw->out_conn; |
|
else |
|
conn = &efw->in_conn; |
|
|
|
// Establish connection via CMP. |
|
err = cmp_connection_establish(conn); |
|
if (err < 0) |
|
return err; |
|
|
|
// Start amdtp stream. |
|
err = amdtp_domain_add_stream(&efw->domain, stream, |
|
conn->resources.channel, conn->speed); |
|
if (err < 0) { |
|
cmp_connection_break(conn); |
|
return err; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
// This function should be called before starting the stream or after stopping |
|
// the streams. |
|
static void destroy_stream(struct snd_efw *efw, struct amdtp_stream *stream) |
|
{ |
|
amdtp_stream_destroy(stream); |
|
|
|
if (stream == &efw->tx_stream) |
|
cmp_connection_destroy(&efw->out_conn); |
|
else |
|
cmp_connection_destroy(&efw->in_conn); |
|
} |
|
|
|
static int |
|
check_connection_used_by_others(struct snd_efw *efw, struct amdtp_stream *s) |
|
{ |
|
struct cmp_connection *conn; |
|
bool used; |
|
int err; |
|
|
|
if (s == &efw->tx_stream) |
|
conn = &efw->out_conn; |
|
else |
|
conn = &efw->in_conn; |
|
|
|
err = cmp_connection_check_used(conn, &used); |
|
if ((err >= 0) && used && !amdtp_stream_running(s)) { |
|
dev_err(&efw->unit->device, |
|
"Connection established by others: %cPCR[%d]\n", |
|
(conn->direction == CMP_OUTPUT) ? 'o' : 'i', |
|
conn->pcr_index); |
|
err = -EBUSY; |
|
} |
|
|
|
return err; |
|
} |
|
|
|
int snd_efw_stream_init_duplex(struct snd_efw *efw) |
|
{ |
|
int err; |
|
|
|
err = init_stream(efw, &efw->tx_stream); |
|
if (err < 0) |
|
return err; |
|
|
|
err = init_stream(efw, &efw->rx_stream); |
|
if (err < 0) { |
|
destroy_stream(efw, &efw->tx_stream); |
|
return err; |
|
} |
|
|
|
err = amdtp_domain_init(&efw->domain); |
|
if (err < 0) { |
|
destroy_stream(efw, &efw->tx_stream); |
|
destroy_stream(efw, &efw->rx_stream); |
|
return err; |
|
} |
|
|
|
// set IEC61883 compliant mode (actually not fully compliant...). |
|
err = snd_efw_command_set_tx_mode(efw, SND_EFW_TRANSPORT_MODE_IEC61883); |
|
if (err < 0) { |
|
destroy_stream(efw, &efw->tx_stream); |
|
destroy_stream(efw, &efw->rx_stream); |
|
} |
|
|
|
return err; |
|
} |
|
|
|
static int keep_resources(struct snd_efw *efw, struct amdtp_stream *stream, |
|
unsigned int rate, unsigned int mode) |
|
{ |
|
unsigned int pcm_channels; |
|
unsigned int midi_ports; |
|
struct cmp_connection *conn; |
|
int err; |
|
|
|
if (stream == &efw->tx_stream) { |
|
pcm_channels = efw->pcm_capture_channels[mode]; |
|
midi_ports = efw->midi_out_ports; |
|
conn = &efw->out_conn; |
|
} else { |
|
pcm_channels = efw->pcm_playback_channels[mode]; |
|
midi_ports = efw->midi_in_ports; |
|
conn = &efw->in_conn; |
|
} |
|
|
|
err = amdtp_am824_set_parameters(stream, rate, pcm_channels, |
|
midi_ports, false); |
|
if (err < 0) |
|
return err; |
|
|
|
return cmp_connection_reserve(conn, amdtp_stream_get_max_payload(stream)); |
|
} |
|
|
|
int snd_efw_stream_reserve_duplex(struct snd_efw *efw, unsigned int rate, |
|
unsigned int frames_per_period, |
|
unsigned int frames_per_buffer) |
|
{ |
|
unsigned int curr_rate; |
|
int err; |
|
|
|
// Considering JACK/FFADO streaming: |
|
// TODO: This can be removed hwdep functionality becomes popular. |
|
err = check_connection_used_by_others(efw, &efw->rx_stream); |
|
if (err < 0) |
|
return err; |
|
|
|
// stop streams if rate is different. |
|
err = snd_efw_command_get_sampling_rate(efw, &curr_rate); |
|
if (err < 0) |
|
return err; |
|
if (rate == 0) |
|
rate = curr_rate; |
|
if (rate != curr_rate) { |
|
amdtp_domain_stop(&efw->domain); |
|
|
|
cmp_connection_break(&efw->out_conn); |
|
cmp_connection_break(&efw->in_conn); |
|
|
|
cmp_connection_release(&efw->out_conn); |
|
cmp_connection_release(&efw->in_conn); |
|
} |
|
|
|
if (efw->substreams_counter == 0 || rate != curr_rate) { |
|
unsigned int mode; |
|
|
|
err = snd_efw_command_set_sampling_rate(efw, rate); |
|
if (err < 0) |
|
return err; |
|
|
|
err = snd_efw_get_multiplier_mode(rate, &mode); |
|
if (err < 0) |
|
return err; |
|
|
|
err = keep_resources(efw, &efw->tx_stream, rate, mode); |
|
if (err < 0) |
|
return err; |
|
|
|
err = keep_resources(efw, &efw->rx_stream, rate, mode); |
|
if (err < 0) { |
|
cmp_connection_release(&efw->in_conn); |
|
return err; |
|
} |
|
|
|
err = amdtp_domain_set_events_per_period(&efw->domain, |
|
frames_per_period, frames_per_buffer); |
|
if (err < 0) { |
|
cmp_connection_release(&efw->in_conn); |
|
cmp_connection_release(&efw->out_conn); |
|
return err; |
|
} |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
int snd_efw_stream_start_duplex(struct snd_efw *efw) |
|
{ |
|
unsigned int rate; |
|
int err = 0; |
|
|
|
// Need no substreams. |
|
if (efw->substreams_counter == 0) |
|
return -EIO; |
|
|
|
if (amdtp_streaming_error(&efw->rx_stream) || |
|
amdtp_streaming_error(&efw->tx_stream)) { |
|
amdtp_domain_stop(&efw->domain); |
|
cmp_connection_break(&efw->out_conn); |
|
cmp_connection_break(&efw->in_conn); |
|
} |
|
|
|
err = snd_efw_command_get_sampling_rate(efw, &rate); |
|
if (err < 0) |
|
return err; |
|
|
|
if (!amdtp_stream_running(&efw->rx_stream)) { |
|
unsigned int tx_init_skip_cycles; |
|
|
|
// Audiofire 2/4 skip an isochronous cycle several thousands after starting |
|
// packet transmission. |
|
if (efw->is_fireworks3 && !efw->is_af9) |
|
tx_init_skip_cycles = 6000; |
|
else |
|
tx_init_skip_cycles = 0; |
|
|
|
err = start_stream(efw, &efw->rx_stream, rate); |
|
if (err < 0) |
|
goto error; |
|
|
|
err = start_stream(efw, &efw->tx_stream, rate); |
|
if (err < 0) |
|
goto error; |
|
|
|
// NOTE: The device ignores presentation time expressed by the value of syt field |
|
// of CIP header in received packets. The sequence of the number of data blocks per |
|
// packet is important for media clock recovery. |
|
err = amdtp_domain_start(&efw->domain, tx_init_skip_cycles, true, false); |
|
if (err < 0) |
|
goto error; |
|
|
|
if (!amdtp_domain_wait_ready(&efw->domain, READY_TIMEOUT_MS)) { |
|
err = -ETIMEDOUT; |
|
goto error; |
|
} |
|
} |
|
|
|
return 0; |
|
error: |
|
amdtp_domain_stop(&efw->domain); |
|
|
|
cmp_connection_break(&efw->out_conn); |
|
cmp_connection_break(&efw->in_conn); |
|
|
|
return err; |
|
} |
|
|
|
void snd_efw_stream_stop_duplex(struct snd_efw *efw) |
|
{ |
|
if (efw->substreams_counter == 0) { |
|
amdtp_domain_stop(&efw->domain); |
|
|
|
cmp_connection_break(&efw->out_conn); |
|
cmp_connection_break(&efw->in_conn); |
|
|
|
cmp_connection_release(&efw->out_conn); |
|
cmp_connection_release(&efw->in_conn); |
|
} |
|
} |
|
|
|
void snd_efw_stream_update_duplex(struct snd_efw *efw) |
|
{ |
|
amdtp_domain_stop(&efw->domain); |
|
|
|
cmp_connection_break(&efw->out_conn); |
|
cmp_connection_break(&efw->in_conn); |
|
|
|
amdtp_stream_pcm_abort(&efw->rx_stream); |
|
amdtp_stream_pcm_abort(&efw->tx_stream); |
|
} |
|
|
|
void snd_efw_stream_destroy_duplex(struct snd_efw *efw) |
|
{ |
|
amdtp_domain_destroy(&efw->domain); |
|
|
|
destroy_stream(efw, &efw->rx_stream); |
|
destroy_stream(efw, &efw->tx_stream); |
|
} |
|
|
|
void snd_efw_stream_lock_changed(struct snd_efw *efw) |
|
{ |
|
efw->dev_lock_changed = true; |
|
wake_up(&efw->hwdep_wait); |
|
} |
|
|
|
int snd_efw_stream_lock_try(struct snd_efw *efw) |
|
{ |
|
int err; |
|
|
|
spin_lock_irq(&efw->lock); |
|
|
|
/* user land lock this */ |
|
if (efw->dev_lock_count < 0) { |
|
err = -EBUSY; |
|
goto end; |
|
} |
|
|
|
/* this is the first time */ |
|
if (efw->dev_lock_count++ == 0) |
|
snd_efw_stream_lock_changed(efw); |
|
err = 0; |
|
end: |
|
spin_unlock_irq(&efw->lock); |
|
return err; |
|
} |
|
|
|
void snd_efw_stream_lock_release(struct snd_efw *efw) |
|
{ |
|
spin_lock_irq(&efw->lock); |
|
|
|
if (WARN_ON(efw->dev_lock_count <= 0)) |
|
goto end; |
|
if (--efw->dev_lock_count == 0) |
|
snd_efw_stream_lock_changed(efw); |
|
end: |
|
spin_unlock_irq(&efw->lock); |
|
}
|
|
|