fpgautils.c 22 KB

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