[deliverable/linux.git] / sound / firewire / digi00x / digi00x-transaction.c

/*
 * digi00x-transaction.c - a part of driver for Digidesign Digi 002/003 family
 *
 * Copyright (c) 2014-2015 Takashi Sakamoto
 *
 * Licensed under the terms of the GNU General Public License, version 2.
 */

#include <sound/asound.h>
#include "digi00x.h"

static int fill_midi_message(struct snd_rawmidi_substream *substream, u8 *buf)
{
	int bytes;

	buf[0] = 0x80;
	bytes = snd_rawmidi_transmit_peek(substream, buf + 1, 2);
	if (bytes >= 0)
		buf[3] = 0xc0 | bytes;

	return bytes;
}

static void handle_midi_control(struct snd_dg00x *dg00x, __be32 *buf,
				unsigned int length)
{
	struct snd_rawmidi_substream *substream;
	unsigned int i;
	unsigned int len;
	u8 *b;

	substream = ACCESS_ONCE(dg00x->in_control);
	if (substream == NULL)
		return;

	length /= 4;

	for (i = 0; i < length; i++) {
		b = (u8 *)&buf[i];
		len = b[3] & 0xf;
		if (len > 0)
			snd_rawmidi_receive(dg00x->in_control, b + 1, len);
	}
}

static void handle_unknown_message(struct snd_dg00x *dg00x,
				   unsigned long long offset, __be32 *buf)
{
	unsigned long flags;

	spin_lock_irqsave(&dg00x->lock, flags);
	dg00x->msg = be32_to_cpu(*buf);
	spin_unlock_irqrestore(&dg00x->lock, flags);

	wake_up(&dg00x->hwdep_wait);
}

static void handle_message(struct fw_card *card, struct fw_request *request,
			   int tcode, int destination, int source,
			   int generation, unsigned long long offset,
			   void *data, size_t length, void *callback_data)
{
	struct snd_dg00x *dg00x = callback_data;
	__be32 *buf = (__be32 *)data;

	if (offset == dg00x->async_handler.offset)
		handle_unknown_message(dg00x, offset, buf);
	else if (offset == dg00x->async_handler.offset + 4)
		handle_midi_control(dg00x, buf, length);

	fw_send_response(card, request, RCODE_COMPLETE);
}

int snd_dg00x_transaction_reregister(struct snd_dg00x *dg00x)
{
	struct fw_device *device = fw_parent_device(dg00x->unit);
	__be32 data[2];
	int err;

	/* Unknown. 4bytes. */
	data[0] = cpu_to_be32((device->card->node_id << 16) |
			      (dg00x->async_handler.offset >> 32));
	data[1] = cpu_to_be32(dg00x->async_handler.offset);
	err = snd_fw_transaction(dg00x->unit, TCODE_WRITE_BLOCK_REQUEST,
				 DG00X_ADDR_BASE + DG00X_OFFSET_MESSAGE_ADDR,
				 &data, sizeof(data), 0);
	if (err < 0)
		return err;

	/* Asynchronous transactions for MIDI control message. */
	data[0] = cpu_to_be32((device->card->node_id << 16) |
			      (dg00x->async_handler.offset >> 32));
	data[1] = cpu_to_be32(dg00x->async_handler.offset + 4);
	return snd_fw_transaction(dg00x->unit, TCODE_WRITE_BLOCK_REQUEST,
				  DG00X_ADDR_BASE + DG00X_OFFSET_MIDI_CTL_ADDR,
				  &data, sizeof(data), 0);
}

int snd_dg00x_transaction_register(struct snd_dg00x *dg00x)
{
	static const struct fw_address_region resp_register_region = {
		.start	= 0xffffe0000000ull,
		.end	= 0xffffe000ffffull,
	};
	int err;

	dg00x->async_handler.length = 12;
	dg00x->async_handler.address_callback = handle_message;
	dg00x->async_handler.callback_data = dg00x;

	err = fw_core_add_address_handler(&dg00x->async_handler,
					  &resp_register_region);
	if (err < 0)
		return err;

	err = snd_dg00x_transaction_reregister(dg00x);
	if (err < 0)
		goto error;

	err = snd_fw_async_midi_port_init(&dg00x->out_control, dg00x->unit,
					  DG00X_ADDR_BASE + DG00X_OFFSET_MMC,
					  4, fill_midi_message);
	if (err < 0)
		goto error;

	return err;
error:
	fw_core_remove_address_handler(&dg00x->async_handler);
	dg00x->async_handler.address_callback = NULL;
	return err;
}

void snd_dg00x_transaction_unregister(struct snd_dg00x *dg00x)
{
	snd_fw_async_midi_port_destroy(&dg00x->out_control);
	fw_core_remove_address_handler(&dg00x->async_handler);
}
Commit	Line	Data
44b73088 TS	1	/*
	2	* digi00x-transaction.c - a part of driver for Digidesign Digi 002/003 family
	3	*
	4	* Copyright (c) 2014-2015 Takashi Sakamoto
	5	*
	6	* Licensed under the terms of the GNU General Public License, version 2.
	7	*/
	8
	9	#include <sound/asound.h>
	10	#include "digi00x.h"
	11
