1
2
3
4
5
6
7
8
9
10#include <linux/kernel.h>
11#include <linux/errno.h>
12#include <linux/slab.h>
13#include <linux/init.h>
14#include <linux/module.h>
15#include <linux/usb.h>
16#include <linux/delay.h>
17#include <linux/firmware.h>
18#include <linux/ihex.h>
19
20
21
22
23#define SPDIF
24
25
26#ifdef SPDIF
27#define FIRMWARE_FW "emi62/spdif.fw"
28#else
29#define FIRMWARE_FW "emi62/midi.fw"
30#endif
31
32#define EMI62_VENDOR_ID 0x086a
33#define EMI62_PRODUCT_ID 0x0110
34
35#define ANCHOR_LOAD_INTERNAL 0xA0
36#define ANCHOR_LOAD_EXTERNAL 0xA3
37#define ANCHOR_LOAD_FPGA 0xA5
38#define MAX_INTERNAL_ADDRESS 0x1B3F
39#define CPUCS_REG 0x7F92
40#define INTERNAL_RAM(address) (address <= MAX_INTERNAL_ADDRESS)
41
42static int emi62_writememory(struct usb_device *dev, int address,
43 const unsigned char *data, int length,
44 __u8 bRequest);
45static int emi62_set_reset(struct usb_device *dev, unsigned char reset_bit);
46static int emi62_load_firmware (struct usb_device *dev);
47static int emi62_probe(struct usb_interface *intf, const struct usb_device_id *id);
48static void emi62_disconnect(struct usb_interface *intf);
49static int __init emi62_init (void);
50static void __exit emi62_exit (void);
51
52
53
54static int emi62_writememory(struct usb_device *dev, int address,
55 const unsigned char *data, int length,
56 __u8 request)
57{
58 int result;
59 unsigned char *buffer = kmemdup(data, length, GFP_KERNEL);
60
61 if (!buffer) {
62 err("emi62: kmalloc(%d) failed.", length);
63 return -ENOMEM;
64 }
65
66
67 result = usb_control_msg (dev, usb_sndctrlpipe(dev, 0), request, 0x40, address, 0, buffer, length, 300);
68 kfree (buffer);
69 return result;
70}
71
72
73static int emi62_set_reset (struct usb_device *dev, unsigned char reset_bit)
74{
75 int response;
76 dev_info(&dev->dev, "%s - %d\n", __func__, reset_bit);
77
78 response = emi62_writememory (dev, CPUCS_REG, &reset_bit, 1, 0xa0);
79 if (response < 0) {
80 err("emi62: set_reset (%d) failed", reset_bit);
81 }
82 return response;
83}
84
85#define FW_LOAD_SIZE 1023
86
87static int emi62_load_firmware (struct usb_device *dev)
88{
89 const struct firmware *loader_fw = NULL;
90 const struct firmware *bitstream_fw = NULL;
91 const struct firmware *firmware_fw = NULL;
92 const struct ihex_binrec *rec;
93 int err;
94 int i;
95 __u32 addr;
96 __u8 *buf;
97
98 dev_dbg(&dev->dev, "load_firmware\n");
99 buf = kmalloc(FW_LOAD_SIZE, GFP_KERNEL);
100 if (!buf) {
101 err( "%s - error loading firmware: error = %d", __func__, -ENOMEM);
102 err = -ENOMEM;
103 goto wraperr;
104 }
105
106 err = request_ihex_firmware(&loader_fw, "emi62/loader.fw", &dev->dev);
107 if (err)
108 goto nofw;
109
110 err = request_ihex_firmware(&bitstream_fw, "emi62/bitstream.fw",
111 &dev->dev);
112 if (err)
113 goto nofw;
114
115 err = request_ihex_firmware(&firmware_fw, FIRMWARE_FW, &dev->dev);
116 if (err) {
117 nofw:
118 err( "%s - request_firmware() failed", __func__);
119 goto wraperr;
120 }
121
122
123 err = emi62_set_reset(dev,1);
124 if (err < 0) {
125 err("%s - error loading firmware: error = %d", __func__, err);
126 goto wraperr;
127 }
128
129 rec = (const struct ihex_binrec *)loader_fw->data;
130
131
132 while (rec) {
133 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
134 rec->data, be16_to_cpu(rec->len),
135 ANCHOR_LOAD_INTERNAL);
136 if (err < 0) {
137 err("%s - error loading firmware: error = %d", __func__, err);
138 goto wraperr;
139 }
140 rec = ihex_next_binrec(rec);
141 }
142
143
144 err = emi62_set_reset(dev,0);
145 if (err < 0) {
146 err("%s - error loading firmware: error = %d", __func__, err);
147 goto wraperr;
148 }
149 msleep(250);
150
151
152
153
154 rec = (const struct ihex_binrec *)bitstream_fw->data;
155 do {
156 i = 0;
157 addr = be32_to_cpu(rec->addr);
158
159
160 while (rec && (i + be16_to_cpu(rec->len) < FW_LOAD_SIZE)) {
161 memcpy(buf + i, rec->data, be16_to_cpu(rec->len));
162 i += be16_to_cpu(rec->len);
163 rec = ihex_next_binrec(rec);
164 }
165 err = emi62_writememory(dev, addr, buf, i, ANCHOR_LOAD_FPGA);
166 if (err < 0) {
167 err("%s - error loading firmware: error = %d", __func__, err);
168 goto wraperr;
169 }
170 } while (rec);
171
172
173 err = emi62_set_reset(dev,1);
174 if (err < 0) {
175 err("%s - error loading firmware: error = %d", __func__, err);
176 goto wraperr;
177 }
178
179
180 for (rec = (const struct ihex_binrec *)loader_fw->data;
181 rec; rec = ihex_next_binrec(rec)) {
182 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
183 rec->data, be16_to_cpu(rec->len),
184 ANCHOR_LOAD_INTERNAL);
185 if (err < 0) {
186 err("%s - error loading firmware: error = %d", __func__, err);
187 goto wraperr;
188 }
189 }
190
191
192 err = emi62_set_reset(dev,0);
193 if (err < 0) {
194 err("%s - error loading firmware: error = %d", __func__, err);
195 goto wraperr;
196 }
197 msleep(250);
198
199
200
201 for (rec = (const struct ihex_binrec *)firmware_fw->data;
202 rec; rec = ihex_next_binrec(rec)) {
203 if (!INTERNAL_RAM(be32_to_cpu(rec->addr))) {
204 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
205 rec->data, be16_to_cpu(rec->len),
206 ANCHOR_LOAD_EXTERNAL);
207 if (err < 0) {
208 err("%s - error loading firmware: error = %d", __func__, err);
209 goto wraperr;
210 }
211 }
212 }
213
214
215 err = emi62_set_reset(dev,1);
216 if (err < 0) {
217 err("%s - error loading firmware: error = %d", __func__, err);
218 goto wraperr;
219 }
220
221 for (rec = (const struct ihex_binrec *)firmware_fw->data;
222 rec; rec = ihex_next_binrec(rec)) {
223 if (INTERNAL_RAM(be32_to_cpu(rec->addr))) {
224 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
225 rec->data, be16_to_cpu(rec->len),
226 ANCHOR_LOAD_EXTERNAL);
227 if (err < 0) {
228 err("%s - error loading firmware: error = %d", __func__, err);
229 goto wraperr;
230 }
231 }
232 }
233
234
235 err = emi62_set_reset(dev,0);
236 if (err < 0) {
237 err("%s - error loading firmware: error = %d", __func__, err);
238 goto wraperr;
239 }
240 msleep(250);
241
242 release_firmware(loader_fw);
243 release_firmware(bitstream_fw);
244 release_firmware(firmware_fw);
245
246 kfree(buf);
247
248
249
250 return 1;
251
252wraperr:
253 release_firmware(loader_fw);
254 release_firmware(bitstream_fw);
255 release_firmware(firmware_fw);
256
257 kfree(buf);
258 dev_err(&dev->dev, "Error\n");
259 return err;
260}
261
262static const struct usb_device_id id_table[] __devinitconst = {
263 { USB_DEVICE(EMI62_VENDOR_ID, EMI62_PRODUCT_ID) },
264 { }
265};
266
267MODULE_DEVICE_TABLE (usb, id_table);
268
269static int emi62_probe(struct usb_interface *intf, const struct usb_device_id *id)
270{
271 struct usb_device *dev = interface_to_usbdev(intf);
272 dev_dbg(&intf->dev, "emi62_probe\n");
273
274 dev_info(&intf->dev, "%s start\n", __func__);
275
276 emi62_load_firmware(dev);
277
278
279 return -EIO;
280}
281
282static void emi62_disconnect(struct usb_interface *intf)
283{
284}
285
286static struct usb_driver emi62_driver = {
287 .name = "emi62 - firmware loader",
288 .probe = emi62_probe,
289 .disconnect = emi62_disconnect,
290 .id_table = id_table,
291};
292
293static int __init emi62_init (void)
294{
295 int retval;
296 retval = usb_register (&emi62_driver);
297 if (retval)
298 printk(KERN_ERR "adi-emi: registration failed\n");
299 return retval;
300}
301
302static void __exit emi62_exit (void)
303{
304 usb_deregister (&emi62_driver);
305}
306
307module_init(emi62_init);
308module_exit(emi62_exit);
309
310MODULE_AUTHOR("Tapio Laxström");
311MODULE_DESCRIPTION("Emagic EMI 6|2m firmware loader.");
312MODULE_LICENSE("GPL");
313
314MODULE_FIRMWARE("emi62/loader.fw");
315MODULE_FIRMWARE("emi62/bitstream.fw");
316MODULE_FIRMWARE(FIRMWARE_FW);
317
318
319