fpgautils.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785
  1. /*
  2. * Copyright 2012 Luke Dashjr
  3. * Copyright 2012 Andrew Smith
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms of the GNU General Public License as published by the Free
  7. * Software Foundation; either version 3 of the License, or (at your option)
  8. * any later version. See COPYING for more details.
  9. */
  10. #include "config.h"
  11. #include <stdarg.h>
  12. #include <stdint.h>
  13. #include <stdlib.h>
  14. #include <sys/types.h>
  15. #include <dirent.h>
  16. #include <string.h>
  17. #ifndef WIN32
  18. #include <errno.h>
  19. #include <termios.h>
  20. #include <sys/stat.h>
  21. #include <unistd.h>
  22. #include <fcntl.h>
  23. #ifndef O_CLOEXEC
  24. #define O_CLOEXEC 0
  25. #endif
  26. #else /* WIN32 */
  27. #include <windows.h>
  28. #include <io.h>
  29. #define dlsym (void*)GetProcAddress
  30. #define dlclose FreeLibrary
  31. typedef unsigned long FT_STATUS;
  32. typedef PVOID FT_HANDLE;
  33. __stdcall FT_STATUS (*FT_ListDevices)(PVOID pArg1, PVOID pArg2, DWORD Flags);
  34. __stdcall FT_STATUS (*FT_Open)(int idx, FT_HANDLE*);
  35. __stdcall FT_STATUS (*FT_GetComPortNumber)(FT_HANDLE, LPLONG lplComPortNumber);
  36. __stdcall FT_STATUS (*FT_Close)(FT_HANDLE);
  37. const uint32_t FT_OPEN_BY_DESCRIPTION = 2;
  38. const uint32_t FT_LIST_ALL = 0x20000000;
  39. const uint32_t FT_LIST_NUMBER_ONLY = 0x80000000;
  40. enum {
  41. FT_OK,
  42. };
  43. #endif /* WIN32 */
  44. #ifdef HAVE_LIBUDEV
  45. #include <libudev.h>
  46. #endif
  47. #include "elist.h"
  48. #include "logging.h"
  49. #include "miner.h"
  50. #include "fpgautils.h"
  51. #define SEARCH_NEEDLES_BEGIN() { \
  52. const char *needle; \
  53. bool __cont = false; \
  54. va_list ap; \
  55. va_copy(ap, needles); \
  56. while ( (needle = va_arg(ap, const char *)) ) \
  57. {
  58. #define SEARCH_NEEDLES_END(...) \
  59. } \
  60. va_end(ap); \
  61. if (__cont) \
  62. { \
  63. __VA_ARGS__; \
  64. } \
  65. }
  66. static inline
  67. bool search_needles(const char *haystack, va_list needles)
  68. {
  69. bool rv = true;
  70. SEARCH_NEEDLES_BEGIN()
  71. if (!strstr(haystack, needle))
  72. {
  73. rv = false;
  74. break;
  75. }
  76. SEARCH_NEEDLES_END()
  77. return rv;
  78. }
  79. #define SEARCH_NEEDLES(haystack) search_needles(haystack, needles)
  80. #ifdef HAVE_LIBUDEV
  81. static
  82. int _serial_autodetect_udev(detectone_func_t detectone, va_list needles)
  83. {
  84. struct udev *udev = udev_new();
  85. struct udev_enumerate *enumerate = udev_enumerate_new(udev);
  86. struct udev_list_entry *list_entry;
  87. char found = 0;
  88. udev_enumerate_add_match_subsystem(enumerate, "tty");
  89. udev_enumerate_scan_devices(enumerate);
  90. udev_list_entry_foreach(list_entry, udev_enumerate_get_list_entry(enumerate)) {
  91. struct udev_device *device = udev_device_new_from_syspath(
  92. udev_enumerate_get_udev(enumerate),
  93. udev_list_entry_get_name(list_entry)
  94. );
  95. if (!device)
  96. continue;
  97. const char *model = udev_device_get_property_value(device, "ID_MODEL");
  98. if (!(model && SEARCH_NEEDLES(model)))
  99. continue;
  100. const char *devpath = udev_device_get_devnode(device);
  101. if (devpath && detectone(devpath))
  102. ++found;
  103. udev_device_unref(device);
  104. }
  105. udev_enumerate_unref(enumerate);
  106. udev_unref(udev);
  107. return found;
  108. }
  109. #else
  110. # define _serial_autodetect_udev(...) (0)
  111. #endif
  112. #ifndef WIN32
  113. static
  114. int _serial_autodetect_devserial(detectone_func_t detectone, va_list needles)
  115. {
  116. DIR *D;
  117. struct dirent *de;
  118. const char udevdir[] = "/dev/serial/by-id";
  119. char devpath[sizeof(udevdir) + 1 + NAME_MAX];
  120. char *devfile = devpath + sizeof(udevdir);
  121. char found = 0;
  122. D = opendir(udevdir);
  123. if (!D)
  124. return 0;
  125. memcpy(devpath, udevdir, sizeof(udevdir) - 1);
  126. devpath[sizeof(udevdir) - 1] = '/';
  127. while ( (de = readdir(D)) ) {
  128. if (!SEARCH_NEEDLES(de->d_name))
  129. continue;
  130. strcpy(devfile, de->d_name);
  131. if (detectone(devpath))
  132. ++found;
  133. }
  134. closedir(D);
  135. return found;
  136. }
  137. #else
  138. # define _serial_autodetect_devserial(...) (0)
  139. #endif
  140. #ifdef WIN32
  141. #define LOAD_SYM(sym) do { \
  142. if (!(sym = dlsym(dll, #sym))) { \
  143. applog(LOG_DEBUG, "Failed to load " #sym ", not using FTDI autodetect"); \
  144. goto out; \
  145. } \
  146. } while(0)
  147. static
  148. int _serial_autodetect_ftdi(detectone_func_t detectone, va_list needles)
  149. {
  150. char devpath[] = "\\\\.\\COMnnnnn";
  151. char *devpathnum = &devpath[7];
  152. char **bufptrs;
  153. char *buf;
  154. int found = 0;
  155. DWORD i;
  156. FT_STATUS ftStatus;
  157. DWORD numDevs;
  158. HMODULE dll = LoadLibrary("FTD2XX.DLL");
  159. if (!dll) {
  160. applog(LOG_DEBUG, "FTD2XX.DLL failed to load, not using FTDI autodetect");
  161. return 0;
  162. }
  163. LOAD_SYM(FT_ListDevices);
  164. LOAD_SYM(FT_Open);
  165. LOAD_SYM(FT_GetComPortNumber);
  166. LOAD_SYM(FT_Close);
  167. ftStatus = FT_ListDevices(&numDevs, NULL, FT_LIST_NUMBER_ONLY);
  168. if (ftStatus != FT_OK) {
  169. applog(LOG_DEBUG, "FTDI device count failed, not using FTDI autodetect");
  170. goto out;
  171. }
  172. applog(LOG_DEBUG, "FTDI reports %u devices", (unsigned)numDevs);
  173. buf = alloca(65 * numDevs);
  174. bufptrs = alloca(sizeof(*bufptrs) * (numDevs + 1));
  175. for (i = 0; i < numDevs; ++i)
  176. bufptrs[i] = &buf[i * 65];
  177. bufptrs[numDevs] = NULL;
  178. ftStatus = FT_ListDevices(bufptrs, &numDevs, FT_LIST_ALL | FT_OPEN_BY_DESCRIPTION);
  179. if (ftStatus != FT_OK) {
  180. applog(LOG_DEBUG, "FTDI device list failed, not using FTDI autodetect");
  181. goto out;
  182. }
  183. for (i = numDevs; i > 0; ) {
  184. --i;
  185. bufptrs[i][64] = '\0';
  186. if (!SEARCH_NEEDLES(bufptrs[i]))
  187. continue;
  188. FT_HANDLE ftHandle;
  189. if (FT_OK != FT_Open(i, &ftHandle))
  190. continue;
  191. LONG lComPortNumber;
  192. ftStatus = FT_GetComPortNumber(ftHandle, &lComPortNumber);
  193. FT_Close(ftHandle);
  194. if (FT_OK != ftStatus || lComPortNumber < 0)
  195. continue;
  196. sprintf(devpathnum, "%d", (int)lComPortNumber);
  197. if (detectone(devpath))
  198. ++found;
  199. }
  200. out:
  201. dlclose(dll);
  202. return found;
  203. }
  204. #else
  205. # define _serial_autodetect_ftdi(...) (0)
  206. #endif
  207. int _serial_autodetect(detectone_func_t detectone, ...)
  208. {
  209. int rv;
  210. va_list needles;
  211. va_start(needles, detectone);
  212. rv = (
  213. _serial_autodetect_udev (detectone, needles) ?:
  214. _serial_autodetect_devserial(detectone, needles) ?:
  215. _serial_autodetect_ftdi (detectone, needles) ?:
  216. 0);
  217. va_end(needles);
  218. return rv;
  219. }
  220. struct device_api *serial_claim(const char *devpath, struct device_api *api);
  221. int _serial_detect(struct device_api *api, detectone_func_t detectone, autoscan_func_t autoscan, int flags)
  222. {
  223. struct string_elist *iter, *tmp;
  224. const char *dev, *colon;
  225. bool inhibitauto = false;
  226. char found = 0;
  227. bool forceauto = flags & 1;
  228. bool hasname;
  229. size_t namel = strlen(api->name);
  230. size_t dnamel = strlen(api->dname);
  231. list_for_each_entry_safe(iter, tmp, &scan_devices, list) {
  232. dev = iter->string;
  233. if ((colon = strchr(dev, ':')) && colon[1] != '\0') {
  234. size_t idlen = colon - dev;
  235. // allow either name:device or dname:device
  236. if ((idlen != namel || strncasecmp(dev, api->name, idlen))
  237. && (idlen != dnamel || strncasecmp(dev, api->dname, idlen)))
  238. continue;
  239. dev = colon + 1;
  240. hasname = true;
  241. }
  242. else
  243. hasname = false;
  244. if (!strcmp(dev, "auto"))
  245. forceauto = true;
  246. else if (!strcmp(dev, "noauto"))
  247. inhibitauto = true;
  248. else
  249. if ((flags & 2) && !hasname)
  250. continue;
  251. else
  252. if (!detectone)
  253. {} // do nothing
  254. else
  255. if (serial_claim(dev, NULL))
  256. {
  257. applog(LOG_DEBUG, "%s is already claimed... skipping probes", dev);
  258. string_elist_del(iter);
  259. }
  260. else if (detectone(dev)) {
  261. string_elist_del(iter);
  262. inhibitauto = true;
  263. ++found;
  264. }
  265. }
  266. if ((forceauto || !inhibitauto) && autoscan)
  267. found += autoscan();
  268. return found;
  269. }
  270. #ifndef WIN32
  271. typedef dev_t my_dev_t;
  272. #else
  273. typedef int my_dev_t;
  274. #endif
  275. struct _device_claim {
  276. struct device_api *api;
  277. my_dev_t dev;
  278. UT_hash_handle hh;
  279. };
  280. struct device_api *serial_claim(const char *devpath, struct device_api *api)
  281. {
  282. static struct _device_claim *claims = NULL;
  283. struct _device_claim *c;
  284. my_dev_t dev;
  285. #ifndef WIN32
  286. {
  287. struct stat my_stat;
  288. if (stat(devpath, &my_stat))
  289. return NULL;
  290. dev = my_stat.st_rdev;
  291. }
  292. #else
  293. {
  294. char *p = strstr(devpath, "COM"), *p2;
  295. if (!p)
  296. return NULL;
  297. dev = strtol(&p[3], &p2, 10);
  298. if (p2 == p)
  299. return NULL;
  300. }
  301. #endif
  302. HASH_FIND(hh, claims, &dev, sizeof(dev), c);
  303. if (c)
  304. return c->api;
  305. if (!api)
  306. return NULL;
  307. c = malloc(sizeof(*c));
  308. c->dev = dev;
  309. c->api = api;
  310. HASH_ADD(hh, claims, dev, sizeof(dev), c);
  311. return NULL;
  312. }
  313. // This code is purely for debugging but is very useful for that
  314. // It also took quite a bit of effort so I left it in
  315. // #define TERMIOS_DEBUG 1
  316. // Here to include it at compile time
  317. // It's off by default
  318. #ifndef WIN32
  319. #ifdef TERMIOS_DEBUG
  320. #define BITSSET "Y"
  321. #define BITSNOTSET "N"
  322. int tiospeed(speed_t speed)
  323. {
  324. switch (speed) {
  325. case B0:
  326. return 0;
  327. case B50:
  328. return 50;
  329. case B75:
  330. return 75;
  331. case B110:
  332. return 110;
  333. case B134:
  334. return 134;
  335. case B150:
  336. return 150;
  337. case B200:
  338. return 200;
  339. case B300:
  340. return 300;
  341. case B600:
  342. return 600;
  343. case B1200:
  344. return 1200;
  345. case B1800:
  346. return 1800;
  347. case B2400:
  348. return 2400;
  349. case B4800:
  350. return 4800;
  351. case B9600:
  352. return 9600;
  353. case B19200:
  354. return 19200;
  355. case B38400:
  356. return 38400;
  357. case B57600:
  358. return 57600;
  359. case B115200:
  360. return 115200;
  361. case B230400:
  362. return 230400;
  363. case B460800:
  364. return 460800;
  365. case B500000:
  366. return 500000;
  367. case B576000:
  368. return 576000;
  369. case B921600:
  370. return 921600;
  371. case B1000000:
  372. return 1000000;
  373. case B1152000:
  374. return 1152000;
  375. case B1500000:
  376. return 1500000;
  377. case B2000000:
  378. return 2000000;
  379. case B2500000:
  380. return 2500000;
  381. case B3000000:
  382. return 3000000;
  383. case B3500000:
  384. return 3500000;
  385. case B4000000:
  386. return 4000000;
  387. default:
  388. return -1;
  389. }
  390. }
  391. void termios_debug(const char *devpath, struct termios *my_termios, const char *msg)
  392. {
  393. applog(LOG_DEBUG, "TIOS: Open %s attributes %s: ispeed=%d ospeed=%d",
  394. devpath, msg, tiospeed(cfgetispeed(my_termios)), tiospeed(cfgetispeed(my_termios)));
  395. #define ISSETI(b) ((my_termios->c_iflag | (b)) ? BITSSET : BITSNOTSET)
  396. 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",
  397. ISSETI(IGNBRK), ISSETI(BRKINT), ISSETI(IGNPAR), ISSETI(PARMRK),
  398. ISSETI(INPCK), ISSETI(ISTRIP), ISSETI(INLCR), ISSETI(IGNCR),
  399. ISSETI(ICRNL), ISSETI(IUCLC), ISSETI(IXON), ISSETI(IXANY),
  400. ISSETI(IXOFF), ISSETI(IMAXBEL), ISSETI(IUTF8));
  401. #define ISSETO(b) ((my_termios->c_oflag | (b)) ? BITSSET : BITSNOTSET)
  402. #define VALO(b) (my_termios->c_oflag | (b))
  403. 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",
  404. ISSETO(OPOST), ISSETO(OLCUC), ISSETO(ONLCR), ISSETO(OCRNL),
  405. ISSETO(ONOCR), ISSETO(ONLRET), ISSETO(OFILL), ISSETO(OFDEL),
  406. VALO(NLDLY), VALO(CRDLY), VALO(TABDLY), VALO(BSDLY),
  407. VALO(VTDLY), VALO(FFDLY));
  408. #define ISSETC(b) ((my_termios->c_cflag | (b)) ? BITSSET : BITSNOTSET)
  409. #define VALC(b) (my_termios->c_cflag | (b))
  410. applog(LOG_DEBUG, "TIOS: c_cflag: CBAUDEX=%s CSIZE=%d CSTOPB=%s CREAD=%s PARENB=%s PARODD=%s HUPCL=%s CLOCAL=%s"
  411. #ifdef LOBLK
  412. " LOBLK=%s"
  413. #endif
  414. " CMSPAR=%s CRTSCTS=%s",
  415. ISSETC(CBAUDEX), VALC(CSIZE), ISSETC(CSTOPB), ISSETC(CREAD),
  416. ISSETC(PARENB), ISSETC(PARODD), ISSETC(HUPCL), ISSETC(CLOCAL),
  417. #ifdef LOBLK
  418. ISSETC(LOBLK),
  419. #endif
  420. ISSETC(CMSPAR), ISSETC(CRTSCTS));
  421. #define ISSETL(b) ((my_termios->c_lflag | (b)) ? BITSSET : BITSNOTSET)
  422. 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"
  423. #ifdef DEFECHO
  424. " DEFECHO=%s"
  425. #endif
  426. " FLUSHO=%s NOFLSH=%s TOSTOP=%s PENDIN=%s IEXTEN=%s",
  427. ISSETL(ISIG), ISSETL(ICANON), ISSETL(XCASE), ISSETL(ECHO),
  428. ISSETL(ECHOE), ISSETL(ECHOK), ISSETL(ECHONL), ISSETL(ECHOCTL),
  429. ISSETL(ECHOPRT), ISSETL(ECHOKE),
  430. #ifdef DEFECHO
  431. ISSETL(DEFECHO),
  432. #endif
  433. ISSETL(FLUSHO), ISSETL(NOFLSH), ISSETL(TOSTOP), ISSETL(PENDIN),
  434. ISSETL(IEXTEN));
  435. #define VALCC(b) (my_termios->c_cc[b])
  436. 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"
  437. #ifdef VSWTCH
  438. " VSWTCH=0x%02x"
  439. #endif
  440. " VSTART=0x%02x VSTOP=0x%02x VSUSP=0x%02x"
  441. #ifdef VDSUSP
  442. " VDSUSP=0x%02x"
  443. #endif
  444. " VLNEXT=0x%02x VWERASE=0x%02x VREPRINT=0x%02x VDISCARD=0x%02x"
  445. #ifdef VSTATUS
  446. " VSTATUS=0x%02x"
  447. #endif
  448. ,
  449. VALCC(VINTR), VALCC(VQUIT), VALCC(VERASE), VALCC(VKILL),
  450. VALCC(VEOF), VALCC(VMIN), VALCC(VEOL), VALCC(VTIME),
  451. VALCC(VEOL2),
  452. #ifdef VSWTCH
  453. VALCC(VSWTCH),
  454. #endif
  455. VALCC(VSTART), VALCC(VSTOP), VALCC(VSUSP),
  456. #ifdef VDSUSP
  457. VALCC(VDSUSP),
  458. #endif
  459. VALCC(VLNEXT), VALCC(VWERASE),
  460. VALCC(VREPRINT), VALCC(VDISCARD)
  461. #ifdef VSTATUS
  462. ,VALCC(VSTATUS)
  463. #endif
  464. );
  465. }
  466. #endif
  467. #endif
  468. /* NOTE: Linux only supports uint8_t (decisecond) timeouts; limiting it in
  469. * this interface buys us warnings when bad constants are passed in.
  470. */
  471. int serial_open(const char *devpath, unsigned long baud, uint8_t timeout, bool purge)
  472. {
  473. #ifdef WIN32
  474. HANDLE hSerial = CreateFile(devpath, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, 0, NULL);
  475. if (unlikely(hSerial == INVALID_HANDLE_VALUE))
  476. {
  477. DWORD e = GetLastError();
  478. switch (e) {
  479. case ERROR_ACCESS_DENIED:
  480. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  481. break;
  482. case ERROR_SHARING_VIOLATION:
  483. applog(LOG_ERR, "%s is already in use by another process", devpath);
  484. break;
  485. default:
  486. applog(LOG_DEBUG, "Open %s failed, GetLastError:%u", devpath, e);
  487. break;
  488. }
  489. return -1;
  490. }
  491. // thanks to af_newbie for pointers about this
  492. COMMCONFIG comCfg = {0};
  493. comCfg.dwSize = sizeof(COMMCONFIG);
  494. comCfg.wVersion = 1;
  495. comCfg.dcb.DCBlength = sizeof(DCB);
  496. comCfg.dcb.BaudRate = baud;
  497. comCfg.dcb.fBinary = 1;
  498. comCfg.dcb.fDtrControl = DTR_CONTROL_ENABLE;
  499. comCfg.dcb.fRtsControl = RTS_CONTROL_ENABLE;
  500. comCfg.dcb.ByteSize = 8;
  501. SetCommConfig(hSerial, &comCfg, sizeof(comCfg));
  502. // Code must specify a valid timeout value (0 means don't timeout)
  503. const DWORD ctoms = ((DWORD)timeout * 100);
  504. COMMTIMEOUTS cto = {ctoms, 0, ctoms, 0, ctoms};
  505. SetCommTimeouts(hSerial, &cto);
  506. if (purge) {
  507. PurgeComm(hSerial, PURGE_RXABORT);
  508. PurgeComm(hSerial, PURGE_TXABORT);
  509. PurgeComm(hSerial, PURGE_RXCLEAR);
  510. PurgeComm(hSerial, PURGE_TXCLEAR);
  511. }
  512. return _open_osfhandle((LONG)hSerial, 0);
  513. #else
  514. int fdDev = open(devpath, O_RDWR | O_CLOEXEC | O_NOCTTY);
  515. if (unlikely(fdDev == -1))
  516. {
  517. if (errno == EACCES)
  518. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  519. else
  520. applog(LOG_DEBUG, "Open %s failed, errno:%d", devpath, errno);
  521. return -1;
  522. }
  523. struct termios my_termios;
  524. tcgetattr(fdDev, &my_termios);
  525. #ifdef TERMIOS_DEBUG
  526. termios_debug(devpath, &my_termios, "before");
  527. #endif
  528. switch (baud) {
  529. case 0:
  530. break;
  531. case 57600:
  532. cfsetispeed(&my_termios, B57600);
  533. cfsetospeed(&my_termios, B57600);
  534. break;
  535. case 115200:
  536. cfsetispeed(&my_termios, B115200);
  537. cfsetospeed(&my_termios, B115200);
  538. break;
  539. // TODO: try some higher speeds with the Icarus and BFL to see
  540. // if they support them and if setting them makes any difference
  541. // N.B. B3000000 doesn't work on Icarus
  542. default:
  543. applog(LOG_WARNING, "Unrecognized baud rate: %lu", baud);
  544. }
  545. my_termios.c_cflag |= CS8;
  546. my_termios.c_cflag |= CREAD;
  547. my_termios.c_cflag |= CLOCAL;
  548. my_termios.c_cflag &= ~(CSIZE | PARENB);
  549. my_termios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK |
  550. ISTRIP | INLCR | IGNCR | ICRNL | IXON);
  551. my_termios.c_oflag &= ~OPOST;
  552. my_termios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
  553. // Code must specify a valid timeout value (0 means don't timeout)
  554. my_termios.c_cc[VTIME] = (cc_t)timeout;
  555. my_termios.c_cc[VMIN] = 0;
  556. #ifdef TERMIOS_DEBUG
  557. termios_debug(devpath, &my_termios, "settings");
  558. #endif
  559. tcsetattr(fdDev, TCSANOW, &my_termios);
  560. #ifdef TERMIOS_DEBUG
  561. tcgetattr(fdDev, &my_termios);
  562. termios_debug(devpath, &my_termios, "after");
  563. #endif
  564. if (purge)
  565. tcflush(fdDev, TCIOFLUSH);
  566. return fdDev;
  567. #endif
  568. }
  569. ssize_t _serial_read(int fd, char *buf, size_t bufsiz, char *eol)
  570. {
  571. ssize_t len, tlen = 0;
  572. while (bufsiz) {
  573. len = read(fd, buf, eol ? 1 : bufsiz);
  574. if (len < 1)
  575. break;
  576. tlen += len;
  577. if (eol && *eol == buf[0])
  578. break;
  579. buf += len;
  580. bufsiz -= len;
  581. }
  582. return tlen;
  583. }
  584. static FILE *_open_bitstream(const char *path, const char *subdir, const char *filename)
  585. {
  586. char fullpath[PATH_MAX];
  587. strcpy(fullpath, path);
  588. strcat(fullpath, "/");
  589. if (subdir) {
  590. strcat(fullpath, subdir);
  591. strcat(fullpath, "/");
  592. }
  593. strcat(fullpath, filename);
  594. return fopen(fullpath, "rb");
  595. }
  596. #define _open_bitstream(path, subdir) do { \
  597. f = _open_bitstream(path, subdir, filename); \
  598. if (f) \
  599. return f; \
  600. } while(0)
  601. #define _open_bitstream3(path) do { \
  602. _open_bitstream(path, dname); \
  603. _open_bitstream(path, "bitstreams"); \
  604. _open_bitstream(path, NULL); \
  605. } while(0)
  606. FILE *open_bitstream(const char *dname, const char *filename)
  607. {
  608. FILE *f;
  609. _open_bitstream3(opt_kernel_path);
  610. _open_bitstream3(cgminer_path);
  611. _open_bitstream3(".");
  612. return NULL;
  613. }
  614. #define bailout(...) do { \
  615. applog(__VA_ARGS__); \
  616. return NULL; \
  617. } while(0)
  618. #define check_magic(L) do { \
  619. if (1 != fread(buf, 1, 1, f)) \
  620. bailout(LOG_ERR, "%s %u: Error reading firmware ('%c')", \
  621. cgpu->api->name, cgpu->device_id, L); \
  622. if (buf[0] != L) \
  623. bailout(LOG_ERR, "%s %u: Firmware has wrong magic ('%c')", \
  624. cgpu->api->name, cgpu->device_id, L); \
  625. } while(0)
  626. #define read_str(eng) do { \
  627. if (1 != fread(buf, 2, 1, f)) \
  628. bailout(LOG_ERR, "%s %u: Error reading firmware (" eng " len)", \
  629. cgpu->api->name, cgpu->device_id); \
  630. len = (ubuf[0] << 8) | ubuf[1]; \
  631. if (len >= sizeof(buf)) \
  632. bailout(LOG_ERR, "%s %u: Firmware " eng " too long", \
  633. cgpu->api->name, cgpu->device_id); \
  634. if (1 != fread(buf, len, 1, f)) \
  635. bailout(LOG_ERR, "%s %u: Error reading firmware (" eng ")", \
  636. cgpu->api->name, cgpu->device_id); \
  637. buf[len] = '\0'; \
  638. } while(0)
  639. FILE *open_xilinx_bitstream(struct cgpu_info *cgpu, const char *fwfile, unsigned long *out_len)
  640. {
  641. char buf[0x100];
  642. unsigned char *ubuf = (unsigned char*)buf;
  643. unsigned long len;
  644. char *p;
  645. FILE *f = open_bitstream(cgpu->api->dname, fwfile);
  646. if (!f)
  647. bailout(LOG_ERR, "%s %u: Error opening firmware file %s",
  648. cgpu->api->name, cgpu->device_id, fwfile);
  649. if (1 != fread(buf, 2, 1, f))
  650. bailout(LOG_ERR, "%s %u: Error reading firmware (magic)",
  651. cgpu->api->name, cgpu->device_id);
  652. if (buf[0] || buf[1] != 9)
  653. bailout(LOG_ERR, "%s %u: Firmware has wrong magic (9)",
  654. cgpu->api->name, cgpu->device_id);
  655. if (-1 == fseek(f, 11, SEEK_CUR))
  656. bailout(LOG_ERR, "%s %u: Firmware seek failed",
  657. cgpu->api->name, cgpu->device_id);
  658. check_magic('a');
  659. read_str("design name");
  660. applog(LOG_DEBUG, "%s %u: Firmware file %s info:",
  661. cgpu->api->name, cgpu->device_id, fwfile);
  662. applog(LOG_DEBUG, " Design name: %s", buf);
  663. p = strrchr(buf, ';') ?: buf;
  664. p = strrchr(buf, '=') ?: p;
  665. if (p[0] == '=')
  666. ++p;
  667. unsigned long fwusercode = (unsigned long)strtoll(p, &p, 16);
  668. if (p[0] != '\0')
  669. bailout(LOG_ERR, "%s %u: Bad usercode in firmware file",
  670. cgpu->api->name, cgpu->device_id);
  671. if (fwusercode == 0xffffffff)
  672. bailout(LOG_ERR, "%s %u: Firmware doesn't support user code",
  673. cgpu->api->name, cgpu->device_id);
  674. applog(LOG_DEBUG, " Version: %u, build %u", (fwusercode >> 8) & 0xff, fwusercode & 0xff);
  675. check_magic('b');
  676. read_str("part number");
  677. applog(LOG_DEBUG, " Part number: %s", buf);
  678. check_magic('c');
  679. read_str("build date");
  680. applog(LOG_DEBUG, " Build date: %s", buf);
  681. check_magic('d');
  682. read_str("build time");
  683. applog(LOG_DEBUG, " Build time: %s", buf);
  684. check_magic('e');
  685. if (1 != fread(buf, 4, 1, f))
  686. bailout(LOG_ERR, "%s %u: Error reading firmware (data len)",
  687. cgpu->api->name, cgpu->device_id);
  688. len = ((unsigned long)ubuf[0] << 24) | ((unsigned long)ubuf[1] << 16) | (ubuf[2] << 8) | ubuf[3];
  689. applog(LOG_DEBUG, " Bitstream size: %lu", len);
  690. *out_len = len;
  691. return f;
  692. }