fpgautils.c 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140
  1. /*
  2. * Copyright 2012-2013 Luke Dashjr
  3. * Copyright 2013 Con Kolivas
  4. * Copyright 2012 Andrew Smith
  5. * Copyright 2013 Xiangfu
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License as published by the Free
  9. * Software Foundation; either version 3 of the License, or (at your option)
  10. * any later version. See COPYING for more details.
  11. */
  12. #include "config.h"
  13. #ifdef WIN32
  14. #include <winsock2.h>
  15. #endif
  16. #include <ctype.h>
  17. #include <stdarg.h>
  18. #include <stdint.h>
  19. #include <stdlib.h>
  20. #include <sys/types.h>
  21. #include <dirent.h>
  22. #include <string.h>
  23. #ifdef HAVE_SYS_FILE_H
  24. #include <sys/file.h>
  25. #endif
  26. #ifdef HAVE_LIBUSB
  27. #include <libusb.h>
  28. #endif
  29. #include "miner.h"
  30. #ifndef WIN32
  31. #include <errno.h>
  32. #include <termios.h>
  33. #include <sys/ioctl.h>
  34. #include <sys/stat.h>
  35. #include <unistd.h>
  36. #include <fcntl.h>
  37. #ifndef O_CLOEXEC
  38. #define O_CLOEXEC 0
  39. #endif
  40. #else /* WIN32 */
  41. #include <windows.h>
  42. #include <io.h>
  43. #include <utlist.h>
  44. #define dlsym (void*)GetProcAddress
  45. #define dlclose FreeLibrary
  46. typedef unsigned long FT_STATUS;
  47. typedef PVOID FT_HANDLE;
  48. __stdcall FT_STATUS (*FT_ListDevices)(PVOID pArg1, PVOID pArg2, DWORD Flags);
  49. __stdcall FT_STATUS (*FT_Open)(int idx, FT_HANDLE*);
  50. __stdcall FT_STATUS (*FT_GetComPortNumber)(FT_HANDLE, LPLONG lplComPortNumber);
  51. __stdcall FT_STATUS (*FT_Close)(FT_HANDLE);
  52. const uint32_t FT_OPEN_BY_DESCRIPTION = 2;
  53. const uint32_t FT_LIST_ALL = 0x20000000;
  54. const uint32_t FT_LIST_NUMBER_ONLY = 0x80000000;
  55. enum {
  56. FT_OK,
  57. };
  58. #endif /* WIN32 */
  59. #ifdef HAVE_LIBUDEV
  60. #include <libudev.h>
  61. #include <sys/ioctl.h>
  62. #endif
  63. #include "logging.h"
  64. #include "miner.h"
  65. #include "fpgautils.h"
  66. #define SEARCH_NEEDLES_BEGIN() { \
  67. const char *needle; \
  68. bool __cont = false; \
  69. va_list ap; \
  70. va_copy(ap, needles); \
  71. while ( (needle = va_arg(ap, const char *)) ) \
  72. {
  73. #define SEARCH_NEEDLES_END(...) \
  74. } \
  75. va_end(ap); \
  76. if (__cont) \
  77. { \
  78. __VA_ARGS__; \
  79. } \
  80. }
  81. static inline
  82. bool search_needles(const char *haystack, va_list needles)
  83. {
  84. bool rv = true;
  85. SEARCH_NEEDLES_BEGIN()
  86. if (!strstr(haystack, needle))
  87. {
  88. rv = false;
  89. break;
  90. }
  91. SEARCH_NEEDLES_END()
  92. return rv;
  93. }
  94. #define SEARCH_NEEDLES(haystack) search_needles(haystack, needles)
  95. static
  96. int _detectone_wrap(const detectone_func_t detectone, const char * const param, const char *fname)
  97. {
  98. if (bfg_claim_serial(NULL, true, param))
  99. {
  100. applog(LOG_DEBUG, "%s: %s is already claimed, skipping probe", fname, param);
  101. return 0;
  102. }
  103. return detectone(param);
  104. }
  105. #define detectone(param) _detectone_wrap(detectone, param, __func__)
  106. struct detectone_meta_info_t detectone_meta_info;
  107. void clear_detectone_meta_info(void)
  108. {
  109. detectone_meta_info = (struct detectone_meta_info_t){
  110. .manufacturer = NULL,
  111. };
  112. }
  113. #ifdef HAVE_LIBUDEV
  114. static
  115. void _decode_udev_enc(char *o, const char *s)
  116. {
  117. while(s[0])
  118. {
  119. if (s[0] == '\\' && s[1] == 'x' && s[2] && s[3])
  120. {
  121. hex2bin((void*)(o++), &s[2], 1);
  122. s += 4;
  123. }
  124. else
  125. (o++)[0] = (s++)[0];
  126. }
  127. o[0] = '\0';
  128. }
  129. static
  130. char *_decode_udev_enc_dup(const char *s)
  131. {
  132. if (!s)
  133. return NULL;
  134. char *o = malloc(strlen(s) + 1);
  135. if (!o)
  136. {
  137. applog(LOG_ERR, "Failed to malloc in _decode_udev_enc_dup");
  138. return NULL;
  139. }
  140. _decode_udev_enc(o, s);
  141. return o;
  142. }
  143. static
  144. int _serial_autodetect_udev(detectone_func_t detectone, va_list needles)
  145. {
  146. struct udev *udev = udev_new();
  147. struct udev_enumerate *enumerate = udev_enumerate_new(udev);
  148. struct udev_list_entry *list_entry;
  149. char found = 0;
  150. udev_enumerate_add_match_subsystem(enumerate, "tty");
  151. udev_enumerate_scan_devices(enumerate);
  152. udev_list_entry_foreach(list_entry, udev_enumerate_get_list_entry(enumerate)) {
  153. struct udev_device *device = udev_device_new_from_syspath(
  154. udev_enumerate_get_udev(enumerate),
  155. udev_list_entry_get_name(list_entry)
  156. );
  157. if (!device)
  158. continue;
  159. const char *model = udev_device_get_property_value(device, "ID_MODEL");
  160. if (!(model && SEARCH_NEEDLES(model)))
  161. {
  162. udev_device_unref(device);
  163. continue;
  164. }
  165. detectone_meta_info = (struct detectone_meta_info_t){
  166. .manufacturer = _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_VENDOR_ENC")),
  167. .product = _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_MODEL_ENC")),
  168. .serial = _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_SERIAL_SHORT")),
  169. };
  170. const char *devpath = udev_device_get_devnode(device);
  171. if (devpath && detectone(devpath))
  172. ++found;
  173. free((void*)detectone_meta_info.manufacturer);
  174. free((void*)detectone_meta_info.product);
  175. free((void*)detectone_meta_info.serial);
  176. udev_device_unref(device);
  177. }
  178. udev_enumerate_unref(enumerate);
  179. udev_unref(udev);
  180. clear_detectone_meta_info();
  181. return found;
  182. }
  183. #else
  184. # define _serial_autodetect_udev(...) (0)
  185. #endif
  186. #ifndef WIN32
  187. static
  188. int _serial_autodetect_devserial(detectone_func_t detectone, va_list needles)
  189. {
  190. DIR *D;
  191. struct dirent *de;
  192. const char udevdir[] = "/dev/serial/by-id";
  193. char devpath[sizeof(udevdir) + 1 + NAME_MAX];
  194. char *devfile = devpath + sizeof(udevdir);
  195. char found = 0;
  196. // No way to split this out of the filename reliably
  197. clear_detectone_meta_info();
  198. D = opendir(udevdir);
  199. if (!D)
  200. return 0;
  201. memcpy(devpath, udevdir, sizeof(udevdir) - 1);
  202. devpath[sizeof(udevdir) - 1] = '/';
  203. while ( (de = readdir(D)) ) {
  204. if (!SEARCH_NEEDLES(de->d_name))
  205. continue;
  206. strcpy(devfile, de->d_name);
  207. if (detectone(devpath))
  208. ++found;
  209. }
  210. closedir(D);
  211. return found;
  212. }
  213. #else
  214. # define _serial_autodetect_devserial(...) (0)
  215. #endif
  216. #ifndef WIN32
  217. static
  218. char *_sysfs_do_read(char *buf, size_t bufsz, const char *devpath, char *devfile, const char *append)
  219. {
  220. FILE *F;
  221. strcpy(devfile, append);
  222. F = fopen(devpath, "r");
  223. if (F)
  224. {
  225. if (fgets(buf, bufsz, F))
  226. {
  227. size_t L = strlen(buf);
  228. while (isCspace(buf[--L]))
  229. buf[L] = '\0';
  230. }
  231. else
  232. buf[0] = '\0';
  233. fclose(F);
  234. }
  235. else
  236. buf[0] = '\0';
  237. return buf[0] ? buf : NULL;
  238. }
  239. static
  240. void _sysfs_find_tty(detectone_func_t detectone, char *devpath, char *devfile, const char *prod, char *pfound)
  241. {
  242. DIR *DT;
  243. struct dirent *de;
  244. char ttybuf[0x10] = "/dev/";
  245. char manuf[0x40], serial[0x40];
  246. char *mydevfile = strdup(devfile);
  247. DT = opendir(devpath);
  248. if (!DT)
  249. goto out;
  250. while ( (de = readdir(DT)) )
  251. {
  252. if (strncmp(de->d_name, "tty", 3))
  253. continue;
  254. if (!de->d_name[3])
  255. {
  256. // "tty" directory: recurse (needed for ttyACM)
  257. sprintf(devfile, "%s/tty", mydevfile);
  258. _sysfs_find_tty(detectone, devpath, devfile, prod, pfound);
  259. continue;
  260. }
  261. if (strncmp(&de->d_name[3], "USB", 3) && strncmp(&de->d_name[3], "ACM", 3))
  262. continue;
  263. detectone_meta_info = (struct detectone_meta_info_t){
  264. .manufacturer = _sysfs_do_read(manuf, sizeof(manuf), devpath, devfile, "/manufacturer"),
  265. .product = prod,
  266. .serial = _sysfs_do_read(serial, sizeof(serial), devpath, devfile, "/serial"),
  267. };
  268. strcpy(&ttybuf[5], de->d_name);
  269. if (detectone(ttybuf))
  270. ++*pfound;
  271. }
  272. closedir(DT);
  273. out:
  274. free(mydevfile);
  275. }
  276. static
  277. int _serial_autodetect_sysfs(detectone_func_t detectone, va_list needles)
  278. {
  279. DIR *D, *DS;
  280. struct dirent *de;
  281. const char devroot[] = "/sys/bus/usb/devices";
  282. const size_t devrootlen = sizeof(devroot) - 1;
  283. char devpath[sizeof(devroot) + (NAME_MAX * 3)];
  284. char prod[0x40];
  285. char *devfile, *upfile;
  286. char found = 0;
  287. size_t len, len2;
  288. D = opendir(devroot);
  289. if (!D)
  290. return 0;
  291. memcpy(devpath, devroot, devrootlen);
  292. devpath[devrootlen] = '/';
  293. while ( (de = readdir(D)) )
  294. {
  295. len = strlen(de->d_name);
  296. upfile = &devpath[devrootlen + 1];
  297. memcpy(upfile, de->d_name, len);
  298. devfile = upfile + len;
  299. if (!_sysfs_do_read(prod, sizeof(prod), devpath, devfile, "/product"))
  300. continue;
  301. if (!SEARCH_NEEDLES(prod))
  302. continue;
  303. devfile[0] = '\0';
  304. DS = opendir(devpath);
  305. if (!DS)
  306. continue;
  307. devfile[0] = '/';
  308. ++devfile;
  309. while ( (de = readdir(DS)) )
  310. {
  311. if (strncmp(de->d_name, upfile, len))
  312. continue;
  313. len2 = strlen(de->d_name);
  314. memcpy(devfile, de->d_name, len2 + 1);
  315. _sysfs_find_tty(detectone, devpath, devfile, prod, &found);
  316. }
  317. closedir(DS);
  318. }
  319. closedir(D);
  320. clear_detectone_meta_info();
  321. return found;
  322. }
  323. #else
  324. # define _serial_autodetect_sysfs(...) (0)
  325. #endif
  326. #ifdef WIN32
  327. #define LOAD_SYM(sym) do { \
  328. if (!(sym = dlsym(dll, #sym))) { \
  329. applog(LOG_DEBUG, "Failed to load " #sym ", not using FTDI autodetect"); \
  330. goto out; \
  331. } \
  332. } while(0)
  333. #ifdef UNTESTED_FTDI_DETECTONE_META_INFO
  334. static
  335. char *_ftdi_get_string(char *buf, int i, DWORD flags)
  336. {
  337. if (FT_OK != FT_ListDevices((PVOID)i, buf, FT_LIST_BY_INDEX | flags))
  338. return NULL;
  339. return buf[0] ? buf : NULL;
  340. }
  341. #endif
  342. static
  343. int _serial_autodetect_ftdi(detectone_func_t detectone, va_list needles)
  344. {
  345. char devpath[] = "\\\\.\\COMnnnnn";
  346. char *devpathnum = &devpath[7];
  347. char **bufptrs;
  348. char *buf;
  349. #ifdef UNTESTED_FTDI_DETECTONE_META_INFO
  350. char manuf[64], serial[64];
  351. #endif
  352. int found = 0;
  353. DWORD i;
  354. FT_STATUS ftStatus;
  355. DWORD numDevs;
  356. HMODULE dll = LoadLibrary("FTD2XX.DLL");
  357. if (!dll) {
  358. applog(LOG_DEBUG, "FTD2XX.DLL failed to load, not using FTDI autodetect");
  359. return 0;
  360. }
  361. LOAD_SYM(FT_ListDevices);
  362. LOAD_SYM(FT_Open);
  363. LOAD_SYM(FT_GetComPortNumber);
  364. LOAD_SYM(FT_Close);
  365. ftStatus = FT_ListDevices(&numDevs, NULL, FT_LIST_NUMBER_ONLY);
  366. if (ftStatus != FT_OK) {
  367. applog(LOG_DEBUG, "FTDI device count failed, not using FTDI autodetect");
  368. goto out;
  369. }
  370. applog(LOG_DEBUG, "FTDI reports %u devices", (unsigned)numDevs);
  371. buf = alloca(65 * numDevs);
  372. bufptrs = alloca(sizeof(*bufptrs) * (numDevs + 1));
  373. for (i = 0; i < numDevs; ++i)
  374. bufptrs[i] = &buf[i * 65];
  375. bufptrs[numDevs] = NULL;
  376. ftStatus = FT_ListDevices(bufptrs, &numDevs, FT_LIST_ALL | FT_OPEN_BY_DESCRIPTION);
  377. if (ftStatus != FT_OK) {
  378. applog(LOG_DEBUG, "FTDI device list failed, not using FTDI autodetect");
  379. goto out;
  380. }
  381. clear_detectone_meta_info();
  382. for (i = numDevs; i > 0; ) {
  383. --i;
  384. bufptrs[i][64] = '\0';
  385. if (!SEARCH_NEEDLES(bufptrs[i]))
  386. continue;
  387. FT_HANDLE ftHandle;
  388. if (FT_OK != FT_Open(i, &ftHandle))
  389. continue;
  390. LONG lComPortNumber;
  391. ftStatus = FT_GetComPortNumber(ftHandle, &lComPortNumber);
  392. FT_Close(ftHandle);
  393. if (FT_OK != ftStatus || lComPortNumber < 0)
  394. continue;
  395. applog(LOG_ERR, "FT_GetComPortNumber(%p (%ld), %ld)", ftHandle, (long)i, (long)lComPortNumber);
  396. #ifdef UNTESTED_FTDI_DETECTONE_META_INFO
  397. detectone_meta_info = (struct detectone_meta_info_t){
  398. .product = bufptrs[i],
  399. .serial = _ftdi_get_string(serial, i, FT_OPEN_BY_SERIAL_NUMBER),
  400. };
  401. #endif
  402. sprintf(devpathnum, "%d", (int)lComPortNumber);
  403. if (detectone(devpath))
  404. ++found;
  405. }
  406. out:
  407. clear_detectone_meta_info();
  408. dlclose(dll);
  409. return found;
  410. }
  411. #else
  412. # define _serial_autodetect_ftdi(...) (0)
  413. #endif
  414. #undef detectone
  415. int _serial_autodetect(detectone_func_t detectone, ...)
  416. {
  417. int rv;
  418. va_list needles;
  419. va_start(needles, detectone);
  420. rv = (
  421. _serial_autodetect_udev (detectone, needles) ?:
  422. _serial_autodetect_sysfs (detectone, needles) ?:
  423. _serial_autodetect_devserial(detectone, needles) ?:
  424. _serial_autodetect_ftdi (detectone, needles) ?:
  425. 0);
  426. va_end(needles);
  427. return rv;
  428. }
  429. struct _device_claim {
  430. struct device_drv *drv;
  431. char *devpath;
  432. UT_hash_handle hh;
  433. };
  434. struct device_drv *bfg_claim_any(struct device_drv * const api, const char *verbose, const char * const devpath)
  435. {
  436. static struct _device_claim *claims = NULL;
  437. struct _device_claim *c;
  438. HASH_FIND_STR(claims, devpath, c);
  439. if (c)
  440. {
  441. if (verbose && opt_debug)
  442. {
  443. char logbuf[LOGBUFSIZ];
  444. logbuf[0] = '\0';
  445. if (api)
  446. tailsprintf(logbuf, sizeof(logbuf), "%s device ", api->dname);
  447. if (verbose[0])
  448. tailsprintf(logbuf, sizeof(logbuf), "%s (%s)", verbose, devpath);
  449. else
  450. tailsprintf(logbuf, sizeof(logbuf), "%s", devpath);
  451. tailsprintf(logbuf, sizeof(logbuf), " already claimed by ");
  452. if (api)
  453. tailsprintf(logbuf, sizeof(logbuf), "other ");
  454. tailsprintf(logbuf, sizeof(logbuf), "driver: %s", c->drv->dname);
  455. _applog(LOG_DEBUG, logbuf);
  456. }
  457. return c->drv;
  458. }
  459. if (!api)
  460. return NULL;
  461. c = malloc(sizeof(*c));
  462. c->devpath = strdup(devpath);
  463. c->drv = api;
  464. HASH_ADD_KEYPTR(hh, claims, c->devpath, strlen(devpath), c);
  465. return NULL;
  466. }
  467. struct device_drv *bfg_claim_any2(struct device_drv * const api, const char * const verbose, const char * const llname, const char * const path)
  468. {
  469. const size_t llnamesz = strlen(llname);
  470. const size_t pathsz = strlen(path);
  471. char devpath[llnamesz + 1 + pathsz + 1];
  472. memcpy(devpath, llname, llnamesz);
  473. devpath[llnamesz] = ':';
  474. memcpy(&devpath[llnamesz+1], path, pathsz + 1);
  475. return bfg_claim_any(api, verbose, devpath);
  476. }
  477. struct device_drv *bfg_claim_serial(struct device_drv * const api, const bool verbose, const char * const devpath)
  478. {
  479. #ifndef WIN32
  480. char devs[6 + (sizeof(dev_t) * 2) + 1];
  481. {
  482. struct stat my_stat;
  483. if (stat(devpath, &my_stat))
  484. return NULL;
  485. memcpy(devs, "dev_t:", 6);
  486. bin2hex(&devs[6], &my_stat.st_rdev, sizeof(dev_t));
  487. }
  488. #else
  489. char *p = strstr(devpath, "COM"), *p2;
  490. if (!p)
  491. return NULL;
  492. const int com = strtol(&p[3], &p2, 10);
  493. if (p2 == p)
  494. return NULL;
  495. char dummy;
  496. const int sz = snprintf(&dummy, 1, "%d", com);
  497. char devs[4 + sz + 1];
  498. sprintf(devs, "com:%d", com);
  499. #endif
  500. return bfg_claim_any(api, (verbose ? devpath : NULL), devs);
  501. }
  502. struct device_drv *bfg_claim_usb(struct device_drv * const api, const bool verbose, const uint8_t usbbus, const uint8_t usbaddr)
  503. {
  504. char devpath[12];
  505. sprintf(devpath, "usb:%03u:%03u", (unsigned)usbbus, (unsigned)usbaddr);
  506. return bfg_claim_any(api, verbose ? "" : NULL, devpath);
  507. }
  508. #ifdef HAVE_LIBUSB
  509. void cgpu_copy_libusb_strings(struct cgpu_info *cgpu, libusb_device *usb)
  510. {
  511. unsigned char buf[0x20];
  512. libusb_device_handle *h;
  513. struct libusb_device_descriptor desc;
  514. if (LIBUSB_SUCCESS != libusb_open(usb, &h))
  515. return;
  516. if (libusb_get_device_descriptor(usb, &desc))
  517. {
  518. libusb_close(h);
  519. return;
  520. }
  521. if ((!cgpu->dev_manufacturer) && libusb_get_string_descriptor_ascii(h, desc.iManufacturer, buf, sizeof(buf)) >= 0)
  522. cgpu->dev_manufacturer = strdup((void *)buf);
  523. if ((!cgpu->dev_product) && libusb_get_string_descriptor_ascii(h, desc.iProduct, buf, sizeof(buf)) >= 0)
  524. cgpu->dev_product = strdup((void *)buf);
  525. if ((!cgpu->dev_serial) && libusb_get_string_descriptor_ascii(h, desc.iSerialNumber, buf, sizeof(buf)) >= 0)
  526. cgpu->dev_serial = strdup((void *)buf);
  527. libusb_close(h);
  528. }
  529. #endif
  530. // This code is purely for debugging but is very useful for that
  531. // It also took quite a bit of effort so I left it in
  532. // #define TERMIOS_DEBUG 1
  533. // Here to include it at compile time
  534. // It's off by default
  535. #ifndef WIN32
  536. #ifdef TERMIOS_DEBUG
  537. #define BITSSET "Y"
  538. #define BITSNOTSET "N"
  539. int tiospeed(speed_t speed)
  540. {
  541. switch (speed) {
  542. #define IOSPEED(baud) \
  543. case B ## baud: \
  544. return baud; \
  545. // END
  546. #include "iospeeds_local.h"
  547. #undef IOSPEED
  548. default:
  549. return -1;
  550. }
  551. }
  552. void termios_debug(const char *devpath, struct termios *my_termios, const char *msg)
  553. {
  554. applog(LOG_DEBUG, "TIOS: Open %s attributes %s: ispeed=%d ospeed=%d",
  555. devpath, msg, tiospeed(cfgetispeed(my_termios)), tiospeed(cfgetispeed(my_termios)));
  556. #define ISSETI(b) ((my_termios->c_iflag | (b)) ? BITSSET : BITSNOTSET)
  557. applog(LOG_DEBUG, "TIOS: c_iflag: IGNBRK=%s BRKINT=%s IGNPAR=%s PARMRK=%s INPCK=%s ISTRIP=%s INLCR=%s IGNCR=%s ICRNL=%s IUCLC=%s IXON=%s IXANY=%s IOFF=%s IMAXBEL=%s IUTF8=%s",
  558. ISSETI(IGNBRK), ISSETI(BRKINT), ISSETI(IGNPAR), ISSETI(PARMRK),
  559. ISSETI(INPCK), ISSETI(ISTRIP), ISSETI(INLCR), ISSETI(IGNCR),
  560. ISSETI(ICRNL), ISSETI(IUCLC), ISSETI(IXON), ISSETI(IXANY),
  561. ISSETI(IXOFF), ISSETI(IMAXBEL), ISSETI(IUTF8));
  562. #define ISSETO(b) ((my_termios->c_oflag | (b)) ? BITSSET : BITSNOTSET)
  563. #define VALO(b) (my_termios->c_oflag | (b))
  564. applog(LOG_DEBUG, "TIOS: c_oflag: OPOST=%s OLCUC=%s ONLCR=%s OCRNL=%s ONOCR=%s ONLRET=%s OFILL=%s OFDEL=%s NLDLY=%d CRDLY=%d TABDLY=%d BSDLY=%d VTDLY=%d FFDLY=%d",
  565. ISSETO(OPOST), ISSETO(OLCUC), ISSETO(ONLCR), ISSETO(OCRNL),
  566. ISSETO(ONOCR), ISSETO(ONLRET), ISSETO(OFILL), ISSETO(OFDEL),
  567. VALO(NLDLY), VALO(CRDLY), VALO(TABDLY), VALO(BSDLY),
  568. VALO(VTDLY), VALO(FFDLY));
  569. #define ISSETC(b) ((my_termios->c_cflag | (b)) ? BITSSET : BITSNOTSET)
  570. #define VALC(b) (my_termios->c_cflag | (b))
  571. applog(LOG_DEBUG, "TIOS: c_cflag: CBAUDEX=%s CSIZE=%d CSTOPB=%s CREAD=%s PARENB=%s PARODD=%s HUPCL=%s CLOCAL=%s"
  572. #ifdef LOBLK
  573. " LOBLK=%s"
  574. #endif
  575. " CMSPAR=%s CRTSCTS=%s",
  576. ISSETC(CBAUDEX), VALC(CSIZE), ISSETC(CSTOPB), ISSETC(CREAD),
  577. ISSETC(PARENB), ISSETC(PARODD), ISSETC(HUPCL), ISSETC(CLOCAL),
  578. #ifdef LOBLK
  579. ISSETC(LOBLK),
  580. #endif
  581. ISSETC(CMSPAR), ISSETC(CRTSCTS));
  582. #define ISSETL(b) ((my_termios->c_lflag | (b)) ? BITSSET : BITSNOTSET)
  583. applog(LOG_DEBUG, "TIOS: c_lflag: ISIG=%s ICANON=%s XCASE=%s ECHO=%s ECHOE=%s ECHOK=%s ECHONL=%s ECHOCTL=%s ECHOPRT=%s ECHOKE=%s"
  584. #ifdef DEFECHO
  585. " DEFECHO=%s"
  586. #endif
  587. " FLUSHO=%s NOFLSH=%s TOSTOP=%s PENDIN=%s IEXTEN=%s",
  588. ISSETL(ISIG), ISSETL(ICANON), ISSETL(XCASE), ISSETL(ECHO),
  589. ISSETL(ECHOE), ISSETL(ECHOK), ISSETL(ECHONL), ISSETL(ECHOCTL),
  590. ISSETL(ECHOPRT), ISSETL(ECHOKE),
  591. #ifdef DEFECHO
  592. ISSETL(DEFECHO),
  593. #endif
  594. ISSETL(FLUSHO), ISSETL(NOFLSH), ISSETL(TOSTOP), ISSETL(PENDIN),
  595. ISSETL(IEXTEN));
  596. #define VALCC(b) (my_termios->c_cc[b])
  597. applog(LOG_DEBUG, "TIOS: c_cc: VINTR=0x%02x VQUIT=0x%02x VERASE=0x%02x VKILL=0x%02x VEOF=0x%02x VMIN=%u VEOL=0x%02x VTIME=%u VEOL2=0x%02x"
  598. #ifdef VSWTCH
  599. " VSWTCH=0x%02x"
  600. #endif
  601. " VSTART=0x%02x VSTOP=0x%02x VSUSP=0x%02x"
  602. #ifdef VDSUSP
  603. " VDSUSP=0x%02x"
  604. #endif
  605. " VLNEXT=0x%02x VWERASE=0x%02x VREPRINT=0x%02x VDISCARD=0x%02x"
  606. #ifdef VSTATUS
  607. " VSTATUS=0x%02x"
  608. #endif
  609. ,
  610. VALCC(VINTR), VALCC(VQUIT), VALCC(VERASE), VALCC(VKILL),
  611. VALCC(VEOF), VALCC(VMIN), VALCC(VEOL), VALCC(VTIME),
  612. VALCC(VEOL2),
  613. #ifdef VSWTCH
  614. VALCC(VSWTCH),
  615. #endif
  616. VALCC(VSTART), VALCC(VSTOP), VALCC(VSUSP),
  617. #ifdef VDSUSP
  618. VALCC(VDSUSP),
  619. #endif
  620. VALCC(VLNEXT), VALCC(VWERASE),
  621. VALCC(VREPRINT), VALCC(VDISCARD)
  622. #ifdef VSTATUS
  623. ,VALCC(VSTATUS)
  624. #endif
  625. );
  626. }
  627. #endif /* TERMIOS_DEBUG */
  628. speed_t tiospeed_t(int baud)
  629. {
  630. switch (baud) {
  631. #define IOSPEED(baud) \
  632. case baud: \
  633. return B ## baud; \
  634. // END
  635. #include "iospeeds_local.h"
  636. #undef IOSPEED
  637. default:
  638. return B0;
  639. }
  640. }
  641. #endif /* WIN32 */
  642. bool valid_baud(int baud)
  643. {
  644. switch (baud) {
  645. #define IOSPEED(baud) \
  646. case baud: \
  647. return true; \
  648. // END
  649. #include "iospeeds_local.h"
  650. #undef IOSPEED
  651. default:
  652. return false;
  653. }
  654. }
  655. /* NOTE: Linux only supports uint8_t (decisecond) timeouts; limiting it in
  656. * this interface buys us warnings when bad constants are passed in.
  657. */
  658. int serial_open(const char *devpath, unsigned long baud, uint8_t timeout, bool purge)
  659. {
  660. #ifdef WIN32
  661. HANDLE hSerial = CreateFile(devpath, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, 0, NULL);
  662. if (unlikely(hSerial == INVALID_HANDLE_VALUE))
  663. {
  664. DWORD e = GetLastError();
  665. switch (e) {
  666. case ERROR_ACCESS_DENIED:
  667. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  668. break;
  669. case ERROR_SHARING_VIOLATION:
  670. applog(LOG_ERR, "%s is already in use by another process", devpath);
  671. break;
  672. default:
  673. applog(LOG_DEBUG, "Open %s failed, GetLastError:%u", devpath, (unsigned)e);
  674. break;
  675. }
  676. return -1;
  677. }
  678. // thanks to af_newbie for pointers about this
  679. COMMCONFIG comCfg = {0};
  680. comCfg.dwSize = sizeof(COMMCONFIG);
  681. comCfg.wVersion = 1;
  682. comCfg.dcb.DCBlength = sizeof(DCB);
  683. comCfg.dcb.BaudRate = baud;
  684. comCfg.dcb.fBinary = 1;
  685. comCfg.dcb.fDtrControl = DTR_CONTROL_ENABLE;
  686. comCfg.dcb.fRtsControl = RTS_CONTROL_ENABLE;
  687. comCfg.dcb.ByteSize = 8;
  688. SetCommConfig(hSerial, &comCfg, sizeof(comCfg));
  689. // Code must specify a valid timeout value (0 means don't timeout)
  690. const DWORD ctoms = ((DWORD)timeout * 100);
  691. COMMTIMEOUTS cto = {ctoms, 0, ctoms, 0, ctoms};
  692. SetCommTimeouts(hSerial, &cto);
  693. if (purge) {
  694. PurgeComm(hSerial, PURGE_RXABORT);
  695. PurgeComm(hSerial, PURGE_TXABORT);
  696. PurgeComm(hSerial, PURGE_RXCLEAR);
  697. PurgeComm(hSerial, PURGE_TXCLEAR);
  698. }
  699. return _open_osfhandle((intptr_t)hSerial, 0);
  700. #else
  701. int fdDev = open(devpath, O_RDWR | O_CLOEXEC | O_NOCTTY);
  702. if (unlikely(fdDev == -1))
  703. {
  704. if (errno == EACCES)
  705. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  706. else
  707. applog(LOG_DEBUG, "Open %s failed: %s", devpath, bfg_strerror(errno, BST_ERRNO));
  708. return -1;
  709. }
  710. #if defined(LOCK_EX) && defined(LOCK_NB)
  711. if (likely(!flock(fdDev, LOCK_EX | LOCK_NB)))
  712. applog(LOG_DEBUG, "Acquired exclusive advisory lock on %s", devpath);
  713. else
  714. if (errno == EWOULDBLOCK)
  715. {
  716. applog(LOG_ERR, "%s is already in use by another process", devpath);
  717. close(fdDev);
  718. return -1;
  719. }
  720. else
  721. applog(LOG_WARNING, "Failed to acquire exclusive lock on %s: %s (ignoring)", devpath, bfg_strerror(errno, BST_ERRNO));
  722. #endif
  723. struct termios my_termios;
  724. tcgetattr(fdDev, &my_termios);
  725. #ifdef TERMIOS_DEBUG
  726. termios_debug(devpath, &my_termios, "before");
  727. #endif
  728. if (baud)
  729. {
  730. speed_t speed = tiospeed_t(baud);
  731. if (speed == B0)
  732. applog(LOG_WARNING, "Unrecognized baud rate: %lu", baud);
  733. else
  734. {
  735. cfsetispeed(&my_termios, speed);
  736. cfsetospeed(&my_termios, speed);
  737. }
  738. }
  739. my_termios.c_cflag &= ~(CSIZE | PARENB);
  740. my_termios.c_cflag |= CS8;
  741. my_termios.c_cflag |= CREAD;
  742. #ifdef USE_AVALON
  743. // my_termios.c_cflag |= CRTSCTS;
  744. #endif
  745. my_termios.c_cflag |= CLOCAL;
  746. my_termios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK |
  747. ISTRIP | INLCR | IGNCR | ICRNL | IXON);
  748. my_termios.c_oflag &= ~OPOST;
  749. my_termios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
  750. // Code must specify a valid timeout value (0 means don't timeout)
  751. my_termios.c_cc[VTIME] = (cc_t)timeout;
  752. my_termios.c_cc[VMIN] = 0;
  753. #ifdef TERMIOS_DEBUG
  754. termios_debug(devpath, &my_termios, "settings");
  755. #endif
  756. tcsetattr(fdDev, TCSANOW, &my_termios);
  757. #ifdef TERMIOS_DEBUG
  758. tcgetattr(fdDev, &my_termios);
  759. termios_debug(devpath, &my_termios, "after");
  760. #endif
  761. if (purge)
  762. tcflush(fdDev, TCIOFLUSH);
  763. return fdDev;
  764. #endif
  765. }
  766. ssize_t _serial_read(int fd, char *buf, size_t bufsiz, char *eol)
  767. {
  768. ssize_t len, tlen = 0;
  769. while (bufsiz) {
  770. len = read(fd, buf, eol ? 1 : bufsiz);
  771. if (len < 1)
  772. break;
  773. tlen += len;
  774. if (eol && *eol == buf[0])
  775. break;
  776. buf += len;
  777. bufsiz -= len;
  778. }
  779. return tlen;
  780. }
  781. #define bailout(...) do { \
  782. applog(__VA_ARGS__); \
  783. return NULL; \
  784. } while(0)
  785. #define check_magic(L) do { \
  786. if (1 != fread(buf, 1, 1, f)) \
  787. bailout(LOG_ERR, "%s: Error reading bitstream ('%c')", \
  788. repr, L); \
  789. if (buf[0] != L) \
  790. bailout(LOG_ERR, "%s: Firmware has wrong magic ('%c')", \
  791. repr, L); \
  792. } while(0)
  793. #define read_str(eng) do { \
  794. if (1 != fread(buf, 2, 1, f)) \
  795. bailout(LOG_ERR, "%s: Error reading bitstream (" eng " len)", \
  796. repr); \
  797. len = (ubuf[0] << 8) | ubuf[1]; \
  798. if (len >= sizeof(buf)) \
  799. bailout(LOG_ERR, "%s: Firmware " eng " too long", \
  800. repr); \
  801. if (1 != fread(buf, len, 1, f)) \
  802. bailout(LOG_ERR, "%s: Error reading bitstream (" eng ")", \
  803. repr); \
  804. buf[len] = '\0'; \
  805. } while(0)
  806. void _bitstream_not_found(const char *repr, const char *fn)
  807. {
  808. applog(LOG_ERR, "ERROR: Unable to load '%s', required for %s to work!", fn, repr);
  809. applog(LOG_ERR, "ERROR: Please read README.FPGA for instructions");
  810. }
  811. FILE *open_xilinx_bitstream(const char *dname, const char *repr, const char *fwfile, unsigned long *out_len)
  812. {
  813. char buf[0x100];
  814. unsigned char *ubuf = (unsigned char*)buf;
  815. unsigned long len;
  816. char *p;
  817. FILE *f = open_bitstream(dname, fwfile);
  818. if (!f)
  819. {
  820. _bitstream_not_found(repr, fwfile);
  821. return NULL;
  822. }
  823. if (1 != fread(buf, 2, 1, f))
  824. bailout(LOG_ERR, "%s: Error reading bitstream (magic)",
  825. repr);
  826. if (buf[0] || buf[1] != 9)
  827. bailout(LOG_ERR, "%s: Firmware has wrong magic (9)",
  828. repr);
  829. if (-1 == fseek(f, 11, SEEK_CUR))
  830. bailout(LOG_ERR, "%s: Firmware seek failed",
  831. repr);
  832. check_magic('a');
  833. read_str("design name");
  834. applog(LOG_DEBUG, "%s: Firmware file %s info:",
  835. repr, fwfile);
  836. applog(LOG_DEBUG, " Design name: %s", buf);
  837. p = strrchr(buf, ';') ?: buf;
  838. p = strrchr(buf, '=') ?: p;
  839. if (p[0] == '=')
  840. ++p;
  841. unsigned long fwusercode = (unsigned long)strtoll(p, &p, 16);
  842. if (p[0] != '\0')
  843. bailout(LOG_ERR, "%s: Bad usercode in bitstream file",
  844. repr);
  845. if (fwusercode == 0xffffffff)
  846. bailout(LOG_ERR, "%s: Firmware doesn't support user code",
  847. repr);
  848. applog(LOG_DEBUG, " Version: %u, build %u", (unsigned)((fwusercode >> 8) & 0xff), (unsigned)(fwusercode & 0xff));
  849. check_magic('b');
  850. read_str("part number");
  851. applog(LOG_DEBUG, " Part number: %s", buf);
  852. check_magic('c');
  853. read_str("build date");
  854. applog(LOG_DEBUG, " Build date: %s", buf);
  855. check_magic('d');
  856. read_str("build time");
  857. applog(LOG_DEBUG, " Build time: %s", buf);
  858. check_magic('e');
  859. if (1 != fread(buf, 4, 1, f))
  860. bailout(LOG_ERR, "%s: Error reading bitstream (data len)",
  861. repr);
  862. len = ((unsigned long)ubuf[0] << 24) | ((unsigned long)ubuf[1] << 16) | (ubuf[2] << 8) | ubuf[3];
  863. applog(LOG_DEBUG, " Bitstream size: %lu", len);
  864. *out_len = len;
  865. return f;
  866. }
  867. bool load_bitstream_intelhex(bytes_t *rv, const char *dname, const char *repr, const char *fn)
  868. {
  869. char buf[0x100];
  870. size_t sz;
  871. uint8_t xsz, xrt;
  872. uint16_t xaddr;
  873. FILE *F = open_bitstream(dname, fn);
  874. if (!F)
  875. return false;
  876. while (!feof(F))
  877. {
  878. if (unlikely(ferror(F)))
  879. {
  880. applog(LOG_ERR, "Error reading '%s'", fn);
  881. goto ihxerr;
  882. }
  883. if (!fgets(buf, sizeof(buf), F))
  884. goto ihxerr;
  885. if (unlikely(buf[0] != ':'))
  886. goto ihxerr;
  887. if (unlikely(!(
  888. hex2bin(&xsz, &buf[1], 1)
  889. && hex2bin((unsigned char*)&xaddr, &buf[3], 2)
  890. && hex2bin(&xrt, &buf[7], 1)
  891. )))
  892. {
  893. applog(LOG_ERR, "Error parsing in '%s'", fn);
  894. goto ihxerr;
  895. }
  896. switch (xrt)
  897. {
  898. case 0: // data
  899. break;
  900. case 1: // EOF
  901. fclose(F);
  902. return true;
  903. default:
  904. applog(LOG_ERR, "Unsupported record type in '%s'", fn);
  905. goto ihxerr;
  906. }
  907. xaddr = be16toh(xaddr);
  908. sz = bytes_len(rv);
  909. bytes_resize(rv, xaddr + xsz);
  910. if (sz < xaddr)
  911. memset(&bytes_buf(rv)[sz], 0xff, xaddr - sz);
  912. if (unlikely(!(hex2bin(&bytes_buf(rv)[xaddr], &buf[9], xsz))))
  913. {
  914. applog(LOG_ERR, "Error parsing data in '%s'", fn);
  915. goto ihxerr;
  916. }
  917. // TODO: checksum
  918. }
  919. ihxerr:
  920. fclose(F);
  921. bytes_reset(rv);
  922. return false;
  923. }
  924. bool load_bitstream_bytes(bytes_t *rv, const char *dname, const char *repr, const char *fileprefix)
  925. {
  926. FILE *F;
  927. size_t fplen = strlen(fileprefix);
  928. char fnbuf[fplen + 4 + 1];
  929. int e;
  930. bytes_reset(rv);
  931. memcpy(fnbuf, fileprefix, fplen);
  932. strcpy(&fnbuf[fplen], ".bin");
  933. F = open_bitstream(dname, fnbuf);
  934. if (F)
  935. {
  936. char buf[0x100];
  937. size_t sz;
  938. while ( (sz = fread(buf, 1, sizeof(buf), F)) )
  939. bytes_append(rv, buf, sz);
  940. e = ferror(F);
  941. fclose(F);
  942. if (unlikely(e))
  943. {
  944. applog(LOG_ERR, "Error reading '%s'", fnbuf);
  945. bytes_reset(rv);
  946. }
  947. else
  948. return true;
  949. }
  950. strcpy(&fnbuf[fplen], ".ihx");
  951. if (load_bitstream_intelhex(rv, dname, repr, fnbuf))
  952. return true;
  953. // TODO: Xilinx
  954. _bitstream_not_found(repr, fnbuf);
  955. return false;
  956. }
  957. #ifndef WIN32
  958. int get_serial_cts(int fd)
  959. {
  960. int flags;
  961. if (!fd)
  962. return -1;
  963. ioctl(fd, TIOCMGET, &flags);
  964. return (flags & TIOCM_CTS) ? 1 : 0;
  965. }
  966. int set_serial_rts(int fd, int rts)
  967. {
  968. int flags;
  969. if (!fd)
  970. return -1;
  971. ioctl(fd, TIOCMGET, &flags);
  972. if (rts)
  973. flags |= TIOCM_RTS;
  974. else
  975. flags &= ~TIOCM_RTS;
  976. ioctl(fd, TIOCMSET, &flags);
  977. return flags & TIOCM_CTS;
  978. }
  979. #else
  980. int get_serial_cts(const int fd)
  981. {
  982. if (!fd)
  983. return -1;
  984. const HANDLE fh = (HANDLE)_get_osfhandle(fd);
  985. if (!fh)
  986. return -1;
  987. DWORD flags;
  988. if (!GetCommModemStatus(fh, &flags))
  989. return -1;
  990. return (flags & MS_CTS_ON) ? 1 : 0;
  991. }
  992. #endif // ! WIN32