Lines Matching full:mpu
4 * Routines for control of MPU-401 in UART mode
6 * MPU-401 supports UART mode which is not capable generate transmit
12 * are port and mmio. For other kind of I/O, set mpu->read and
13 * mpu->write to your own I/O functions.
28 MODULE_DESCRIPTION("Routines for control of MPU-401 in UART mode");
31 static void snd_mpu401_uart_input_read(struct snd_mpu401 * mpu);
32 static void snd_mpu401_uart_output_write(struct snd_mpu401 * mpu);
38 #define snd_mpu401_input_avail(mpu) \
39 (!(mpu->read(mpu, MPU401C(mpu)) & MPU401_RX_EMPTY))
40 #define snd_mpu401_output_ready(mpu) \
41 (!(mpu->read(mpu, MPU401C(mpu)) & MPU401_TX_FULL))
44 static void mpu401_write_port(struct snd_mpu401 *mpu, unsigned char data,
50 static unsigned char mpu401_read_port(struct snd_mpu401 *mpu,
56 static void mpu401_write_mmio(struct snd_mpu401 *mpu, unsigned char data,
62 static unsigned char mpu401_read_mmio(struct snd_mpu401 *mpu,
69 static void snd_mpu401_uart_clear_rx(struct snd_mpu401 *mpu)
72 for (; timeout > 0 && snd_mpu401_input_avail(mpu); timeout--)
73 mpu->read(mpu, MPU401D(mpu));
76 dev_err(mpu->rmidi->dev,
78 mpu->read(mpu, MPU401C(mpu)));
82 static void uart_interrupt_tx(struct snd_mpu401 *mpu)
84 if (test_bit(MPU401_MODE_BIT_OUTPUT, &mpu->mode) &&
85 test_bit(MPU401_MODE_BIT_OUTPUT_TRIGGER, &mpu->mode)) {
86 guard(spinlock_irqsave)(&mpu->output_lock);
87 snd_mpu401_uart_output_write(mpu);
91 static void _snd_mpu401_uart_interrupt(struct snd_mpu401 *mpu)
93 if (mpu->info_flags & MPU401_INFO_INPUT) {
94 guard(spinlock_irqsave)(&mpu->input_lock);
95 if (test_bit(MPU401_MODE_BIT_INPUT, &mpu->mode))
96 snd_mpu401_uart_input_read(mpu);
98 snd_mpu401_uart_clear_rx(mpu);
100 if (! (mpu->info_flags & MPU401_INFO_TX_IRQ))
103 uart_interrupt_tx(mpu);
117 struct snd_mpu401 *mpu = dev_id;
119 if (!mpu)
121 _snd_mpu401_uart_interrupt(mpu);
138 struct snd_mpu401 *mpu = dev_id;
140 if (!mpu)
142 uart_interrupt_tx(mpu);
154 struct snd_mpu401 *mpu = timer_container_of(mpu, t, timer);
156 scoped_guard(spinlock_irqsave, &mpu->timer_lock) {
157 /*mpu->mode |= MPU401_MODE_TIMER;*/
158 mod_timer(&mpu->timer, 1 + jiffies);
160 if (mpu->rmidi)
161 _snd_mpu401_uart_interrupt(mpu);
167 static void snd_mpu401_uart_add_timer (struct snd_mpu401 *mpu, int input)
169 guard(spinlock_irqsave)(&mpu->timer_lock);
170 if (mpu->timer_invoked == 0) {
171 timer_setup(&mpu->timer, snd_mpu401_uart_timer, 0);
172 mod_timer(&mpu->timer, 1 + jiffies);
174 mpu->timer_invoked |= input ? MPU401_MODE_INPUT_TIMER :
181 static void snd_mpu401_uart_remove_timer (struct snd_mpu401 *mpu, int input)
183 guard(spinlock_irqsave)(&mpu->timer_lock);
184 if (mpu->timer_invoked) {
185 mpu->timer_invoked &= input ? ~MPU401_MODE_INPUT_TIMER :
187 if (! mpu->timer_invoked)
188 timer_delete(&mpu->timer);
197 static int snd_mpu401_uart_cmd(struct snd_mpu401 * mpu, unsigned char cmd,
202 guard(spinlock_irqsave)(&mpu->input_lock);
203 if (mpu->hardware != MPU401_HW_TRID4DWAVE) {
204 mpu->write(mpu, 0x00, MPU401D(mpu));
205 /*snd_mpu401_uart_clear_rx(mpu);*/
207 /* ok. standard MPU-401 initialization */
208 if (mpu->hardware != MPU401_HW_SB) {
210 !snd_mpu401_output_ready(mpu); timeout--)
214 dev_err(mpu->rmidi->dev,
216 mpu->read(mpu, MPU401C(mpu)));
219 mpu->write(mpu, cmd, MPU401C(mpu));
220 if (ack && !(mpu->info_flags & MPU401_INFO_NO_ACK)) {
224 if (snd_mpu401_input_avail(mpu)) {
225 if (mpu->read(mpu, MPU401D(mpu)) == MPU401_ACK)
229 if (!ok && mpu->read(mpu, MPU401D(mpu)) == MPU401_ACK)
234 dev_err(mpu->rmidi->dev,
236 cmd, mpu->port,
237 mpu->read(mpu, MPU401C(mpu)),
238 mpu->read(mpu, MPU401D(mpu)));
244 static int snd_mpu401_do_reset(struct snd_mpu401 *mpu)
246 if (snd_mpu401_uart_cmd(mpu, MPU401_RESET, 1))
248 if (snd_mpu401_uart_cmd(mpu, MPU401_ENTER_UART, 0))
258 struct snd_mpu401 *mpu;
261 mpu = substream->rmidi->private_data;
262 if (mpu->open_input) {
263 err = mpu->open_input(mpu);
267 if (! test_bit(MPU401_MODE_BIT_OUTPUT, &mpu->mode)) {
268 if (snd_mpu401_do_reset(mpu) < 0)
271 mpu->substream_input = substream;
272 set_bit(MPU401_MODE_BIT_INPUT, &mpu->mode);
276 if (mpu->open_input && mpu->close_input)
277 mpu->close_input(mpu);
283 struct snd_mpu401 *mpu;
286 mpu = substream->rmidi->private_data;
287 if (mpu->open_output) {
288 err = mpu->open_output(mpu);
292 if (! test_bit(MPU401_MODE_BIT_INPUT, &mpu->mode)) {
293 if (snd_mpu401_do_reset(mpu) < 0)
296 mpu->substream_output = substream;
297 set_bit(MPU401_MODE_BIT_OUTPUT, &mpu->mode);
301 if (mpu->open_output && mpu->close_output)
302 mpu->close_output(mpu);
308 struct snd_mpu401 *mpu;
311 mpu = substream->rmidi->private_data;
312 clear_bit(MPU401_MODE_BIT_INPUT, &mpu->mode);
313 mpu->substream_input = NULL;
314 if (! test_bit(MPU401_MODE_BIT_OUTPUT, &mpu->mode))
315 err = snd_mpu401_uart_cmd(mpu, MPU401_RESET, 0);
316 if (mpu->close_input)
317 mpu->close_input(mpu);
325 struct snd_mpu401 *mpu;
328 mpu = substream->rmidi->private_data;
329 clear_bit(MPU401_MODE_BIT_OUTPUT, &mpu->mode);
330 mpu->substream_output = NULL;
331 if (! test_bit(MPU401_MODE_BIT_INPUT, &mpu->mode))
332 err = snd_mpu401_uart_cmd(mpu, MPU401_RESET, 0);
333 if (mpu->close_output)
334 mpu->close_output(mpu);
346 struct snd_mpu401 *mpu;
349 mpu = substream->rmidi->private_data;
352 &mpu->mode)) {
355 mpu->read(mpu, MPU401D(mpu));
356 if (mpu->info_flags & MPU401_INFO_USE_TIMER)
357 snd_mpu401_uart_add_timer(mpu, 1);
361 guard(spinlock_irqsave)(&mpu->input_lock);
362 snd_mpu401_uart_input_read(mpu);
364 if (mpu->info_flags & MPU401_INFO_USE_TIMER)
365 snd_mpu401_uart_remove_timer(mpu, 1);
366 clear_bit(MPU401_MODE_BIT_INPUT_TRIGGER, &mpu->mode);
375 static void snd_mpu401_uart_input_read(struct snd_mpu401 * mpu)
381 if (! snd_mpu401_input_avail(mpu))
383 byte = mpu->read(mpu, MPU401D(mpu));
384 if (test_bit(MPU401_MODE_BIT_INPUT_TRIGGER, &mpu->mode))
385 snd_rawmidi_receive(mpu->substream_input, &byte, 1);
401 static void snd_mpu401_uart_output_write(struct snd_mpu401 * mpu)
407 if (snd_rawmidi_transmit_peek(mpu->substream_output,
413 if (!snd_mpu401_output_ready(mpu) &&
414 !snd_mpu401_output_ready(mpu))
416 mpu->write(mpu, byte, MPU401D(mpu));
417 snd_rawmidi_transmit_ack(mpu->substream_output, 1);
419 snd_mpu401_uart_remove_timer (mpu, 0);
431 struct snd_mpu401 *mpu;
433 mpu = substream->rmidi->private_data;
435 set_bit(MPU401_MODE_BIT_OUTPUT_TRIGGER, &mpu->mode);
441 if (! (mpu->info_flags & MPU401_INFO_TX_IRQ))
442 snd_mpu401_uart_add_timer(mpu, 0);
445 guard(spinlock_irqsave)(&mpu->output_lock);
446 snd_mpu401_uart_output_write(mpu);
448 if (! (mpu->info_flags & MPU401_INFO_TX_IRQ))
449 snd_mpu401_uart_remove_timer(mpu, 0);
450 clear_bit(MPU401_MODE_BIT_OUTPUT_TRIGGER, &mpu->mode);
474 struct snd_mpu401 *mpu = rmidi->private_data;
475 if (mpu->irq >= 0)
476 free_irq(mpu->irq, (void *) mpu);
477 release_and_free_resource(mpu->res);
478 kfree(mpu);
491 * Creates a new MPU-401 instance.
506 struct snd_mpu401 *mpu;
517 err = snd_rawmidi_new(card, "MPU-401U", device,
521 mpu = kzalloc(sizeof(*mpu), GFP_KERNEL);
522 if (!mpu) {
526 rmidi->private_data = mpu;
528 spin_lock_init(&mpu->input_lock);
529 spin_lock_init(&mpu->output_lock);
530 spin_lock_init(&mpu->timer_lock);
531 mpu->hardware = hardware;
532 mpu->irq = -1;
533 mpu->rmidi = rmidi;
536 mpu->res = request_region(port, res_size, "MPU401 UART");
537 if (!mpu->res) {
546 mpu->write = mpu401_write_mmio;
547 mpu->read = mpu401_read_mmio;
549 mpu->write = mpu401_write_port;
550 mpu->read = mpu401_read_port;
552 mpu->port = port;
554 mpu->cport = port + 2;
556 mpu->cport = port + 1;
559 "MPU401 UART", (void *) mpu)) {
568 mpu->info_flags = info_flags;
569 mpu->irq = irq;
574 sprintf(rmidi->name, "MPU-401 MIDI %d-%d",card->number, device);