1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include "firmware.h"
35#include "control.h"
36#include "rndis.h"
37
38
39
40static int msglevel =MSG_LEVEL_INFO;
41
42
43#define FIRMWARE_VERSION 0x133
44#define FIRMWARE_NAME "vntwusb.fw"
45
46#define FIRMWARE_CHUNK_SIZE 0x400
47
48
49
50
51
52
53
54
55
56
57
58
59BOOL
60FIRMWAREbDownload(
61 PSDevice pDevice
62 )
63{
64 const struct firmware *fw;
65 int NdisStatus;
66 void *pBuffer = NULL;
67 BOOL result = FALSE;
68 u16 wLength;
69 int ii;
70
71 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->Download firmware\n");
72 spin_unlock_irq(&pDevice->lock);
73
74 if (!pDevice->firmware) {
75 struct device *dev = &pDevice->usb->dev;
76 int rc;
77
78 rc = request_firmware(&pDevice->firmware, FIRMWARE_NAME, dev);
79 if (rc) {
80 dev_err(dev, "firmware file %s request failed (%d)\n",
81 FIRMWARE_NAME, rc);
82 goto out;
83 }
84 }
85 fw = pDevice->firmware;
86
87 pBuffer = kmalloc(FIRMWARE_CHUNK_SIZE, GFP_KERNEL);
88 if (!pBuffer)
89 goto out;
90
91 for (ii = 0; ii < fw->size; ii += FIRMWARE_CHUNK_SIZE) {
92 wLength = min_t(int, fw->size - ii, FIRMWARE_CHUNK_SIZE);
93 memcpy(pBuffer, fw->data + ii, wLength);
94
95 NdisStatus = CONTROLnsRequestOutAsyn(pDevice,
96 0,
97 0x1200+ii,
98 0x0000,
99 wLength,
100 pBuffer
101 );
102
103 DBG_PRT(MSG_LEVEL_DEBUG,
104 KERN_INFO"Download firmware...%d %zu\n", ii, fw->size);
105 if (NdisStatus != STATUS_SUCCESS)
106 goto out;
107 }
108
109 result = TRUE;
110
111out:
112 kfree(pBuffer);
113
114 spin_lock_irq(&pDevice->lock);
115 return result;
116}
117MODULE_FIRMWARE(FIRMWARE_NAME);
118
119BOOL
120FIRMWAREbBrach2Sram(
121 PSDevice pDevice
122 )
123{
124 int NdisStatus;
125
126 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->Branch to Sram\n");
127
128 NdisStatus = CONTROLnsRequestOut(pDevice,
129 1,
130 0x1200,
131 0x0000,
132 0,
133 NULL
134 );
135
136 if (NdisStatus != STATUS_SUCCESS) {
137 return (FALSE);
138 } else {
139 return (TRUE);
140 }
141}
142
143
144BOOL
145FIRMWAREbCheckVersion(
146 PSDevice pDevice
147 )
148{
149 int ntStatus;
150
151 ntStatus = CONTROLnsRequestIn(pDevice,
152 MESSAGE_TYPE_READ,
153 0,
154 MESSAGE_REQUEST_VERSION,
155 2,
156 (PBYTE) &(pDevice->wFirmwareVersion));
157
158 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Firmware Version [%04x]\n", pDevice->wFirmwareVersion);
159 if (ntStatus != STATUS_SUCCESS) {
160 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Firmware Invalid.\n");
161 return FALSE;
162 }
163 if (pDevice->wFirmwareVersion == 0xFFFF) {
164 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"In Loader.\n");
165 return FALSE;
166 }
167 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"Firmware Version [%04x]\n", pDevice->wFirmwareVersion);
168 if (pDevice->wFirmwareVersion < FIRMWARE_VERSION) {
169
170 FIRMWAREbBrach2Sram(pDevice);
171 return FALSE;
172 }
173 return TRUE;
174}
175