fpgautils.c 24 KB

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