Allow include() directive for libconfuse formatted config
[libftdi] / ftdi_eeprom / main.c
1 /***************************************************************************
2                              main.c  -  description
3                            -------------------
4     begin                : Mon Apr  7 12:05:22 CEST 2003
5     copyright            : (C) 2003-2014 by Intra2net AG and the libftdi developers
6     email                : opensource@intra2net.com
7  ***************************************************************************/
8
9 /***************************************************************************
10  *                                                                         *
11  *   This program is free software; you can redistribute it and/or modify  *
12  *   it under the terms of the GNU General Public License version 2 as     *
13  *   published by the Free Software Foundation.                            *
14  *                                                                         *
15  ***************************************************************************/
16
17 /*
18  TODO:
19     - Merge Uwe's eeprom tool. Current features:
20         - Init eeprom defaults based upon eeprom type
21         - Read -> Already there
22         - Write -> Already there
23         - Erase -> Already there
24         - Decode on stdout
25         - Ability to find device by PID/VID, product name or serial
26
27  TODO nice-to-have:
28     - Out-of-the-box compatibility with FTDI's eeprom tool configuration files
29  */
30
31 #ifdef HAVE_CONFIG_H
32 #include <config.h>
33 #endif
34
35 #include <stdlib.h>
36 #include <stdio.h>
37 #include <string.h>
38 #include <errno.h>
39
40 #include <confuse.h>
41 #include <libusb.h>
42 #include <ftdi.h>
43 #include <ftdi_eeprom_version.h>
44
45 static int parse_cbus(cfg_t *cfg, cfg_opt_t *opt, const char *value, void *result)
46 {
47     static const char* options[] =
48     {
49         "TXDEN", "PWREN", "RXLED", "TXLED", "TXRXLED", "SLEEP", "CLK48",
50         "CLK24", "CLK12", "CLK6", "IOMODE", "BB_WR", "BB_RD"
51     };
52
53     int i;
54     for (i=0; i<sizeof(options)/sizeof(*options); i++)
55     {
56         if (!(strcmp(options[i], value)))
57         {
58             *(int *)result = i;
59             return 0;
60         }
61     }
62
63     cfg_error(cfg, "Invalid %s option '%s'", cfg_opt_name(opt), value);
64     return -1;
65 }
66
67 static int parse_cbush(cfg_t *cfg, cfg_opt_t *opt, const char *value, void *result)
68 {
69     static const char* options[] =
70     {
71         "TRISTATE", "TXLED", "RXLED", "TXRXLED", "PWREN", "SLEEP",
72         "DRIVE_0", "DRIVE1", "IOMODE", "TXDEN", "CLK30", "CLK15", "CLK7_5"
73     };
74
75     int i;
76     for (i=0; i<sizeof(options)/sizeof(*options); i++)
77     {
78         if (!(strcmp(options[i], value)))
79         {
80             *(int *)result = i;
81             return 0;
82         }
83     }
84
85     cfg_error(cfg, "Invalid %s option '%s'", cfg_opt_name(opt), value);
86     return -1;
87 }
88
89 static int parse_cbusx(cfg_t *cfg, cfg_opt_t *opt, const char *value, void *result)
90 {
91     static const char* options[] =
92     {
93         "TRISTATE", "TXLED", "RXLED", "TXRXLED", "PWREN", "SLEEP",
94         "DRIVE_0", "DRIVE1", "IOMODE", "TXDEN", "CLK24", "CLK12",
95         "CLK6", "BAT_DETECT", "BAT_DETECT_NEG", "I2C_TXE", "I2C_RXF", "VBUS_SENSE",
96         "BB_WR", "BB_RD", "TIME_STAMP", "AWAKE"
97     };
98
99     int i;
100     for (i=0; i<sizeof(options)/sizeof(*options); i++)
101     {
102         if (!(strcmp(options[i], value)))
103         {
104             *(int *)result = i;
105             return 0;
106         }
107     }
108
109     cfg_error(cfg, "Invalid %s option '%s'", cfg_opt_name(opt), value);
110     return -1;
111 }
112
113 static int parse_chtype(cfg_t *cfg, cfg_opt_t *opt, const char *value, void *result)
114 {
115     static const struct
116     {
117         char* key;
118         int   opt;
119     } options[] =
120     {
121         { "UART",   CHANNEL_IS_UART },
122         { "FIFO",   CHANNEL_IS_FIFO },
123         { "OPTO",   CHANNEL_IS_OPTO },
124         { "CPU",    CHANNEL_IS_CPU },
125         { "FT1284", CHANNEL_IS_FT1284}
126     };
127
128     int i;
129     for (i=0; i<sizeof(options)/sizeof(*options); i++)
130     {
131         if (!(strcmp(options[i].key, value)))
132         {
133             *(int *)result = options[i].opt;
134             return 0;
135         }
136     }
137
138     cfg_error(cfg, "Invalid %s option '%s'", cfg_opt_name(opt), value);
139     return -1;
140 }
141
142 /**
143  * @brief Set eeprom value
144  *
145  * \param ftdi pointer to ftdi_context
146  * \param value_name Enum of the value to set
147  * \param value Value to set
148  *
149  * Function will abort the program on error
150  **/
151 static void eeprom_set_value(struct ftdi_context *ftdi, enum ftdi_eeprom_value value_name, int value)
152 {
153     if (ftdi_set_eeprom_value(ftdi, value_name, value) < 0)
154     {
155         printf("Unable to set eeprom value %d: %s. Aborting\n", value_name, ftdi_get_error_string(ftdi));
156         exit (-1);
157     }
158 }
159
160 /**
161  * @brief Get eeprom value
162  *
163  * \param ftdi pointer to ftdi_context
164  * \param value_name Enum of the value to get
165  * \param value Value to get
166  *
167  * Function will abort the program on error
168  **/
169 static void eeprom_get_value(struct ftdi_context *ftdi, enum ftdi_eeprom_value value_name, int *value)
170 {
171     if (ftdi_get_eeprom_value(ftdi, value_name, value) < 0)
172     {
173         printf("Unable to get eeprom value %d: %s. Aborting\n", value_name, ftdi_get_error_string(ftdi));
174         exit (-1);
175     }
176 }
177
178 static void usage(const char *program)
179 {
180     fprintf(stderr, "Syntax: %s [...options...] <config-file>\n", program);
181     fprintf(stderr, "Valid Options:\n");
182     fprintf(stderr, "--device <description>  Specify device to open by description string. One of:\n");
183     fprintf(stderr, "         d:<devicenode>\n");
184     fprintf(stderr, "         i:<vendor>:<product>\n");
185     fprintf(stderr, "         i:<vendor>:<product>:<index>\n");
186     fprintf(stderr, "         s:<vendor>:<product>:<serial>\n");
187     fprintf(stderr, "--read-eeprom           Read eeprom and write to -filename- from config-file\n");
188     fprintf(stderr, "--erase-eeprom          Erase eeprom\n");
189     fprintf(stderr, "--flash-eeprom          Flash eeprom\n");
190 }
191
192 int main(int argc, char *argv[])
193 {
194     /*
195     configuration options
196     */
197     cfg_opt_t opts[] =
198     {
199         CFG_INT("vendor_id", 0, 0),
200         CFG_INT("product_id", 0, 0),
201         CFG_BOOL("self_powered", cfg_true, 0),
202         CFG_BOOL("remote_wakeup", cfg_true, 0),
203         CFG_BOOL("in_is_isochronous", cfg_false, 0),
204         CFG_BOOL("out_is_isochronous", cfg_false, 0),
205         CFG_BOOL("suspend_pull_downs", cfg_false, 0),
206         CFG_BOOL("use_serial", cfg_false, 0),
207         CFG_BOOL("change_usb_version", cfg_false, 0),
208         CFG_INT("usb_version", 0, 0),
209         CFG_INT("default_pid", 0x6001, 0),
210         CFG_INT("max_power", 0, 0),
211         CFG_STR("manufacturer", "Acme Inc.", 0),
212         CFG_STR("product", "USB Serial Converter", 0),
213         CFG_STR("serial", "08-15", 0),
214         CFG_INT("eeprom_type", 0x00, 0),
215         CFG_STR("filename", "", 0),
216         CFG_BOOL("flash_raw", cfg_false, 0),
217         CFG_BOOL("high_current", cfg_false, 0),
218         CFG_INT_CB("cbus0", -1, 0, parse_cbus),
219         CFG_INT_CB("cbus1", -1, 0, parse_cbus),
220         CFG_INT_CB("cbus2", -1, 0, parse_cbus),
221         CFG_INT_CB("cbus3", -1, 0, parse_cbus),
222         CFG_INT_CB("cbus4", -1, 0, parse_cbus),
223         CFG_INT_CB("cbush0", -1, 0, parse_cbush),
224         CFG_INT_CB("cbush1", -1, 0, parse_cbush),
225         CFG_INT_CB("cbush2", -1, 0, parse_cbush),
226         CFG_INT_CB("cbush3", -1, 0, parse_cbush),
227         CFG_INT_CB("cbush4", -1, 0, parse_cbush),
228         CFG_INT_CB("cbush5", -1, 0, parse_cbush),
229         CFG_INT_CB("cbush6", -1, 0, parse_cbush),
230         CFG_INT_CB("cbush7", -1, 0, parse_cbush),
231         CFG_INT_CB("cbush8", -1, 0, parse_cbush),
232         CFG_INT_CB("cbush9", -1, 0, parse_cbush),
233         CFG_INT_CB("cbusx0", -1, 0, parse_cbusx),
234         CFG_INT_CB("cbusx1", -1, 0, parse_cbusx),
235         CFG_INT_CB("cbusx2", -1, 0, parse_cbusx),
236         CFG_INT_CB("cbusx3", -1, 0, parse_cbusx),
237         CFG_BOOL("invert_txd", cfg_false, 0),
238         CFG_BOOL("invert_rxd", cfg_false, 0),
239         CFG_BOOL("invert_rts", cfg_false, 0),
240         CFG_BOOL("invert_cts", cfg_false, 0),
241         CFG_BOOL("invert_dtr", cfg_false, 0),
242         CFG_BOOL("invert_dsr", cfg_false, 0),
243         CFG_BOOL("invert_dcd", cfg_false, 0),
244         CFG_BOOL("invert_ri", cfg_false, 0),
245         CFG_INT_CB("cha_type", -1, 0, parse_chtype),
246         CFG_INT_CB("chb_type", -1, 0, parse_chtype),
247         CFG_BOOL("cha_vcp", cfg_true, 0),
248         CFG_BOOL("chb_vcp", cfg_true, 0),
249         CFG_BOOL("chc_vcp", cfg_true, 0),
250         CFG_BOOL("chd_vcp", cfg_true, 0),
251         CFG_BOOL("cha_rs485", cfg_false, 0),
252         CFG_BOOL("chb_rs485", cfg_false, 0),
253         CFG_BOOL("chc_rs485", cfg_false, 0),
254         CFG_BOOL("chd_rs485", cfg_false, 0),
255         CFG_FUNC("include", &cfg_include),
256         CFG_END()
257     };
258     cfg_t *cfg;
259
260     /*
261     normal variables
262     */
263     enum {
264         COMMAND_READ = 1,
265         COMMAND_ERASE,
266         COMMAND_FLASH
267     } command = 0;
268     const char *cfg_filename = NULL;
269     const char *device_description = NULL;
270
271     const int max_eeprom_size = 256;
272     int my_eeprom_size = 0;
273     unsigned char *eeprom_buf = NULL;
274     char *filename;
275     int size_check;
276     int i;
277     FILE *fp;
278
279     struct ftdi_context *ftdi = NULL;
280
281     printf("\nFTDI eeprom generator v%s\n", EEPROM_VERSION_STRING);
282     printf ("(c) Intra2net AG and the libftdi developers <opensource@intra2net.com>\n");
283
284     for (i = 1; i < argc; i++) {
285         if (*argv[i] != '-')
286         {
287             cfg_filename = argv[i];
288         }
289         else if (!strcmp(argv[i], "--device"))
290         {
291             if (i+1 >= argc)
292             {
293                 usage(argv[0]);
294                 exit(-1);
295             }
296             device_description = argv[++i];
297         }
298         else if (!strcmp(argv[i], "--read-eeprom"))
299         {
300             command = COMMAND_READ;
301         }
302         else if (!strcmp(argv[i], "--erase-eeprom"))
303         {
304             command = COMMAND_ERASE;
305         }
306         else if (!strcmp(argv[i], "--flash-eeprom"))
307         {
308             command = COMMAND_FLASH;
309         }
310         else
311         {
312             usage(argv[0]);
313             exit(-1);
314         }
315     }
316
317     if (!cfg_filename)
318     {
319         usage(argv[0]);
320         exit(-1);
321     }
322
323     if ((fp = fopen(cfg_filename, "r")) == NULL)
324     {
325         printf ("Can't open configuration file\n");
326         exit (-1);
327     }
328     fclose (fp);
329
330     cfg = cfg_init(opts, 0);
331     cfg_parse(cfg, cfg_filename);
332     filename = cfg_getstr(cfg, "filename");
333
334     if (cfg_getbool(cfg, "self_powered") && cfg_getint(cfg, "max_power") > 0)
335         printf("Hint: Self powered devices should have a max_power setting of 0.\n");
336
337     if ((ftdi = ftdi_new()) == 0)
338     {
339         fprintf(stderr, "Failed to allocate ftdi structure :%s \n",
340                 ftdi_get_error_string(ftdi));
341         return EXIT_FAILURE;
342     }
343
344     if (device_description != NULL)
345     {
346         i = ftdi_usb_open_string(ftdi, device_description);
347
348         if (i != 0)
349         {
350             printf("Unable to find FTDI device with description: %s\n",
351                    device_description);
352             printf("Error code: %d (%s)\n", i, ftdi_get_error_string(ftdi));
353             exit (-1);
354         }
355     }
356     else if (command > 0)
357     {
358         int vendor_id = cfg_getint(cfg, "vendor_id");
359         int product_id = cfg_getint(cfg, "product_id");
360
361         i = ftdi_usb_open(ftdi, vendor_id, product_id);
362
363         if (i != 0)
364         {
365             int default_pid = cfg_getint(cfg, "default_pid");
366             printf("Unable to find FTDI devices under given vendor/product id: 0x%X/0x%X\n", vendor_id, product_id);
367             printf("Error code: %d (%s)\n", i, ftdi_get_error_string(ftdi));
368             printf("Retrying with default FTDI pid=%#04x.\n", default_pid);
369
370             i = ftdi_usb_open(ftdi, 0x0403, default_pid);
371             if (i != 0)
372             {
373                 printf("Error: %s\n", ftdi->error_str);
374                 exit (-1);
375             }
376         }
377     }
378     ftdi_eeprom_initdefaults (ftdi, cfg_getstr(cfg, "manufacturer"),
379                               cfg_getstr(cfg, "product"),
380                               cfg_getstr(cfg, "serial"));
381
382     printf("FTDI read eeprom: %d\n", ftdi_read_eeprom(ftdi));
383     eeprom_get_value(ftdi, CHIP_SIZE, &my_eeprom_size);
384     printf("EEPROM size: %d\n", my_eeprom_size);
385
386     if (command == COMMAND_READ)
387     {
388         ftdi_eeprom_decode(ftdi, 0 /* debug: 1 */);
389
390         eeprom_buf = malloc(my_eeprom_size);
391         ftdi_get_eeprom_buf(ftdi, eeprom_buf, my_eeprom_size);
392
393         if (eeprom_buf == NULL)
394         {
395             fprintf(stderr, "Malloc failed, aborting\n");
396             goto cleanup;
397         }
398         if (filename != NULL && strlen(filename) > 0)
399         {
400             FILE *fp = fopen (filename, "wb");
401             
402             if(fp)
403             {
404                 fwrite(eeprom_buf, 1, my_eeprom_size, fp);
405                 fclose(fp);
406             }
407             else
408                 fprintf(stderr, "Could not open output file %s: %s\n", filename, strerror(errno));
409         }
410         else
411         {
412             printf("Warning: Not writing eeprom, you must supply a valid filename\n");
413         }
414
415         goto cleanup;
416     }
417
418     eeprom_set_value(ftdi, VENDOR_ID, cfg_getint(cfg, "vendor_id"));
419     eeprom_set_value(ftdi, PRODUCT_ID, cfg_getint(cfg, "product_id"));
420
421     eeprom_set_value(ftdi, SELF_POWERED, cfg_getbool(cfg, "self_powered"));
422     eeprom_set_value(ftdi, REMOTE_WAKEUP, cfg_getbool(cfg, "remote_wakeup"));
423     eeprom_set_value(ftdi, MAX_POWER, cfg_getint(cfg, "max_power"));
424
425     eeprom_set_value(ftdi, IN_IS_ISOCHRONOUS, cfg_getbool(cfg, "in_is_isochronous"));
426     eeprom_set_value(ftdi, OUT_IS_ISOCHRONOUS, cfg_getbool(cfg, "out_is_isochronous"));
427     eeprom_set_value(ftdi, SUSPEND_PULL_DOWNS, cfg_getbool(cfg, "suspend_pull_downs"));
428
429     eeprom_set_value(ftdi, USE_SERIAL, cfg_getbool(cfg, "use_serial"));
430     eeprom_set_value(ftdi, USE_USB_VERSION, cfg_getbool(cfg, "change_usb_version"));
431     eeprom_set_value(ftdi, USB_VERSION, cfg_getint(cfg, "usb_version"));
432     eeprom_set_value(ftdi, CHIP_TYPE, cfg_getint(cfg, "eeprom_type"));
433
434     eeprom_set_value(ftdi, HIGH_CURRENT, cfg_getbool(cfg, "high_current"));
435
436     if (ftdi->type == TYPE_R)
437     {
438         if (cfg_getint(cfg, "cbus0") != -1)
439             eeprom_set_value(ftdi, CBUS_FUNCTION_0, cfg_getint(cfg, "cbus0"));
440         if (cfg_getint(cfg, "cbus1") != -1)
441             eeprom_set_value(ftdi, CBUS_FUNCTION_1, cfg_getint(cfg, "cbus1"));
442         if (cfg_getint(cfg, "cbus2") != -1)
443             eeprom_set_value(ftdi, CBUS_FUNCTION_2, cfg_getint(cfg, "cbus2"));
444         if (cfg_getint(cfg, "cbus3") != -1)
445             eeprom_set_value(ftdi, CBUS_FUNCTION_3, cfg_getint(cfg, "cbus3"));
446         if (cfg_getint(cfg, "cbus4") != -1)
447             eeprom_set_value(ftdi, CBUS_FUNCTION_4, cfg_getint(cfg, "cbus4"));
448     }
449     else if (ftdi->type == TYPE_232H)
450     {
451         if (cfg_getint(cfg, "cbush0") != -1)
452             eeprom_set_value(ftdi, CBUS_FUNCTION_0, cfg_getint(cfg, "cbush0"));
453         if (cfg_getint(cfg, "cbush1") != -1)
454             eeprom_set_value(ftdi, CBUS_FUNCTION_1, cfg_getint(cfg, "cbush1"));
455         if (cfg_getint(cfg, "cbush2") != -1)
456             eeprom_set_value(ftdi, CBUS_FUNCTION_2, cfg_getint(cfg, "cbush2"));
457         if (cfg_getint(cfg, "cbush3") != -1)
458             eeprom_set_value(ftdi, CBUS_FUNCTION_3, cfg_getint(cfg, "cbush3"));
459         if (cfg_getint(cfg, "cbush4") != -1)
460             eeprom_set_value(ftdi, CBUS_FUNCTION_4, cfg_getint(cfg, "cbush4"));
461         if (cfg_getint(cfg, "cbush5") != -1)
462             eeprom_set_value(ftdi, CBUS_FUNCTION_5, cfg_getint(cfg, "cbush5"));
463         if (cfg_getint(cfg, "cbush6") != -1)
464             eeprom_set_value(ftdi, CBUS_FUNCTION_6, cfg_getint(cfg, "cbush6"));
465         if (cfg_getint(cfg, "cbush7") != -1)
466             eeprom_set_value(ftdi, CBUS_FUNCTION_7, cfg_getint(cfg, "cbush7"));
467         if (cfg_getint(cfg, "cbush8") != -1)
468             eeprom_set_value(ftdi, CBUS_FUNCTION_8, cfg_getint(cfg, "cbush8"));
469         if (cfg_getint(cfg, "cbush9") != -1)
470             eeprom_set_value(ftdi, CBUS_FUNCTION_9, cfg_getint(cfg, "cbush9"));
471     }
472     else if (ftdi->type == TYPE_230X)
473     {
474         if (cfg_getint(cfg, "cbusx0") != -1)
475             eeprom_set_value(ftdi, CBUS_FUNCTION_0, cfg_getint(cfg, "cbusx0"));
476         if (cfg_getint(cfg, "cbusx1") != -1)
477             eeprom_set_value(ftdi, CBUS_FUNCTION_1, cfg_getint(cfg, "cbusx1"));
478         if (cfg_getint(cfg, "cbusx2") != -1)
479             eeprom_set_value(ftdi, CBUS_FUNCTION_2, cfg_getint(cfg, "cbusx2"));
480         if (cfg_getint(cfg, "cbusx3") != -1)
481             eeprom_set_value(ftdi, CBUS_FUNCTION_3, cfg_getint(cfg, "cbusx3"));
482     }
483
484     int invert = 0;
485     if (cfg_getbool(cfg, "invert_rxd")) invert |= INVERT_RXD;
486     if (cfg_getbool(cfg, "invert_txd")) invert |= INVERT_TXD;
487     if (cfg_getbool(cfg, "invert_rts")) invert |= INVERT_RTS;
488     if (cfg_getbool(cfg, "invert_cts")) invert |= INVERT_CTS;
489     if (cfg_getbool(cfg, "invert_dtr")) invert |= INVERT_DTR;
490     if (cfg_getbool(cfg, "invert_dsr")) invert |= INVERT_DSR;
491     if (cfg_getbool(cfg, "invert_dcd")) invert |= INVERT_DCD;
492     if (cfg_getbool(cfg, "invert_ri")) invert |= INVERT_RI;
493     eeprom_set_value(ftdi, INVERT, invert);
494
495     if (cfg_getint(cfg, "cha_type") != -1)
496         eeprom_set_value(ftdi, CHANNEL_A_TYPE, cfg_getint(cfg, "cha_type"));
497     if (cfg_getint(cfg, "chb_type") != -1)
498         eeprom_set_value(ftdi, CHANNEL_B_TYPE, cfg_getint(cfg, "chb_type"));
499
500     eeprom_set_value(ftdi, CHANNEL_A_DRIVER,
501                      cfg_getbool(cfg, "cha_vcp") ? DRIVER_VCP : 0);
502     eeprom_set_value(ftdi, CHANNEL_B_DRIVER,
503                      cfg_getbool(cfg, "chb_vcp") ? DRIVER_VCP : 0);
504     eeprom_set_value(ftdi, CHANNEL_C_DRIVER,
505                      cfg_getbool(cfg, "chc_vcp") ? DRIVER_VCP : 0);
506     eeprom_set_value(ftdi, CHANNEL_D_DRIVER,
507                      cfg_getbool(cfg, "chd_vcp") ? DRIVER_VCP : 0);
508
509     eeprom_set_value(ftdi, CHANNEL_A_RS485, cfg_getbool(cfg, "cha_rs485"));
510     eeprom_set_value(ftdi, CHANNEL_B_RS485, cfg_getbool(cfg, "chb_rs485"));
511     eeprom_set_value(ftdi, CHANNEL_C_RS485, cfg_getbool(cfg, "chc_rs485"));
512     eeprom_set_value(ftdi, CHANNEL_D_RS485, cfg_getbool(cfg, "chd_rs485"));
513
514     if (command == COMMAND_ERASE)
515     {
516         printf("FTDI erase eeprom: %d\n", ftdi_erase_eeprom(ftdi));
517     }
518
519     size_check = ftdi_eeprom_build(ftdi);
520     eeprom_get_value(ftdi, CHIP_SIZE, &my_eeprom_size);
521
522     if (size_check == -1)
523     {
524         printf ("Sorry, the eeprom can only contain 128 bytes.\n");
525         goto cleanup;
526     }
527     else if (size_check < 0)
528     {
529         printf ("ftdi_eeprom_build(): error: %d\n", size_check);
530         goto cleanup;
531     }
532     else
533     {
534         printf ("Used eeprom space: %d bytes\n", my_eeprom_size-size_check);
535     }
536
537     if (command == COMMAND_FLASH)
538     {
539         if (cfg_getbool(cfg, "flash_raw"))
540         {
541             if (filename != NULL && strlen(filename) > 0)
542             {
543                 eeprom_buf = malloc(max_eeprom_size);
544                 FILE *fp = fopen(filename, "rb");
545                 if (fp == NULL)
546                 {
547                     printf ("Can't open eeprom file %s.\n", filename);
548                     exit (-1);
549                 }
550                 my_eeprom_size = fread(eeprom_buf, 1, max_eeprom_size, fp);
551                 fclose(fp);
552                 if (my_eeprom_size < 128)
553                 {
554                     printf ("Can't read eeprom file %s.\n", filename);
555                     exit (-1);
556                 }
557
558                 ftdi_set_eeprom_buf(ftdi, eeprom_buf, my_eeprom_size);
559             }
560         }
561         printf ("FTDI write eeprom: %d\n", ftdi_write_eeprom(ftdi));
562         libusb_reset_device(ftdi->usb_dev);
563     }
564
565     // Write to file?
566     if (filename != NULL && strlen(filename) > 0 && !cfg_getbool(cfg, "flash_raw"))
567     {
568         fp = fopen(filename, "w");
569         if (fp == NULL)
570         {
571             printf ("Can't write eeprom file.\n");
572             exit (-1);
573         }
574         else
575             printf ("Writing to file: %s\n", filename);
576
577         if (eeprom_buf == NULL)
578             eeprom_buf = malloc(my_eeprom_size);
579         ftdi_get_eeprom_buf(ftdi, eeprom_buf, my_eeprom_size);
580
581         fwrite(eeprom_buf, my_eeprom_size, 1, fp);
582         fclose(fp);
583     }
584
585 cleanup:
586     if (eeprom_buf)
587         free(eeprom_buf);
588     if (command > 0)
589     {
590         printf("FTDI close: %d\n", ftdi_usb_close(ftdi));
591     }
592
593     ftdi_deinit (ftdi);
594     ftdi_free (ftdi);
595
596     cfg_free(cfg);
597
598     printf("\n");
599     return 0;
600 }