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);
49
50
51static int emi62_writememory(struct usb_device *dev, int address,
52 const unsigned char *data, int length,
53 __u8 request)
54{
55 int result;
56 unsigned char *buffer = kmemdup(data, length, GFP_KERNEL);
57
58 if (!buffer) {
59 dev_err(&dev->dev, "kmalloc(%d) failed.\n", length);
60 return -ENOMEM;
61 }
62
63
64 result = usb_control_msg (dev, usb_sndctrlpipe(dev, 0), request, 0x40, address, 0, buffer, length, 300);
65 kfree (buffer);
66 return result;
67}
68
69
70static int emi62_set_reset (struct usb_device *dev, unsigned char reset_bit)
71{
72 int response;
73 dev_info(&dev->dev, "%s - %d\n", __func__, reset_bit);
74
75 response = emi62_writememory (dev, CPUCS_REG, &reset_bit, 1, 0xa0);
76 if (response < 0)
77 dev_err(&dev->dev, "set_reset (%d) failed\n", reset_bit);
78 return response;
79}
80
81#define FW_LOAD_SIZE 1023
82
83static int emi62_load_firmware (struct usb_device *dev)
84{
85 const struct firmware *loader_fw = NULL;
86 const struct firmware *bitstream_fw = NULL;
87 const struct firmware *firmware_fw = NULL;
88 const struct ihex_binrec *rec;
89 int err = -ENOMEM;
90 int i;
91 __u32 addr;
92 __u8 *buf;
93
94 dev_dbg(&dev->dev, "load_firmware\n");
95 buf = kmalloc(FW_LOAD_SIZE, GFP_KERNEL);
96 if (!buf)
97 goto wraperr;
98
99 err = request_ihex_firmware(&loader_fw, "emi62/loader.fw", &dev->dev);
100 if (err)
101 goto nofw;
102
103 err = request_ihex_firmware(&bitstream_fw, "emi62/bitstream.fw",
104 &dev->dev);
105 if (err)
106 goto nofw;
107
108 err = request_ihex_firmware(&firmware_fw, FIRMWARE_FW, &dev->dev);
109 if (err) {
110 nofw:
111 goto wraperr;
112 }
113
114
115 err = emi62_set_reset(dev,1);
116 if (err < 0)
117 goto wraperr;
118
119 rec = (const struct ihex_binrec *)loader_fw->data;
120
121
122 while (rec) {
123 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
124 rec->data, be16_to_cpu(rec->len),
125 ANCHOR_LOAD_INTERNAL);
126 if (err < 0)
127 goto wraperr;
128 rec = ihex_next_binrec(rec);
129 }
130
131
132 err = emi62_set_reset(dev,0);
133 if (err < 0)
134 goto wraperr;
135 msleep(250);
136
137
138
139
140 rec = (const struct ihex_binrec *)bitstream_fw->data;
141 do {
142 i = 0;
143 addr = be32_to_cpu(rec->addr);
144
145
146 while (rec && (i + be16_to_cpu(rec->len) < FW_LOAD_SIZE)) {
147 memcpy(buf + i, rec->data, be16_to_cpu(rec->len));
148 i += be16_to_cpu(rec->len);
149 rec = ihex_next_binrec(rec);
150 }
151 err = emi62_writememory(dev, addr, buf, i, ANCHOR_LOAD_FPGA);
152 if (err < 0)
153 goto wraperr;
154 } while (rec);
155
156
157 err = emi62_set_reset(dev,1);
158 if (err < 0)
159 goto wraperr;
160
161
162 for (rec = (const struct ihex_binrec *)loader_fw->data;
163 rec; rec = ihex_next_binrec(rec)) {
164 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
165 rec->data, be16_to_cpu(rec->len),
166 ANCHOR_LOAD_INTERNAL);
167 if (err < 0)
168 goto wraperr;
169 }
170
171
172 err = emi62_set_reset(dev,0);
173 if (err < 0)
174 goto wraperr;
175 msleep(250);
176
177
178
179 for (rec = (const struct ihex_binrec *)firmware_fw->data;
180 rec; rec = ihex_next_binrec(rec)) {
181 if (!INTERNAL_RAM(be32_to_cpu(rec->addr))) {
182 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
183 rec->data, be16_to_cpu(rec->len),
184 ANCHOR_LOAD_EXTERNAL);
185 if (err < 0)
186 goto wraperr;
187 }
188 }
189
190
191 err = emi62_set_reset(dev,1);
192 if (err < 0)
193 goto wraperr;
194
195 for (rec = (const struct ihex_binrec *)firmware_fw->data;
196 rec; rec = ihex_next_binrec(rec)) {
197 if (INTERNAL_RAM(be32_to_cpu(rec->addr))) {
198 err = emi62_writememory(dev, be32_to_cpu(rec->addr),
199 rec->data, be16_to_cpu(rec->len),
200 ANCHOR_LOAD_EXTERNAL);
201 if (err < 0)
202 goto wraperr;
203 }
204 }
205
206
207 err = emi62_set_reset(dev,0);
208 if (err < 0)
209 goto wraperr;
210 msleep(250);
211
212 release_firmware(loader_fw);
213 release_firmware(bitstream_fw);
214 release_firmware(firmware_fw);
215
216 kfree(buf);
217
218
219
220 return 1;
221
222wraperr:
223 if (err < 0)
224 dev_err(&dev->dev,"%s - error loading firmware: error = %d\n",
225 __func__, err);
226 release_firmware(loader_fw);
227 release_firmware(bitstream_fw);
228 release_firmware(firmware_fw);
229
230 kfree(buf);
231 dev_err(&dev->dev, "Error\n");
232 return err;
233}
234
235static const struct usb_device_id id_table[] = {
236 { USB_DEVICE(EMI62_VENDOR_ID, EMI62_PRODUCT_ID) },
237 { }
238};
239
240MODULE_DEVICE_TABLE (usb, id_table);
241
242static int emi62_probe(struct usb_interface *intf, const struct usb_device_id *id)
243{
244 struct usb_device *dev = interface_to_usbdev(intf);
245 dev_dbg(&intf->dev, "emi62_probe\n");
246
247 dev_info(&intf->dev, "%s start\n", __func__);
248
249 emi62_load_firmware(dev);
250
251
252 return -EIO;
253}
254
255static void emi62_disconnect(struct usb_interface *intf)
256{
257}
258
259static struct usb_driver emi62_driver = {
260 .name = "emi62 - firmware loader",
261 .probe = emi62_probe,
262 .disconnect = emi62_disconnect,
263 .id_table = id_table,
264};
265
266module_usb_driver(emi62_driver);
267
268MODULE_AUTHOR("Tapio Laxström");
269MODULE_DESCRIPTION("Emagic EMI 6|2m firmware loader.");
270MODULE_LICENSE("GPL");
271
272MODULE_FIRMWARE("emi62/loader.fw");
273MODULE_FIRMWARE("emi62/bitstream.fw");
274MODULE_FIRMWARE(FIRMWARE_FW);
275
276
277