Blame view

kernel/linux-imx6_3.14.28/sound/usb/6fire/midi.c 5.08 KB
6b13f685e   김민수   BSP 최초 추가
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
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
  /*
   * Linux driver for TerraTec DMX 6Fire USB
   *
   * Rawmidi driver
   *
   * Author:	Torsten Schenk <torsten.schenk@zoho.com>
   * Created:	Jan 01, 2011
   * Copyright:	(C) Torsten Schenk
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2 of the License, or
   * (at your option) any later version.
   */
  
  #include <sound/rawmidi.h>
  
  #include "midi.h"
  #include "chip.h"
  #include "comm.h"
  
  enum {
  	MIDI_BUFSIZE = 64
  };
  
  static void usb6fire_midi_out_handler(struct urb *urb)
  {
  	struct midi_runtime *rt = urb->context;
  	int ret;
  	unsigned long flags;
  
  	spin_lock_irqsave(&rt->out_lock, flags);
  
  	if (rt->out) {
  		ret = snd_rawmidi_transmit(rt->out, rt->out_buffer + 4,
  				MIDI_BUFSIZE - 4);
  		if (ret > 0) { /* more data available, send next packet */
  			rt->out_buffer[1] = ret + 2;
  			rt->out_buffer[3] = rt->out_serial++;
  			urb->transfer_buffer_length = ret + 4;
  
  			ret = usb_submit_urb(urb, GFP_ATOMIC);
  			if (ret < 0)
  				snd_printk(KERN_ERR PREFIX "midi out urb "
  						"submit failed: %d
  ", ret);
  		} else /* no more data to transmit */
  			rt->out = NULL;
  	}
  	spin_unlock_irqrestore(&rt->out_lock, flags);
  }
  
  static void usb6fire_midi_in_received(
  		struct midi_runtime *rt, u8 *data, int length)
  {
  	unsigned long flags;
  
  	spin_lock_irqsave(&rt->in_lock, flags);
  	if (rt->in)
  		snd_rawmidi_receive(rt->in, data, length);
  	spin_unlock_irqrestore(&rt->in_lock, flags);
  }
  
  static int usb6fire_midi_out_open(struct snd_rawmidi_substream *alsa_sub)
  {
  	return 0;
  }
  
  static int usb6fire_midi_out_close(struct snd_rawmidi_substream *alsa_sub)
  {
  	return 0;
  }
  
  static void usb6fire_midi_out_trigger(
  		struct snd_rawmidi_substream *alsa_sub, int up)
  {
  	struct midi_runtime *rt = alsa_sub->rmidi->private_data;
  	struct urb *urb = &rt->out_urb;
  	__s8 ret;
  	unsigned long flags;
  
  	spin_lock_irqsave(&rt->out_lock, flags);
  	if (up) { /* start transfer */
  		if (rt->out) { /* we are already transmitting so just return */
  			spin_unlock_irqrestore(&rt->out_lock, flags);
  			return;
  		}
  
  		ret = snd_rawmidi_transmit(alsa_sub, rt->out_buffer + 4,
  				MIDI_BUFSIZE - 4);
  		if (ret > 0) {
  			rt->out_buffer[1] = ret + 2;
  			rt->out_buffer[3] = rt->out_serial++;
  			urb->transfer_buffer_length = ret + 4;
  
  			ret = usb_submit_urb(urb, GFP_ATOMIC);
  			if (ret < 0)
  				snd_printk(KERN_ERR PREFIX "midi out urb "
  						"submit failed: %d
  ", ret);
  			else
  				rt->out = alsa_sub;
  		}
  	} else if (rt->out == alsa_sub)
  		rt->out = NULL;
  	spin_unlock_irqrestore(&rt->out_lock, flags);
  }
  
  static void usb6fire_midi_out_drain(struct snd_rawmidi_substream *alsa_sub)
  {
  	struct midi_runtime *rt = alsa_sub->rmidi->private_data;
  	int retry = 0;
  
  	while (rt->out && retry++ < 100)
  		msleep(10);
  }
  
  static int usb6fire_midi_in_open(struct snd_rawmidi_substream *alsa_sub)
  {
  	return 0;
  }
  
  static int usb6fire_midi_in_close(struct snd_rawmidi_substream *alsa_sub)
  {
  	return 0;
  }
  
  static void usb6fire_midi_in_trigger(
  		struct snd_rawmidi_substream *alsa_sub, int up)
  {
  	struct midi_runtime *rt = alsa_sub->rmidi->private_data;
  	unsigned long flags;
  
  	spin_lock_irqsave(&rt->in_lock, flags);
  	if (up)
  		rt->in = alsa_sub;
  	else
  		rt->in = NULL;
  	spin_unlock_irqrestore(&rt->in_lock, flags);
  }
  
  static struct snd_rawmidi_ops out_ops = {
  	.open = usb6fire_midi_out_open,
  	.close = usb6fire_midi_out_close,
  	.trigger = usb6fire_midi_out_trigger,
  	.drain = usb6fire_midi_out_drain
  };
  
  static struct snd_rawmidi_ops in_ops = {
  	.open = usb6fire_midi_in_open,
  	.close = usb6fire_midi_in_close,
  	.trigger = usb6fire_midi_in_trigger
  };
  
  int usb6fire_midi_init(struct sfire_chip *chip)
  {
  	int ret;
  	struct midi_runtime *rt = kzalloc(sizeof(struct midi_runtime),
  			GFP_KERNEL);
  	struct comm_runtime *comm_rt = chip->comm;
  
  	if (!rt)
  		return -ENOMEM;
  
  	rt->out_buffer = kzalloc(MIDI_BUFSIZE, GFP_KERNEL);
  	if (!rt->out_buffer) {
  		kfree(rt);
  		return -ENOMEM;
  	}
  
  	rt->chip = chip;
  	rt->in_received = usb6fire_midi_in_received;
  	rt->out_buffer[0] = 0x80; /* 'send midi' command */
  	rt->out_buffer[1] = 0x00; /* size of data */
  	rt->out_buffer[2] = 0x00; /* always 0 */
  	spin_lock_init(&rt->in_lock);
  	spin_lock_init(&rt->out_lock);
  
  	comm_rt->init_urb(comm_rt, &rt->out_urb, rt->out_buffer, rt,
  			usb6fire_midi_out_handler);
  
  	ret = snd_rawmidi_new(chip->card, "6FireUSB", 0, 1, 1, &rt->instance);
  	if (ret < 0) {
  		kfree(rt->out_buffer);
  		kfree(rt);
  		snd_printk(KERN_ERR PREFIX "unable to create midi.
  ");
  		return ret;
  	}
  	rt->instance->private_data = rt;
  	strcpy(rt->instance->name, "DMX6FireUSB MIDI");
  	rt->instance->info_flags = SNDRV_RAWMIDI_INFO_OUTPUT |
  			SNDRV_RAWMIDI_INFO_INPUT |
  			SNDRV_RAWMIDI_INFO_DUPLEX;
  	snd_rawmidi_set_ops(rt->instance, SNDRV_RAWMIDI_STREAM_OUTPUT,
  			&out_ops);
  	snd_rawmidi_set_ops(rt->instance, SNDRV_RAWMIDI_STREAM_INPUT,
  			&in_ops);
  
  	chip->midi = rt;
  	return 0;
  }
  
  void usb6fire_midi_abort(struct sfire_chip *chip)
  {
  	struct midi_runtime *rt = chip->midi;
  
  	if (rt)
  		usb_poison_urb(&rt->out_urb);
  }
  
  void usb6fire_midi_destroy(struct sfire_chip *chip)
  {
  	struct midi_runtime *rt = chip->midi;
  
  	kfree(rt->out_buffer);
  	kfree(rt);
  	chip->midi = NULL;
  }