This source file includes following definitions.
- usb6fire_comm_init_urb
- usb6fire_comm_receiver_handler
- usb6fire_comm_init_buffer
- usb6fire_comm_send_buffer
- usb6fire_comm_write8
- usb6fire_comm_write16
- usb6fire_comm_init
- usb6fire_comm_abort
- usb6fire_comm_destroy
1
2
3
4
5
6
7
8
9
10
11
12 #include "comm.h"
13 #include "chip.h"
14 #include "midi.h"
15
16 enum {
17 COMM_EP = 1,
18 COMM_FPGA_EP = 2
19 };
20
21 static void usb6fire_comm_init_urb(struct comm_runtime *rt, struct urb *urb,
22 u8 *buffer, void *context, void(*handler)(struct urb *urb))
23 {
24 usb_init_urb(urb);
25 urb->transfer_buffer = buffer;
26 urb->pipe = usb_sndintpipe(rt->chip->dev, COMM_EP);
27 urb->complete = handler;
28 urb->context = context;
29 urb->interval = 1;
30 urb->dev = rt->chip->dev;
31 }
32
33 static void usb6fire_comm_receiver_handler(struct urb *urb)
34 {
35 struct comm_runtime *rt = urb->context;
36 struct midi_runtime *midi_rt = rt->chip->midi;
37
38 if (!urb->status) {
39 if (rt->receiver_buffer[0] == 0x10)
40 if (midi_rt)
41 midi_rt->in_received(midi_rt,
42 rt->receiver_buffer + 2,
43 rt->receiver_buffer[1]);
44 }
45
46 if (!rt->chip->shutdown) {
47 urb->status = 0;
48 urb->actual_length = 0;
49 if (usb_submit_urb(urb, GFP_ATOMIC) < 0)
50 dev_warn(&urb->dev->dev,
51 "comm data receiver aborted.\n");
52 }
53 }
54
55 static void usb6fire_comm_init_buffer(u8 *buffer, u8 id, u8 request,
56 u8 reg, u8 vl, u8 vh)
57 {
58 buffer[0] = 0x01;
59 buffer[2] = request;
60 buffer[3] = id;
61 switch (request) {
62 case 0x02:
63 buffer[1] = 0x05;
64 buffer[4] = reg;
65 buffer[5] = vl;
66 buffer[6] = vh;
67 break;
68
69 case 0x12:
70 buffer[1] = 0x0b;
71 buffer[4] = 0x00;
72 buffer[5] = 0x18;
73 buffer[6] = 0x05;
74 buffer[7] = 0x00;
75 buffer[8] = 0x01;
76 buffer[9] = 0x00;
77 buffer[10] = 0x9e;
78 buffer[11] = reg;
79 buffer[12] = vl;
80 break;
81
82 case 0x20:
83 case 0x21:
84 case 0x22:
85 buffer[1] = 0x04;
86 buffer[4] = reg;
87 buffer[5] = vl;
88 break;
89 }
90 }
91
92 static int usb6fire_comm_send_buffer(u8 *buffer, struct usb_device *dev)
93 {
94 int ret;
95 int actual_len;
96
97 ret = usb_interrupt_msg(dev, usb_sndintpipe(dev, COMM_EP),
98 buffer, buffer[1] + 2, &actual_len, HZ);
99 if (ret < 0)
100 return ret;
101 else if (actual_len != buffer[1] + 2)
102 return -EIO;
103 return 0;
104 }
105
106 static int usb6fire_comm_write8(struct comm_runtime *rt, u8 request,
107 u8 reg, u8 value)
108 {
109 u8 *buffer;
110 int ret;
111
112
113 buffer = kmalloc(13, GFP_KERNEL);
114 if (!buffer)
115 return -ENOMEM;
116
117 usb6fire_comm_init_buffer(buffer, 0x00, request, reg, value, 0x00);
118 ret = usb6fire_comm_send_buffer(buffer, rt->chip->dev);
119
120 kfree(buffer);
121 return ret;
122 }
123
124 static int usb6fire_comm_write16(struct comm_runtime *rt, u8 request,
125 u8 reg, u8 vl, u8 vh)
126 {
127 u8 *buffer;
128 int ret;
129
130
131 buffer = kmalloc(13, GFP_KERNEL);
132 if (!buffer)
133 return -ENOMEM;
134
135 usb6fire_comm_init_buffer(buffer, 0x00, request, reg, vl, vh);
136 ret = usb6fire_comm_send_buffer(buffer, rt->chip->dev);
137
138 kfree(buffer);
139 return ret;
140 }
141
142 int usb6fire_comm_init(struct sfire_chip *chip)
143 {
144 struct comm_runtime *rt = kzalloc(sizeof(struct comm_runtime),
145 GFP_KERNEL);
146 struct urb *urb;
147 int ret;
148
149 if (!rt)
150 return -ENOMEM;
151
152 rt->receiver_buffer = kzalloc(COMM_RECEIVER_BUFSIZE, GFP_KERNEL);
153 if (!rt->receiver_buffer) {
154 kfree(rt);
155 return -ENOMEM;
156 }
157
158 urb = &rt->receiver;
159 rt->serial = 1;
160 rt->chip = chip;
161 usb_init_urb(urb);
162 rt->init_urb = usb6fire_comm_init_urb;
163 rt->write8 = usb6fire_comm_write8;
164 rt->write16 = usb6fire_comm_write16;
165
166
167 urb->transfer_buffer = rt->receiver_buffer;
168 urb->transfer_buffer_length = COMM_RECEIVER_BUFSIZE;
169 urb->pipe = usb_rcvintpipe(chip->dev, COMM_EP);
170 urb->dev = chip->dev;
171 urb->complete = usb6fire_comm_receiver_handler;
172 urb->context = rt;
173 urb->interval = 1;
174 ret = usb_submit_urb(urb, GFP_KERNEL);
175 if (ret < 0) {
176 kfree(rt->receiver_buffer);
177 kfree(rt);
178 dev_err(&chip->dev->dev, "cannot create comm data receiver.");
179 return ret;
180 }
181 chip->comm = rt;
182 return 0;
183 }
184
185 void usb6fire_comm_abort(struct sfire_chip *chip)
186 {
187 struct comm_runtime *rt = chip->comm;
188
189 if (rt)
190 usb_poison_urb(&rt->receiver);
191 }
192
193 void usb6fire_comm_destroy(struct sfire_chip *chip)
194 {
195 struct comm_runtime *rt = chip->comm;
196
197 kfree(rt->receiver_buffer);
198 kfree(rt);
199 chip->comm = NULL;
200 }