]> git.zerfleddert.de Git - proxmark3-svn/blob - winsrc/prox.cpp
Add forgotten file
[proxmark3-svn] / winsrc / prox.cpp
1 #include <windows.h>
2 #include <setupapi.h>
3 #include <stdio.h>
4 #include <ctype.h>
5 #include <stdlib.h>
6 extern "C" {
7 #include "include/hidsdi.h"
8 #include "include/hidpi.h"
9 }
10
11 #include "prox.h"
12
13 #define OUR_VID 0x9ac4
14 #define OUR_PID 0x4b8f
15
16 int offline = 0;
17 HANDLE UsbHandle;
18
19 static void ShowError(void)
20 {
21 char buf[1024];
22 FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM, NULL, GetLastError(), 0,
23 buf, sizeof(buf), NULL);
24 printf("ERROR: %s", buf);
25 }
26
27 static BOOL UsbConnect(void)
28 {
29 typedef void (__stdcall *GetGuidProc)(GUID *);
30 typedef BOOLEAN (__stdcall *GetAttrProc)(HANDLE, HIDD_ATTRIBUTES *);
31 typedef BOOLEAN (__stdcall *GetPreparsedProc)(HANDLE,
32 PHIDP_PREPARSED_DATA *);
33 typedef NTSTATUS (__stdcall *GetCapsProc)(PHIDP_PREPARSED_DATA, PHIDP_CAPS);
34 GetGuidProc getGuid;
35 GetAttrProc getAttr;
36 GetPreparsedProc getPreparsed;
37 GetCapsProc getCaps;
38
39 HMODULE h = LoadLibrary("hid.dll");
40 getGuid = (GetGuidProc)GetProcAddress(h, "HidD_GetHidGuid");
41 getAttr = (GetAttrProc)GetProcAddress(h, "HidD_GetAttributes");
42 getPreparsed = (GetPreparsedProc)GetProcAddress(h, "HidD_GetPreparsedData");
43 getCaps = (GetCapsProc)GetProcAddress(h, "HidP_GetCaps");
44
45 GUID hidGuid;
46 getGuid(&hidGuid);
47
48 HDEVINFO devInfo;
49 devInfo = SetupDiGetClassDevs(&hidGuid, NULL, NULL,
50 DIGCF_PRESENT | DIGCF_INTERFACEDEVICE);
51
52 SP_DEVICE_INTERFACE_DATA devInfoData;
53 devInfoData.cbSize = sizeof(devInfoData);
54
55 int i;
56 for(i = 0;; i++) {
57 if(!SetupDiEnumDeviceInterfaces(devInfo, 0, &hidGuid, i, &devInfoData))
58 {
59 if(GetLastError() != ERROR_NO_MORE_ITEMS) {
60 // printf("SetupDiEnumDeviceInterfaces failed\n");
61 }
62 // printf("done list\n");
63 SetupDiDestroyDeviceInfoList(devInfo);
64 return FALSE;
65 }
66
67 // printf("item %d:\n", i);
68
69 DWORD sizeReqd = 0;
70 if(!SetupDiGetDeviceInterfaceDetail(devInfo, &devInfoData,
71 NULL, 0, &sizeReqd, NULL))
72 {
73 if(GetLastError() != ERROR_INSUFFICIENT_BUFFER) {
74 // printf("SetupDiGetDeviceInterfaceDetail (0) failed\n");
75 continue;
76 }
77 }
78
79 SP_DEVICE_INTERFACE_DETAIL_DATA *devInfoDetailData =
80 (SP_DEVICE_INTERFACE_DETAIL_DATA *)malloc(sizeReqd);
81 devInfoDetailData->cbSize = sizeof(*devInfoDetailData);
82
83 if(!SetupDiGetDeviceInterfaceDetail(devInfo, &devInfoData,
84 devInfoDetailData, 87, NULL, NULL))
85 {
86 // printf("SetupDiGetDeviceInterfaceDetail (1) failed\n");
87 continue;
88 }
89
90 char *path = devInfoDetailData->DevicePath;
91
92 UsbHandle = CreateFile(path, /*GENERIC_READ |*/ GENERIC_WRITE,
93 FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_EXISTING,
94 FILE_FLAG_OVERLAPPED, NULL);
95
96 if(UsbHandle == INVALID_HANDLE_VALUE) {
97 ShowError();
98 // printf("CreateFile failed: for '%s'\n", path);
99 continue;
100 }
101
102 HIDD_ATTRIBUTES attr;
103 attr.Size = sizeof(attr);
104 if(!getAttr(UsbHandle, &attr)) {
105 ShowError();
106 // printf("HidD_GetAttributes failed\n");
107 continue;
108 }
109
110 // printf("VID: %04x PID %04x\n", attr.VendorID, attr.ProductID);
111
112 if(attr.VendorID != OUR_VID || attr.ProductID != OUR_PID) {
113 CloseHandle(UsbHandle);
114 // printf(" nope, not us\n");
115 continue;
116 }
117
118 // printf ("got it!\n");
119 CloseHandle(UsbHandle);
120
121 UsbHandle = CreateFile(path, GENERIC_READ | GENERIC_WRITE,
122 FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_EXISTING,
123 FILE_FLAG_OVERLAPPED, NULL);
124
125 if(UsbHandle == INVALID_HANDLE_VALUE) {
126 ShowError();
127 // printf("Error, couldn't open our own handle as desired.\n");
128 return FALSE;
129 }
130
131 PHIDP_PREPARSED_DATA pp;
132 getPreparsed(UsbHandle, &pp);
133 HIDP_CAPS caps;
134
135 if(getCaps(pp, &caps) != HIDP_STATUS_SUCCESS) {
136 // printf("getcaps failed\n");
137 return FALSE;
138 }
139
140 // printf("input/out report %d/%d\n", caps.InputReportByteLength,
141 // caps.OutputReportByteLength);
142
143
144 return TRUE;
145 }
146 return FALSE;
147 }
148
149 BOOL ReceiveCommandPoll(UsbCommand *c)
150 {
151 static BOOL ReadInProgress = FALSE;
152 static OVERLAPPED Ov;
153 static BYTE Buf[65];
154 static DWORD HaveRead;
155
156 if(!ReadInProgress) {
157 memset(&Ov, 0, sizeof(Ov));
158 ReadFile(UsbHandle, Buf, 65, &HaveRead, &Ov);
159 if(GetLastError() != ERROR_IO_PENDING) {
160 ShowError();
161 exit(-1);
162 }
163 ReadInProgress = TRUE;
164 }
165
166 if(HasOverlappedIoCompleted(&Ov)) {
167 ReadInProgress = FALSE;
168
169 if(!GetOverlappedResult(UsbHandle, &Ov, &HaveRead, FALSE)) {
170 ShowError();
171 exit(-1);
172 }
173
174 memcpy(c, Buf+1, 64);
175
176 return TRUE;
177 } else {
178 return FALSE;
179 }
180 }
181
182 void ReceiveCommand(UsbCommand *c)
183 {
184 while(!ReceiveCommandPoll(c)) {
185 Sleep(0);
186 }
187 }
188
189 void SendCommand(UsbCommand *c, BOOL wantAck)
190 {
191 BYTE buf[65];
192 buf[0] = 0;
193 memcpy(buf+1, c, 64);
194
195 DWORD written;
196 OVERLAPPED ov;
197
198 memset(&ov, 0, sizeof(ov));
199 WriteFile(UsbHandle, buf, 65, &written, &ov);
200 if(GetLastError() != ERROR_IO_PENDING) {
201 ShowError();
202 exit(-1);
203 }
204
205 while(!HasOverlappedIoCompleted(&ov)) {
206 Sleep(0);
207 }
208
209 if(!GetOverlappedResult(UsbHandle, &ov, &written, FALSE)) {
210 ShowError();
211 exit(-1);
212 }
213
214 if(wantAck) {
215 UsbCommand ack;
216 ReceiveCommand(&ack);
217 if(ack.cmd != CMD_ACK) {
218 printf("bad ACK\n");
219 exit(-1);
220 }
221 }
222 }
223
224 static DWORD ExpectedAddr;
225 static BYTE QueuedToSend[256];
226 static BOOL AllWritten;
227
228 static void FlushPrevious(void)
229 {
230 UsbCommand c;
231 memset(&c, 0, sizeof(c));
232
233 int i;
234 for(i = 0; i < 240; i += 48) {
235 c.cmd = CMD_SETUP_WRITE;
236 memcpy(c.d.asBytes, QueuedToSend+i, 48);
237 c.ext1 = (i/4);
238 SendCommand(&c, TRUE);
239 }
240
241 c.cmd = CMD_FINISH_WRITE;
242 c.ext1 = (ExpectedAddr-1) & (~255);
243 printf("Flashing address: %08x\r", c.ext1);
244 memcpy(c.d.asBytes, QueuedToSend+240, 16);
245 SendCommand(&c, TRUE);
246
247 AllWritten = TRUE;
248 }
249
250 static void GotByte(DWORD where, BYTE which)
251 {
252 AllWritten = FALSE;
253
254 if(where != ExpectedAddr) {
255 printf("bad: got at %08x, expected at %08x\n", where, ExpectedAddr);
256 exit(-1);
257 }
258 QueuedToSend[where & 255] = which;
259 ExpectedAddr++;
260
261 if((where & 255) == 255) {
262 // we have completed a full page
263 FlushPrevious();
264 }
265 }
266
267 static int HexVal(int c)
268 {
269 c = tolower(c);
270 if(c >= '0' && c <= '9') {
271 return c - '0';
272 } else if(c >= 'a' && c <= 'f') {
273 return (c - 'a') + 10;
274 } else {
275 printf("bad hex digit '%c'\n", c);
276 exit(-1);
277 }
278 }
279
280 static BYTE HexByte(char *s)
281 {
282 return (HexVal(s[0]) << 4) | HexVal(s[1]);
283 }
284
285 static void LoadFlashFromSRecords(char *file, int addr)
286 {
287 ExpectedAddr = addr;
288
289 FILE *f = fopen(file, "r");
290 if(!f) {
291 printf("couldn't open file\n");
292 exit(-1);
293 }
294
295 char line[512];
296 while(fgets(line, sizeof(line), f)) {
297 if(memcmp(line, "S3", 2)==0) {
298 char *s = line + 2;
299 int len = HexByte(s) - 5;
300 s += 2;
301
302 char addrStr[9];
303 memcpy(addrStr, s, 8);
304 addrStr[8] = '\0';
305 DWORD addr;
306 sscanf(addrStr, "%x", &addr);
307 s += 8;
308
309 int i;
310 for(i = 0; i < len; i++) {
311 while((addr+i) > ExpectedAddr) {
312 GotByte(ExpectedAddr, 0xff);
313 }
314 GotByte(addr+i, HexByte(s));
315 s += 2;
316 }
317 }
318 }
319
320 if(!AllWritten) FlushPrevious();
321
322 fclose(f);
323 printf("\ndone.\n");
324 }
325
326 int main(int argc, char **argv)
327 {
328 int i = 0;
329
330 if(argc < 2) {
331 printf("Usage: %s bootrom file.s19\n", argv[0]);
332 printf(" %s load osimage.s19\n", argv[0]);
333 printf(" %s fpga fpgaimg.s19\n", argv[0]);
334 printf(" %s gui\n", argv[0]);
335 printf(" %s offline\n", argv[0]);
336 return -1;
337 }
338
339 // Only do this if NOT in offline mode
340 if (strcmp(argv[1], "offline"))
341 {
342 for(;;) {
343 if(UsbConnect()) {
344 break;
345 }
346 if(i == 0) {
347 printf("...no device connected, polling for it now\n");
348 }
349 if(i > 50000) {
350 printf("Could not connect to USB device; exiting.\n");
351 return -1;
352 }
353 i++;
354 Sleep(5);
355 }
356 }
357
358 if(strcmp(argv[1], "bootrom")==0 || strcmp(argv[1], "load")==0 || strcmp(argv[1], "fpga")==0) {
359 if(argc != 3) {
360 printf("Need filename.\n");
361 return -1;
362 }
363 if(strcmp(argv[1], "bootrom")==0) {
364 LoadFlashFromSRecords(argv[2], 0);
365 } else if(strcmp(argv[1], "fpga")==0) {
366 LoadFlashFromSRecords(argv[2], 0x2000);
367 } else {
368 LoadFlashFromSRecords(argv[2], 0x10000);
369 }
370 } else if(strcmp(argv[1], "gui")==0) {
371 ShowGui();
372 } else if(strcmp(argv[1], "offline")==0) {
373 offline = 1;
374 ShowGui();
375 } else if(strcmp(argv[1], "cmd")==0) {
376 if(argc != 3) {
377 printf("Need command.\n");
378 return -1;
379 }
380 ExecCmd(argv[2]);
381 } else {
382 printf("Command '%s' not recognized.\n", argv[1]);
383 return -1;
384 }
385
386 return 0;
387 }
Impressum, Datenschutz