1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
|
/*
* oxfw-scs1x.c - a part of driver for OXFW970/971 based devices
*
* Copyright (c) Clemens Ladisch <clemens@ladisch.de>
* Copyright (c) 2015 Takashi Sakamoto <o-takashi@sakamocchi.jp>
*
* Licensed under the terms of the GNU General Public License, version 2.
*/
#include "oxfw.h"
#define HSS1394_ADDRESS 0xc007dedadadaULL
#define HSS1394_MAX_PACKET_SIZE 64
#define HSS1394_TAG_USER_DATA 0x00
#define HSS1394_TAG_CHANGE_ADDRESS 0xf1
struct fw_scs1x {
struct fw_address_handler hss_handler;
u8 input_escape_count;
struct snd_rawmidi_substream *input;
};
static const u8 sysex_escape_prefix[] = {
0xf0, /* SysEx begin */
0x00, 0x01, 0x60, /* Stanton DJ */
0x48, 0x53, 0x53, /* "HSS" */
};
static void midi_input_escaped_byte(struct snd_rawmidi_substream *stream,
u8 byte)
{
u8 nibbles[2];
nibbles[0] = byte >> 4;
nibbles[1] = byte & 0x0f;
snd_rawmidi_receive(stream, nibbles, 2);
}
static void midi_input_byte(struct fw_scs1x *scs,
struct snd_rawmidi_substream *stream, u8 byte)
{
const u8 eox = 0xf7;
if (scs->input_escape_count > 0) {
midi_input_escaped_byte(stream, byte);
scs->input_escape_count--;
if (scs->input_escape_count == 0)
snd_rawmidi_receive(stream, &eox, sizeof(eox));
} else if (byte == 0xf9) {
snd_rawmidi_receive(stream, sysex_escape_prefix,
ARRAY_SIZE(sysex_escape_prefix));
midi_input_escaped_byte(stream, 0x00);
midi_input_escaped_byte(stream, 0xf9);
scs->input_escape_count = 3;
} else {
snd_rawmidi_receive(stream, &byte, 1);
}
}
static void midi_input_packet(struct fw_scs1x *scs,
struct snd_rawmidi_substream *stream,
const u8 *data, unsigned int bytes)
{
unsigned int i;
const u8 eox = 0xf7;
if (data[0] == HSS1394_TAG_USER_DATA) {
for (i = 1; i < bytes; ++i)
midi_input_byte(scs, stream, data[i]);
} else {
snd_rawmidi_receive(stream, sysex_escape_prefix,
ARRAY_SIZE(sysex_escape_prefix));
for (i = 0; i < bytes; ++i)
midi_input_escaped_byte(stream, data[i]);
snd_rawmidi_receive(stream, &eox, sizeof(eox));
}
}
static void handle_hss(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 fw_scs1x *scs = callback_data;
struct snd_rawmidi_substream *stream;
int rcode;
if (offset != scs->hss_handler.offset) {
rcode = RCODE_ADDRESS_ERROR;
goto end;
}
if (tcode != TCODE_WRITE_QUADLET_REQUEST &&
tcode != TCODE_WRITE_BLOCK_REQUEST) {
rcode = RCODE_TYPE_ERROR;
goto end;
}
if (length >= 1) {
stream = ACCESS_ONCE(scs->input);
if (stream)
midi_input_packet(scs, stream, data, length);
}
rcode = RCODE_COMPLETE;
end:
fw_send_response(card, request, rcode);
}
static int register_address(struct snd_oxfw *oxfw)
{
struct fw_scs1x *scs = oxfw->spec;
__be64 data;
data = cpu_to_be64(((u64)HSS1394_TAG_CHANGE_ADDRESS << 56) |
scs->hss_handler.offset);
return snd_fw_transaction(oxfw->unit, TCODE_WRITE_BLOCK_REQUEST,
HSS1394_ADDRESS, &data, sizeof(data), 0);
}
static void remove_scs1x(struct snd_rawmidi *rmidi)
{
struct fw_scs1x *scs = rmidi->private_data;
fw_core_remove_address_handler(&scs->hss_handler);
}
void snd_oxfw_scs1x_update(struct snd_oxfw *oxfw)
{
register_address(oxfw);
}
int snd_oxfw_scs1x_add(struct snd_oxfw *oxfw)
{
struct snd_rawmidi *rmidi;
struct fw_scs1x *scs;
int err;
scs = kzalloc(sizeof(struct fw_scs1x), GFP_KERNEL);
if (scs == NULL)
return -ENOMEM;
oxfw->spec = scs;
/* Allocate own handler for imcoming asynchronous transaction. */
scs->hss_handler.length = HSS1394_MAX_PACKET_SIZE;
scs->hss_handler.address_callback = handle_hss;
scs->hss_handler.callback_data = scs;
err = fw_core_add_address_handler(&scs->hss_handler,
&fw_high_memory_region);
if (err < 0)
return err;
err = register_address(oxfw);
if (err < 0)
goto err_allocated;
/* Use unique name for backward compatibility to scs1x module. */
err = snd_rawmidi_new(oxfw->card, "SCS.1x", 0, 0, 0, &rmidi);
if (err < 0)
goto err_allocated;
rmidi->private_data = scs;
rmidi->private_free = remove_scs1x;
snprintf(rmidi->name, sizeof(rmidi->name),
"%s MIDI", oxfw->card->shortname);
return 0;
err_allocated:
fw_core_remove_address_handler(&scs->hss_handler);
return err;
}
|
