fpgautils.c 27 KB

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