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) |
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, |
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 | |
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); |
137 | } |