b47f525f TS	12	static int fill_midi_message(struct snd_rawmidi_substream substream, u8 buf)
	13	{
	14	int bytes;
	15
	16	buf[0] = 0x80;
	17	bytes = snd_rawmidi_transmit_peek(substream, buf + 1, 2);
	18	if (bytes >= 0)
	19	buf[3] = 0xc0 \| bytes;
	20
	21	return bytes;
	22	}
	23
3646a54a TS	24	static void handle_midi_control(struct snd_dg00x dg00x, __be32 buf,
	25	unsigned int length)
	26	{
	27	struct snd_rawmidi_substream *substream;
	28	unsigned int i;
	29	unsigned int len;
	30	u8 *b;
	31
	32	substream = ACCESS_ONCE(dg00x->in_control);
	33	if (substream == NULL)
	34	return;
	35
	36	length /= 4;
	37
	38	for (i = 0; i < length; i++) {
	39	b = (u8 *)&buf[i];
	40	len = b[3] & 0xf;
	41	if (len > 0)
	42	snd_rawmidi_receive(dg00x->in_control, b + 1, len);
	43	}
	44	}
	45
44b73088 TS	46	static void handle_unknown_message(struct snd_dg00x *dg00x,
	47	unsigned long long offset, __be32 *buf)
	48	{
	49	unsigned long flags;
	50
	51	spin_lock_irqsave(&dg00x->lock, flags);
	52	dg00x->msg = be32_to_cpu(*buf);
	53	spin_unlock_irqrestore(&dg00x->lock, flags);
	54
	55	wake_up(&dg00x->hwdep_wait);
	56	}
	57
	58	static void handle_message(struct fw_card card, struct fw_request request,
	59	int tcode, int destination, int source,
	60	int generation, unsigned long long offset,
	61	void data, size_t length, void callback_data)
	62	{
	63	struct snd_dg00x *dg00x = callback_data;
	64	__be32 buf = (__be32 )data;
	65
	66	if (offset == dg00x->async_handler.offset)
	67	handle_unknown_message(dg00x, offset, buf);
3646a54a TS	68	else if (offset == dg00x->async_handler.offset + 4)
3646a54a TS	69	handle_midi_control(dg00x, buf, length);
44b73088 TS	70
	71	fw_send_response(card, request, RCODE_COMPLETE);
	72	}
	73
	74	int snd_dg00x_transaction_reregister(struct snd_dg00x *dg00x)
	75	{
	76	struct fw_device *device = fw_parent_device(dg00x->unit);
	77	__be32 data[2];
3646a54a	78	int err;
44b73088 TS	79
	80	/* Unknown. 4bytes. */
	81	data[0] = cpu_to_be32((device->card->node_id << 16) \|
	82	(dg00x->async_handler.offset >> 32));
	83	data[1] = cpu_to_be32(dg00x->async_handler.offset);
3646a54a TS	84	err = snd_fw_transaction(dg00x->unit, TCODE_WRITE_BLOCK_REQUEST,
	85	DG00X_ADDR_BASE + DG00X_OFFSET_MESSAGE_ADDR,
	86	&data, sizeof(data), 0);
	87	if (err < 0)
	88	return err;
	89
	90	/* Asynchronous transactions for MIDI control message. */
	91	data[0] = cpu_to_be32((device->card->node_id << 16) \|
	92	(dg00x->async_handler.offset >> 32));
	93	data[1] = cpu_to_be32(dg00x->async_handler.offset + 4);
44b73088	94	return snd_fw_transaction(dg00x->unit, TCODE_WRITE_BLOCK_REQUEST,
3646a54a TS	95	DG00X_ADDR_BASE + DG00X_OFFSET_MIDI_CTL_ADDR,
3646a54a TS	96	&data, sizeof(data), 0);
44b73088 TS	97	}
	98
	99	int snd_dg00x_transaction_register(struct snd_dg00x *dg00x)
	100	{
	101	static const struct fw_address_region resp_register_region = {
	102	.start = 0xffffe0000000ull,
	103	.end = 0xffffe000ffffull,
	104	};
	105	int err;
	106
3646a54a	107	dg00x->async_handler.length = 12;
44b73088 TS	108	dg00x->async_handler.address_callback = handle_message;
	109	dg00x->async_handler.callback_data = dg00x;
	110
	111	err = fw_core_add_address_handler(&dg00x->async_handler,
	112	&resp_register_region);
	113	if (err < 0)
	114	return err;
	115
	116	err = snd_dg00x_transaction_reregister(dg00x);
b47f525f TS	117	if (err < 0)
	118	goto error;
	119
	120	err = snd_fw_async_midi_port_init(&dg00x->out_control, dg00x->unit,
	121	DG00X_ADDR_BASE + DG00X_OFFSET_MMC,
	122	4, fill_midi_message);
	123	if (err < 0)
	124	goto error;
44b73088 TS	125
44b73088 TS	126	return err;
b47f525f TS	127	error:
	128	fw_core_remove_address_handler(&dg00x->async_handler);
	129	dg00x->async_handler.address_callback = NULL;
	130	return err;
44b73088 TS	131	}
	132
	133	void snd_dg00x_transaction_unregister(struct snd_dg00x *dg00x)
	134	{
b47f525f	135	snd_fw_async_midi_port_destroy(&dg00x->out_control);
44b73088 TS	136	fw_core_remove_address_handler(&dg00x->async_handler);
44b73088 TS	137	}