1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/slab.h>
13#include <linux/module.h>
14#include <linux/usb.h>
15#include <linux/firmware.h>
16#include <linux/ihex.h>
17#include <linux/usb/ezusb.h>
18
19struct ezusb_fx_type {
20
21 unsigned short cpucs_reg;
22 unsigned short max_internal_adress;
23};
24
25static struct ezusb_fx_type ezusb_fx1 = {
26 .cpucs_reg = 0x7F92,
27 .max_internal_adress = 0x1B3F,
28};
29
30
31#define WRITE_INT_RAM 0xA0
32#define WRITE_EXT_RAM 0xA3
33
34static int ezusb_writememory(struct usb_device *dev, int address,
35 unsigned char *data, int length, __u8 request)
36{
37 int result;
38 unsigned char *transfer_buffer;
39
40 if (!dev)
41 return -ENODEV;
42
43 transfer_buffer = kmemdup(data, length, GFP_KERNEL);
44 if (!transfer_buffer) {
45 dev_err(&dev->dev, "%s - kmalloc(%d) failed.\n",
46 __func__, length);
47 return -ENOMEM;
48 }
49 result = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), request,
50 USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
51 address, 0, transfer_buffer, length, 3000);
52
53 kfree(transfer_buffer);
54 return result;
55}
56
57static int ezusb_set_reset(struct usb_device *dev, unsigned short cpucs_reg,
58 unsigned char reset_bit)
59{
60 int response = ezusb_writememory(dev, cpucs_reg, &reset_bit, 1, WRITE_INT_RAM);
61 if (response < 0)
62 dev_err(&dev->dev, "%s-%d failed: %d\n",
63 __func__, reset_bit, response);
64 return response;
65}
66
67int ezusb_fx1_set_reset(struct usb_device *dev, unsigned char reset_bit)
68{
69 return ezusb_set_reset(dev, ezusb_fx1.cpucs_reg, reset_bit);
70}
71EXPORT_SYMBOL_GPL(ezusb_fx1_set_reset);
72
73static int ezusb_ihex_firmware_download(struct usb_device *dev,
74 struct ezusb_fx_type fx,
75 const char *firmware_path)
76{
77 int ret = -ENOENT;
78 const struct firmware *firmware = NULL;
79 const struct ihex_binrec *record;
80
81 if (request_ihex_firmware(&firmware, firmware_path,
82 &dev->dev)) {
83 dev_err(&dev->dev,
84 "%s - request \"%s\" failed\n",
85 __func__, firmware_path);
86 goto out;
87 }
88
89 ret = ezusb_set_reset(dev, fx.cpucs_reg, 0);
90 if (ret < 0)
91 goto out;
92
93 record = (const struct ihex_binrec *)firmware->data;
94 for (; record; record = ihex_next_binrec(record)) {
95 if (be32_to_cpu(record->addr) > fx.max_internal_adress) {
96 ret = ezusb_writememory(dev, be32_to_cpu(record->addr),
97 (unsigned char *)record->data,
98 be16_to_cpu(record->len), WRITE_EXT_RAM);
99 if (ret < 0) {
100 dev_err(&dev->dev, "%s - ezusb_writememory "
101 "failed writing internal memory "
102 "(%d %04X %p %d)\n", __func__, ret,
103 be32_to_cpu(record->addr), record->data,
104 be16_to_cpu(record->len));
105 goto out;
106 }
107 }
108 }
109
110 ret = ezusb_set_reset(dev, fx.cpucs_reg, 1);
111 if (ret < 0)
112 goto out;
113 record = (const struct ihex_binrec *)firmware->data;
114 for (; record; record = ihex_next_binrec(record)) {
115 if (be32_to_cpu(record->addr) <= fx.max_internal_adress) {
116 ret = ezusb_writememory(dev, be32_to_cpu(record->addr),
117 (unsigned char *)record->data,
118 be16_to_cpu(record->len), WRITE_INT_RAM);
119 if (ret < 0) {
120 dev_err(&dev->dev, "%s - ezusb_writememory "
121 "failed writing external memory "
122 "(%d %04X %p %d)\n", __func__, ret,
123 be32_to_cpu(record->addr), record->data,
124 be16_to_cpu(record->len));
125 goto out;
126 }
127 }
128 }
129 ret = ezusb_set_reset(dev, fx.cpucs_reg, 0);
130out:
131 release_firmware(firmware);
132 return ret;
133}
134
135int ezusb_fx1_ihex_firmware_download(struct usb_device *dev,
136 const char *firmware_path)
137{
138 return ezusb_ihex_firmware_download(dev, ezusb_fx1, firmware_path);
139}
140EXPORT_SYMBOL_GPL(ezusb_fx1_ihex_firmware_download);
141
142#if 0
143
144
145
146
147static struct ezusb_fx_type ezusb_fx2 = {
148 .cpucs_reg = 0xE600,
149 .max_internal_adress = 0x3FFF,
150};
151
152int ezusb_fx2_set_reset(struct usb_device *dev, unsigned char reset_bit)
153{
154 return ezusb_set_reset(dev, ezusb_fx2.cpucs_reg, reset_bit);
155}
156EXPORT_SYMBOL_GPL(ezusb_fx2_set_reset);
157
158int ezusb_fx2_ihex_firmware_download(struct usb_device *dev,
159 const char *firmware_path)
160{
161 return ezusb_ihex_firmware_download(dev, ezusb_fx2, firmware_path);
162}
163EXPORT_SYMBOL_GPL(ezusb_fx2_ihex_firmware_download);
164#endif
165
166MODULE_LICENSE("GPL");
167