sound/firewire/fireworks/fireworks_stream.c - kernel/msm-4.19 - Gitiles

 /*
  * fireworks_stream.c - a part of driver for Fireworks based devices
  *
  * Copyright (c) 2013-2014 Takashi Sakamoto
  *
  * Licensed under the terms of the GNU General Public License, version 2.
  */
 #include "./fireworks.h"

 #define CALLBACK_TIMEOUT	100

 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)
 		goto end;

 	err = amdtp_stream_init(stream, efw->unit, s_dir, CIP_BLOCKING);
 	if (err < 0) {
 		amdtp_stream_destroy(stream);
 		cmp_connection_destroy(conn);
 	}
 end:
 	return err;
 }

 static void
 stop_stream(struct snd_efw *efw, struct amdtp_stream *stream)
 {
 	amdtp_stream_pcm_abort(stream);
 	amdtp_stream_stop(stream);

 	if (stream == &efw->tx_stream)
 		cmp_connection_break(&efw->out_conn);
 	else
 		cmp_connection_break(&efw->in_conn);
 }

 static int
 start_stream(struct snd_efw *efw, struct amdtp_stream *stream,
 	     unsigned int sampling_rate)
 {
 	struct cmp_connection *conn;
 	unsigned int mode, pcm_channels, midi_ports;
 	int err;

 	err = snd_efw_get_multiplier_mode(sampling_rate, &mode);
 	if (err < 0)
 		goto end;
 	if (stream == &efw->tx_stream) {
 		conn = &efw->out_conn;
 		pcm_channels = efw->pcm_capture_channels[mode];
 		midi_ports = efw->midi_out_ports;
 	} else {
 		conn = &efw->in_conn;
 		pcm_channels = efw->pcm_playback_channels[mode];
 		midi_ports = efw->midi_in_ports;
 	}

 	amdtp_stream_set_parameters(stream, sampling_rate,
 				    pcm_channels, midi_ports);

 	/*  establish connection via CMP */
 	err = cmp_connection_establish(conn,
 				amdtp_stream_get_max_payload(stream));
 	if (err < 0)
 		goto end;

 	/* start amdtp stream */
 	err = amdtp_stream_start(stream,
 				 conn->resources.channel,
 				 conn->speed);
 	if (err < 0) {
 		stop_stream(efw, stream);
 		goto end;
 	}

 	/* wait first callback */
 	if (!amdtp_stream_wait_callback(stream, CALLBACK_TIMEOUT)) {
 		stop_stream(efw, stream);
 		err = -ETIMEDOUT;
 	}
 end:
 	return err;
 }

 /*
  * 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)
 {
 	struct cmp_connection *conn;

 	if (stream == &efw->tx_stream)
 		conn = &efw->out_conn;
 	else
 		conn = &efw->in_conn;

 	amdtp_stream_destroy(stream);
 	cmp_connection_destroy(&efw->out_conn);
 }

 static int
 get_sync_mode(struct snd_efw *efw, enum cip_flags *sync_mode)
 {
 	enum snd_efw_clock_source clock_source;
 	int err;

 	err = snd_efw_command_get_clock_source(efw, &clock_source);
 	if (err < 0)
 		return err;

 	if (clock_source == SND_EFW_CLOCK_SOURCE_SYTMATCH)
 		return -ENOSYS;

 	*sync_mode = CIP_SYNC_TO_DEVICE;
 	return 0;
 }

 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)
 		goto end;
 	/* 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;
 	/* AudioFire2 starts packets with non-zero dbc. */
 	if (efw->is_af2)
 		efw->tx_stream.flags |= CIP_SKIP_INIT_DBC_CHECK;
 	/* 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.tx_dbc_interval = 8;

 	err = init_stream(efw, &efw->rx_stream);
 	if (err < 0) {
 		destroy_stream(efw, &efw->tx_stream);
 		goto end;
 	}

 	/* 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);
 	}
 end:
 	return err;
 }

 int snd_efw_stream_start_duplex(struct snd_efw *efw, unsigned int rate)
 {
 	struct amdtp_stream *master, *slave;
 	atomic_t *slave_substreams;
 	enum cip_flags sync_mode;
 	unsigned int curr_rate;
 	int err = 0;

 	mutex_lock(&efw->mutex);

 	/* Need no substreams */
 	if ((atomic_read(&efw->playback_substreams) == 0) &&
 	    (atomic_read(&efw->capture_substreams)  == 0))
 		goto end;

 	err = get_sync_mode(efw, &sync_mode);
 	if (err < 0)
 		goto end;
 	if (sync_mode == CIP_SYNC_TO_DEVICE) {
 		master = &efw->tx_stream;
 		slave  = &efw->rx_stream;
 		slave_substreams  = &efw->playback_substreams;
 	} else {
 		master = &efw->rx_stream;
 		slave  = &efw->tx_stream;
 		slave_substreams = &efw->capture_substreams;
 	}

 	/*
 	 * Considering JACK/FFADO streaming:
 	 * TODO: This can be removed hwdep functionality becomes popular.
 	 */
 	err = check_connection_used_by_others(efw, master);
 	if (err < 0)
 		goto end;

 	/* packet queueing error */
 	if (amdtp_streaming_error(slave))
 		stop_stream(efw, slave);
 	if (amdtp_streaming_error(master))
 		stop_stream(efw, master);

 	/* stop streams if rate is different */
 	err = snd_efw_command_get_sampling_rate(efw, &curr_rate);
 	if (err < 0)
 		goto end;
 	if (rate == 0)
 		rate = curr_rate;
 	if (rate != curr_rate) {
 		stop_stream(efw, slave);
 		stop_stream(efw, master);
 	}

 	/* master should be always running */
 	if (!amdtp_stream_running(master)) {
 		amdtp_stream_set_sync(sync_mode, master, slave);
 		efw->master = master;

 		err = snd_efw_command_set_sampling_rate(efw, rate);
 		if (err < 0)
 			goto end;

 		err = start_stream(efw, master, rate);
 		if (err < 0) {
 			dev_err(&efw->unit->device,
 				"fail to start AMDTP master stream:%d\n", err);
 			goto end;
 		}
 	}

 	/* start slave if needed */
 	if (atomic_read(slave_substreams) > 0 && !amdtp_stream_running(slave)) {
 		err = start_stream(efw, slave, rate);
 		if (err < 0) {
 			dev_err(&efw->unit->device,
 				"fail to start AMDTP slave stream:%d\n", err);
 			stop_stream(efw, master);
 		}
 	}
 end:
 	mutex_unlock(&efw->mutex);
 	return err;
 }

 void snd_efw_stream_stop_duplex(struct snd_efw *efw)
 {
 	struct amdtp_stream *master, *slave;
 	atomic_t *master_substreams, *slave_substreams;

 	if (efw->master == &efw->rx_stream) {
 		slave  = &efw->tx_stream;
 		master = &efw->rx_stream;
 		slave_substreams  = &efw->capture_substreams;
 		master_substreams = &efw->playback_substreams;
 	} else {
 		slave  = &efw->rx_stream;
 		master = &efw->tx_stream;
 		slave_substreams  = &efw->playback_substreams;
 		master_substreams = &efw->capture_substreams;
 	}

 	mutex_lock(&efw->mutex);

 	if (atomic_read(slave_substreams) == 0) {
 		stop_stream(efw, slave);

 		if (atomic_read(master_substreams) == 0)
 			stop_stream(efw, master);
 	}

 	mutex_unlock(&efw->mutex);
 }

 void snd_efw_stream_update_duplex(struct snd_efw *efw)
 {
 	if ((cmp_connection_update(&efw->out_conn) < 0) ||
 	    (cmp_connection_update(&efw->in_conn) < 0)) {
 		mutex_lock(&efw->mutex);
 		stop_stream(efw, &efw->rx_stream);
 		stop_stream(efw, &efw->tx_stream);
 		mutex_unlock(&efw->mutex);
 	} else {
 		amdtp_stream_update(&efw->rx_stream);
 		amdtp_stream_update(&efw->tx_stream);
 	}
 }

 void snd_efw_stream_destroy_duplex(struct snd_efw *efw)
 {
 	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);
 }
	/*
	* fireworks_stream.c - a part of driver for Fireworks based devices
	*
	* Copyright (c) 2013-2014 Takashi Sakamoto
	*
	* Licensed under the terms of the GNU General Public License, version 2.
	*/
	#include "./fireworks.h"

	#define CALLBACK_TIMEOUT 100

	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)
	goto end;

	err = amdtp_stream_init(stream, efw->unit, s_dir, CIP_BLOCKING);
	if (err < 0) {
	amdtp_stream_destroy(stream);
	cmp_connection_destroy(conn);
	}
	end:
	return err;
	}

	static void
	stop_stream(struct snd_efw efw, struct amdtp_stream stream)
	{
	amdtp_stream_pcm_abort(stream);
	amdtp_stream_stop(stream);

	if (stream == &efw->tx_stream)
	cmp_connection_break(&efw->out_conn);
	else
	cmp_connection_break(&efw->in_conn);
	}

	static int
	start_stream(struct snd_efw efw, struct amdtp_stream stream,
	unsigned int sampling_rate)
	{
	struct cmp_connection *conn;
	unsigned int mode, pcm_channels, midi_ports;
	int err;

	err = snd_efw_get_multiplier_mode(sampling_rate, &mode);
	if (err < 0)
	goto end;
	if (stream == &efw->tx_stream) {
	conn = &efw->out_conn;
	pcm_channels = efw->pcm_capture_channels[mode];
	midi_ports = efw->midi_out_ports;
	} else {
	conn = &efw->in_conn;
	pcm_channels = efw->pcm_playback_channels[mode];
	midi_ports = efw->midi_in_ports;
	}

	amdtp_stream_set_parameters(stream, sampling_rate,
	pcm_channels, midi_ports);

	/* establish connection via CMP */
	err = cmp_connection_establish(conn,
	amdtp_stream_get_max_payload(stream));
	if (err < 0)
	goto end;

	/* start amdtp stream */
	err = amdtp_stream_start(stream,
	conn->resources.channel,
	conn->speed);
	if (err < 0) {
	stop_stream(efw, stream);
	goto end;
	}

	/* wait first callback */
	if (!amdtp_stream_wait_callback(stream, CALLBACK_TIMEOUT)) {
	stop_stream(efw, stream);
	err = -ETIMEDOUT;
	}
	end:
	return err;
	}

	/*
	* 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)
	{
	struct cmp_connection *conn;

	if (stream == &efw->tx_stream)
	conn = &efw->out_conn;
	else
	conn = &efw->in_conn;

	amdtp_stream_destroy(stream);
	cmp_connection_destroy(&efw->out_conn);
	}

	static int
	get_sync_mode(struct snd_efw efw, enum cip_flags sync_mode)
	{
	enum snd_efw_clock_source clock_source;
	int err;

	err = snd_efw_command_get_clock_source(efw, &clock_source);
	if (err < 0)
	return err;

	if (clock_source == SND_EFW_CLOCK_SOURCE_SYTMATCH)
	return -ENOSYS;

	*sync_mode = CIP_SYNC_TO_DEVICE;
	return 0;
	}

	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)
	goto end;
	/* 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;
	/* AudioFire2 starts packets with non-zero dbc. */
	if (efw->is_af2)
	efw->tx_stream.flags \|= CIP_SKIP_INIT_DBC_CHECK;
	/* 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.tx_dbc_interval = 8;

	err = init_stream(efw, &efw->rx_stream);
	if (err < 0) {
	destroy_stream(efw, &efw->tx_stream);
	goto end;
	}

	/* 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);
	}
	end:
	return err;
	}

	int snd_efw_stream_start_duplex(struct snd_efw *efw, unsigned int rate)
	{
	struct amdtp_stream master, slave;
	atomic_t *slave_substreams;
	enum cip_flags sync_mode;
	unsigned int curr_rate;
	int err = 0;

	mutex_lock(&efw->mutex);

	/* Need no substreams */
	if ((atomic_read(&efw->playback_substreams) == 0) &&
	(atomic_read(&efw->capture_substreams) == 0))
	goto end;

	err = get_sync_mode(efw, &sync_mode);
	if (err < 0)
	goto end;
	if (sync_mode == CIP_SYNC_TO_DEVICE) {
	master = &efw->tx_stream;
	slave = &efw->rx_stream;
	slave_substreams = &efw->playback_substreams;
	} else {
	master = &efw->rx_stream;
	slave = &efw->tx_stream;
	slave_substreams = &efw->capture_substreams;
	}

	/*
	* Considering JACK/FFADO streaming:
	* TODO: This can be removed hwdep functionality becomes popular.
	*/
	err = check_connection_used_by_others(efw, master);
	if (err < 0)
	goto end;

	/* packet queueing error */
	if (amdtp_streaming_error(slave))
	stop_stream(efw, slave);
	if (amdtp_streaming_error(master))
	stop_stream(efw, master);

	/* stop streams if rate is different */
	err = snd_efw_command_get_sampling_rate(efw, &curr_rate);
	if (err < 0)
	goto end;
	if (rate == 0)
	rate = curr_rate;
	if (rate != curr_rate) {
	stop_stream(efw, slave);
	stop_stream(efw, master);
	}

	/* master should be always running */
	if (!amdtp_stream_running(master)) {
	amdtp_stream_set_sync(sync_mode, master, slave);
	efw->master = master;

	err = snd_efw_command_set_sampling_rate(efw, rate);
	if (err < 0)
	goto end;

	err = start_stream(efw, master, rate);
	if (err < 0) {
	dev_err(&efw->unit->device,
	"fail to start AMDTP master stream:%d\n", err);
	goto end;
	}
	}

	/* start slave if needed */
	if (atomic_read(slave_substreams) > 0 && !amdtp_stream_running(slave)) {
	err = start_stream(efw, slave, rate);
	if (err < 0) {
	dev_err(&efw->unit->device,
	"fail to start AMDTP slave stream:%d\n", err);
	stop_stream(efw, master);
	}
	}
	end:
	mutex_unlock(&efw->mutex);
	return err;
	}

	void snd_efw_stream_stop_duplex(struct snd_efw *efw)
	{
	struct amdtp_stream master, slave;
	atomic_t master_substreams, slave_substreams;

	if (efw->master == &efw->rx_stream) {
	slave = &efw->tx_stream;
	master = &efw->rx_stream;
	slave_substreams = &efw->capture_substreams;
	master_substreams = &efw->playback_substreams;
	} else {
	slave = &efw->rx_stream;
	master = &efw->tx_stream;
	slave_substreams = &efw->playback_substreams;
	master_substreams = &efw->capture_substreams;
	}

	mutex_lock(&efw->mutex);

	if (atomic_read(slave_substreams) == 0) {
	stop_stream(efw, slave);

	if (atomic_read(master_substreams) == 0)
	stop_stream(efw, master);
	}

	mutex_unlock(&efw->mutex);
	}

	void snd_efw_stream_update_duplex(struct snd_efw *efw)
	{
	if ((cmp_connection_update(&efw->out_conn) < 0) \|\|
	(cmp_connection_update(&efw->in_conn) < 0)) {
	mutex_lock(&efw->mutex);
	stop_stream(efw, &efw->rx_stream);
	stop_stream(efw, &efw->tx_stream);
	mutex_unlock(&efw->mutex);
	} else {
	amdtp_stream_update(&efw->rx_stream);
	amdtp_stream_update(&efw->tx_stream);
	}
	}

	void snd_efw_stream_destroy_duplex(struct snd_efw *efw)
	{
	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);
	}