lowl-vcom.c 30 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119
  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 <stdbool.h>
  19. #include <stdint.h>
  20. #include <stdlib.h>
  21. #include <sys/types.h>
  22. #include <dirent.h>
  23. #include <string.h>
  24. #ifdef HAVE_SYS_FILE_H
  25. #include <sys/file.h>
  26. #endif
  27. #ifdef HAVE_LIBUSB
  28. #include <libusb.h>
  29. #endif
  30. #include "miner.h"
  31. #ifndef WIN32
  32. #include <errno.h>
  33. #include <termios.h>
  34. #include <sys/ioctl.h>
  35. #include <sys/stat.h>
  36. #include <unistd.h>
  37. #include <fcntl.h>
  38. #ifndef O_CLOEXEC
  39. #define O_CLOEXEC 0
  40. #endif
  41. #else /* WIN32 */
  42. #include <windows.h>
  43. #ifdef HAVE_WIN_DDKUSB
  44. #include <setupapi.h>
  45. #include <usbioctl.h>
  46. #include <usbiodef.h>
  47. #endif
  48. #include <io.h>
  49. #include <utlist.h>
  50. #define dlsym (void*)GetProcAddress
  51. #define dlclose FreeLibrary
  52. typedef unsigned long FT_STATUS;
  53. typedef PVOID FT_HANDLE;
  54. __stdcall FT_STATUS (*FT_ListDevices)(PVOID pArg1, PVOID pArg2, DWORD Flags);
  55. __stdcall FT_STATUS (*FT_Open)(int idx, FT_HANDLE*);
  56. __stdcall FT_STATUS (*FT_GetComPortNumber)(FT_HANDLE, LPLONG lplComPortNumber);
  57. __stdcall FT_STATUS (*FT_Close)(FT_HANDLE);
  58. const uint32_t FT_OPEN_BY_SERIAL_NUMBER = 1;
  59. const uint32_t FT_OPEN_BY_DESCRIPTION = 2;
  60. const uint32_t FT_LIST_ALL = 0x20000000;
  61. const uint32_t FT_LIST_BY_INDEX = 0x40000000;
  62. const uint32_t FT_LIST_NUMBER_ONLY = 0x80000000;
  63. enum {
  64. FT_OK,
  65. };
  66. #endif /* WIN32 */
  67. #ifdef HAVE_LIBUDEV
  68. #include <libudev.h>
  69. #include <sys/ioctl.h>
  70. #endif
  71. #include "logging.h"
  72. #include "lowlevel.h"
  73. #include "miner.h"
  74. #include "util.h"
  75. #include "lowl-vcom.h"
  76. struct lowlevel_driver lowl_vcom;
  77. struct detectone_meta_info_t detectone_meta_info;
  78. void clear_detectone_meta_info(void)
  79. {
  80. detectone_meta_info = (struct detectone_meta_info_t){
  81. .manufacturer = NULL,
  82. };
  83. }
  84. #define _vcom_unique_id(devpath) devpath_to_devid(devpath)
  85. struct lowlevel_device_info *_vcom_devinfo_findorcreate(struct lowlevel_device_info ** const devinfo_list, const char * const devpath)
  86. {
  87. struct lowlevel_device_info *devinfo;
  88. char * const devid = _vcom_unique_id(devpath);
  89. HASH_FIND_STR(*devinfo_list, devid, devinfo);
  90. if (!devinfo)
  91. {
  92. devinfo = malloc(sizeof(*devinfo));
  93. *devinfo = (struct lowlevel_device_info){
  94. .lowl = &lowl_vcom,
  95. .path = strdup(devpath),
  96. .devid = devid,
  97. };
  98. HASH_ADD_KEYPTR(hh, *devinfo_list, devinfo->devid, strlen(devid), devinfo);
  99. }
  100. else
  101. free(devid);
  102. return devinfo;
  103. }
  104. #ifdef HAVE_LIBUDEV
  105. static
  106. void _decode_udev_enc(char *o, const char *s)
  107. {
  108. while(s[0])
  109. {
  110. if (s[0] == '\\' && s[1] == 'x' && s[2] && s[3])
  111. {
  112. hex2bin((void*)(o++), &s[2], 1);
  113. s += 4;
  114. }
  115. else
  116. (o++)[0] = (s++)[0];
  117. }
  118. o[0] = '\0';
  119. }
  120. static
  121. char *_decode_udev_enc_dup(const char *s)
  122. {
  123. if (!s)
  124. return NULL;
  125. char *o = malloc(strlen(s) + 1);
  126. if (!o)
  127. {
  128. applog(LOG_ERR, "Failed to malloc in _decode_udev_enc_dup");
  129. return NULL;
  130. }
  131. _decode_udev_enc(o, s);
  132. return o;
  133. }
  134. static
  135. void _vcom_devinfo_scan_udev(struct lowlevel_device_info ** const devinfo_list)
  136. {
  137. struct udev *udev = udev_new();
  138. struct udev_enumerate *enumerate = udev_enumerate_new(udev);
  139. struct udev_list_entry *list_entry;
  140. struct lowlevel_device_info *devinfo;
  141. udev_enumerate_add_match_subsystem(enumerate, "tty");
  142. udev_enumerate_add_match_property(enumerate, "ID_SERIAL", "*");
  143. udev_enumerate_scan_devices(enumerate);
  144. udev_list_entry_foreach(list_entry, udev_enumerate_get_list_entry(enumerate)) {
  145. struct udev_device *device = udev_device_new_from_syspath(
  146. udev_enumerate_get_udev(enumerate),
  147. udev_list_entry_get_name(list_entry)
  148. );
  149. if (!device)
  150. continue;
  151. const char * const devpath = udev_device_get_devnode(device);
  152. devinfo = _vcom_devinfo_findorcreate(devinfo_list, devpath);
  153. BFGINIT(devinfo->manufacturer, _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_VENDOR_ENC")));
  154. BFGINIT(devinfo->product, _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_MODEL_ENC")));
  155. BFGINIT(devinfo->serial, _decode_udev_enc_dup(udev_device_get_property_value(device, "ID_SERIAL_SHORT")));
  156. udev_device_unref(device);
  157. }
  158. udev_enumerate_unref(enumerate);
  159. udev_unref(udev);
  160. }
  161. #endif
  162. #ifndef WIN32
  163. static
  164. void _vcom_devinfo_scan_devserial(struct lowlevel_device_info ** const devinfo_list)
  165. {
  166. DIR *D;
  167. struct dirent *de;
  168. const char udevdir[] = "/dev/serial/by-id";
  169. char devpath[sizeof(udevdir) + 1 + NAME_MAX];
  170. char *devfile = devpath + sizeof(udevdir);
  171. struct lowlevel_device_info *devinfo;
  172. D = opendir(udevdir);
  173. if (!D)
  174. return;
  175. memcpy(devpath, udevdir, sizeof(udevdir) - 1);
  176. devpath[sizeof(udevdir) - 1] = '/';
  177. while ( (de = readdir(D)) ) {
  178. if (strncmp(de->d_name, "usb-", 4))
  179. continue;
  180. strcpy(devfile, de->d_name);
  181. devinfo = _vcom_devinfo_findorcreate(devinfo_list, devpath);
  182. if (!(devinfo->manufacturer || devinfo->product || devinfo->serial))
  183. devinfo->product = strdup(devfile);
  184. }
  185. closedir(D);
  186. }
  187. #endif
  188. #ifndef WIN32
  189. static
  190. char *_sysfs_do_read(const char *devpath, char *devfile, const char *append)
  191. {
  192. char buf[0x40];
  193. FILE *F;
  194. strcpy(devfile, append);
  195. F = fopen(devpath, "r");
  196. if (F)
  197. {
  198. if (fgets(buf, sizeof(buf), F))
  199. {
  200. size_t L = strlen(buf);
  201. while (isCspace(buf[--L]))
  202. buf[L] = '\0';
  203. }
  204. else
  205. buf[0] = '\0';
  206. fclose(F);
  207. }
  208. else
  209. buf[0] = '\0';
  210. return buf[0] ? strdup(buf) : NULL;
  211. }
  212. static
  213. void _sysfs_find_tty(char *devpath, char *devfile, struct lowlevel_device_info ** const devinfo_list)
  214. {
  215. struct lowlevel_device_info *devinfo;
  216. DIR *DT;
  217. struct dirent *de;
  218. char ttybuf[0x10] = "/dev/";
  219. char *mydevfile = strdup(devfile);
  220. DT = opendir(devpath);
  221. if (!DT)
  222. goto out;
  223. while ( (de = readdir(DT)) )
  224. {
  225. if (strncmp(de->d_name, "tty", 3))
  226. continue;
  227. if (!de->d_name[3])
  228. {
  229. // "tty" directory: recurse (needed for ttyACM)
  230. sprintf(devfile, "%s/tty", mydevfile);
  231. _sysfs_find_tty(devpath, devfile, devinfo_list);
  232. continue;
  233. }
  234. if (strncmp(&de->d_name[3], "USB", 3) && strncmp(&de->d_name[3], "ACM", 3))
  235. continue;
  236. strcpy(&ttybuf[5], de->d_name);
  237. devinfo = _vcom_devinfo_findorcreate(devinfo_list, ttybuf);
  238. BFGINIT(devinfo->manufacturer, _sysfs_do_read(devpath, devfile, "/manufacturer"));
  239. BFGINIT(devinfo->product, _sysfs_do_read(devpath, devfile, "/product"));
  240. BFGINIT(devinfo->serial, _sysfs_do_read(devpath, devfile, "/serial"));
  241. }
  242. closedir(DT);
  243. out:
  244. free(mydevfile);
  245. }
  246. static
  247. void _vcom_devinfo_scan_sysfs(struct lowlevel_device_info ** const devinfo_list)
  248. {
  249. DIR *D, *DS;
  250. struct dirent *de;
  251. const char devroot[] = "/sys/bus/usb/devices";
  252. const size_t devrootlen = sizeof(devroot) - 1;
  253. char devpath[sizeof(devroot) + (NAME_MAX * 3)];
  254. char *devfile, *upfile;
  255. size_t len, len2;
  256. D = opendir(devroot);
  257. if (!D)
  258. return;
  259. memcpy(devpath, devroot, devrootlen);
  260. devpath[devrootlen] = '/';
  261. while ( (de = readdir(D)) )
  262. {
  263. len = strlen(de->d_name);
  264. upfile = &devpath[devrootlen + 1];
  265. memcpy(upfile, de->d_name, len);
  266. devfile = upfile + len;
  267. devfile[0] = '\0';
  268. DS = opendir(devpath);
  269. if (!DS)
  270. continue;
  271. devfile[0] = '/';
  272. ++devfile;
  273. while ( (de = readdir(DS)) )
  274. {
  275. if (strncmp(de->d_name, upfile, len))
  276. continue;
  277. len2 = strlen(de->d_name);
  278. memcpy(devfile, de->d_name, len2 + 1);
  279. _sysfs_find_tty(devpath, devfile, devinfo_list);
  280. }
  281. closedir(DS);
  282. }
  283. closedir(D);
  284. }
  285. #endif
  286. #ifdef HAVE_WIN_DDKUSB
  287. static const GUID WIN_GUID_DEVINTERFACE_USB_HOST_CONTROLLER = { 0x3ABF6F2D, 0x71C4, 0x462A, {0x8A, 0x92, 0x1E, 0x68, 0x61, 0xE6, 0xAF, 0x27} };
  288. static
  289. char *windows_usb_get_port_path(HANDLE hubh, const int portno)
  290. {
  291. size_t namesz;
  292. ULONG rsz;
  293. {
  294. USB_NODE_CONNECTION_NAME pathinfo = {
  295. .ConnectionIndex = portno,
  296. };
  297. if (!(DeviceIoControl(hubh, IOCTL_USB_GET_NODE_CONNECTION_NAME, &pathinfo, sizeof(pathinfo), &pathinfo, sizeof(pathinfo), &rsz, NULL) && rsz >= sizeof(pathinfo)))
  298. applogfailinfor(NULL, LOG_ERR, "ioctl (1)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  299. namesz = pathinfo.ActualLength;
  300. }
  301. const size_t bufsz = sizeof(USB_NODE_CONNECTION_NAME) + namesz;
  302. uint8_t buf[bufsz];
  303. USB_NODE_CONNECTION_NAME *path = (USB_NODE_CONNECTION_NAME *)buf;
  304. *path = (USB_NODE_CONNECTION_NAME){
  305. .ConnectionIndex = portno,
  306. };
  307. if (!(DeviceIoControl(hubh, IOCTL_USB_GET_NODE_CONNECTION_NAME, path, bufsz, path, bufsz, &rsz, NULL) && rsz >= sizeof(*path)))
  308. applogfailinfor(NULL, LOG_ERR, "ioctl (2)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  309. return ucs2_to_utf8_dup(path->NodeName, path->ActualLength);
  310. }
  311. static
  312. char *windows_usb_get_string(HANDLE hubh, const int portno, const uint8_t descid)
  313. {
  314. if (!descid)
  315. return NULL;
  316. const size_t descsz_max = sizeof(USB_STRING_DESCRIPTOR) + MAXIMUM_USB_STRING_LENGTH;
  317. const size_t reqsz = sizeof(USB_DESCRIPTOR_REQUEST) + descsz_max;
  318. uint8_t buf[reqsz];
  319. USB_DESCRIPTOR_REQUEST * const req = (USB_DESCRIPTOR_REQUEST *)buf;
  320. USB_STRING_DESCRIPTOR * const desc = (USB_STRING_DESCRIPTOR *)&req[1];
  321. *req = (USB_DESCRIPTOR_REQUEST){
  322. .ConnectionIndex = portno,
  323. .SetupPacket = {
  324. .wValue = (USB_STRING_DESCRIPTOR_TYPE << 8) | descid,
  325. .wIndex = 0,
  326. .wLength = descsz_max,
  327. },
  328. };
  329. // Need to explicitly zero the output memory
  330. memset(desc, '\0', descsz_max);
  331. ULONG descsz;
  332. if (!DeviceIoControl(hubh, IOCTL_USB_GET_DESCRIPTOR_FROM_NODE_CONNECTION, req, reqsz, req, reqsz, &descsz, NULL))
  333. applogfailinfor(NULL, LOG_DEBUG, "ioctl", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  334. if (descsz < 2 || desc->bDescriptorType != USB_STRING_DESCRIPTOR_TYPE || desc->bLength > descsz - sizeof(USB_DESCRIPTOR_REQUEST) || desc->bLength % 2)
  335. applogfailr(NULL, LOG_ERR, "sanity check");
  336. return ucs2_to_utf8_dup(desc->bString, desc->bLength);
  337. }
  338. static void _vcom_devinfo_scan_windows__hub(struct lowlevel_device_info **, const char *);
  339. static
  340. void _vcom_devinfo_scan_windows__hubport(struct lowlevel_device_info ** const devinfo_list, HANDLE hubh, const int portno)
  341. {
  342. struct lowlevel_device_info *devinfo;
  343. const size_t conninfosz = sizeof(USB_NODE_CONNECTION_INFORMATION) + (sizeof(USB_PIPE_INFO) * 30);
  344. uint8_t buf[conninfosz];
  345. USB_NODE_CONNECTION_INFORMATION * const conninfo = (USB_NODE_CONNECTION_INFORMATION *)buf;
  346. conninfo->ConnectionIndex = portno;
  347. ULONG respsz;
  348. if (!DeviceIoControl(hubh, IOCTL_USB_GET_NODE_CONNECTION_INFORMATION, conninfo, conninfosz, conninfo, conninfosz, &respsz, NULL))
  349. applogfailinfor(, LOG_ERR, "ioctl", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  350. if (conninfo->ConnectionStatus != DeviceConnected)
  351. return;
  352. if (conninfo->DeviceIsHub)
  353. {
  354. const char * const hubpath = windows_usb_get_port_path(hubh, portno);
  355. if (hubpath)
  356. _vcom_devinfo_scan_windows__hub(devinfo_list, hubpath);
  357. return;
  358. }
  359. const USB_DEVICE_DESCRIPTOR * const devdesc = &conninfo->DeviceDescriptor;
  360. char * const serial = windows_usb_get_string(hubh, portno, devdesc->iSerialNumber);
  361. if (!serial)
  362. {
  363. out:
  364. free(serial);
  365. return;
  366. }
  367. const size_t slen = strlen(serial);
  368. char subkey[52 + slen + 18 + 1];
  369. sprintf(subkey, "SYSTEM\\CurrentControlSet\\Enum\\USB\\VID_%04x&PID_%04x\\%s\\Device Parameters",
  370. (unsigned)devdesc->idVendor, (unsigned)devdesc->idProduct, serial);
  371. HKEY hkey;
  372. int e;
  373. if (ERROR_SUCCESS != (e = RegOpenKey(HKEY_LOCAL_MACHINE, subkey, &hkey)))
  374. {
  375. applogfailinfo(LOG_ERR, "open Device Parameters registry key", "%s", bfg_strerror(e, BST_SYSTEM));
  376. goto out;
  377. }
  378. char devpath[0x10] = "\\\\.\\";
  379. DWORD type, sz = sizeof(devpath) - 4;
  380. if (ERROR_SUCCESS != (e = RegQueryValueExA(hkey, "PortName", NULL, &type, (LPBYTE)&devpath[4], &sz)))
  381. {
  382. applogfailinfo(LOG_ERR, "get PortName registry key value", "%s", bfg_strerror(e, BST_SYSTEM));
  383. RegCloseKey(hkey);
  384. goto out;
  385. }
  386. RegCloseKey(hkey);
  387. if (type != REG_SZ)
  388. {
  389. applogfailinfor(, LOG_ERR, "get expected type for PortName registry key value", "%ld", (long)type);
  390. goto out;
  391. }
  392. devinfo = _vcom_devinfo_findorcreate(devinfo_list, devpath);
  393. BFGINIT(devinfo->manufacturer, windows_usb_get_string(hubh, portno, devdesc->iManufacturer));
  394. BFGINIT(devinfo->product, windows_usb_get_string(hubh, portno, devdesc->iProduct));
  395. if (devinfo->serial)
  396. free(serial);
  397. else
  398. devinfo->serial = serial;
  399. }
  400. static
  401. void _vcom_devinfo_scan_windows__hub(struct lowlevel_device_info ** const devinfo_list, const char * const hubpath)
  402. {
  403. HANDLE hubh;
  404. USB_NODE_INFORMATION nodeinfo;
  405. {
  406. char deviceName[4 + strlen(hubpath) + 1];
  407. sprintf(deviceName, "\\\\.\\%s", hubpath);
  408. hubh = CreateFile(deviceName, GENERIC_WRITE, FILE_SHARE_WRITE, NULL, OPEN_EXISTING, 0, NULL);
  409. if (hubh == INVALID_HANDLE_VALUE)
  410. applogr(, LOG_ERR, "Error opening USB hub device %s for autodetect: %s", deviceName, bfg_strerror(GetLastError(), BST_SYSTEM));
  411. }
  412. ULONG nBytes;
  413. if (!DeviceIoControl(hubh, IOCTL_USB_GET_NODE_INFORMATION, &nodeinfo, sizeof(nodeinfo), &nodeinfo, sizeof(nodeinfo), &nBytes, NULL))
  414. applogfailinfor(, LOG_ERR, "ioctl", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  415. const int portcount = nodeinfo.u.HubInformation.HubDescriptor.bNumberOfPorts;
  416. for (int i = 1; i <= portcount; ++i)
  417. _vcom_devinfo_scan_windows__hubport(devinfo_list, hubh, i);
  418. CloseHandle(hubh);
  419. }
  420. static
  421. char *windows_usb_get_root_hub_path(HANDLE hcntlrh)
  422. {
  423. size_t namesz;
  424. ULONG rsz;
  425. {
  426. USB_ROOT_HUB_NAME pathinfo;
  427. if (!(DeviceIoControl(hcntlrh, IOCTL_USB_GET_ROOT_HUB_NAME, 0, 0, &pathinfo, sizeof(pathinfo), &rsz, NULL) && rsz >= sizeof(pathinfo)))
  428. applogfailinfor(NULL, LOG_ERR, "ioctl (1)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  429. namesz = pathinfo.ActualLength;
  430. }
  431. const size_t bufsz = sizeof(USB_ROOT_HUB_NAME) + namesz;
  432. uint8_t buf[bufsz];
  433. USB_ROOT_HUB_NAME *hubpath = (USB_ROOT_HUB_NAME *)buf;
  434. if (!(DeviceIoControl(hcntlrh, IOCTL_USB_GET_ROOT_HUB_NAME, NULL, 0, hubpath, bufsz, &rsz, NULL) && rsz >= sizeof(*hubpath)))
  435. applogfailinfor(NULL, LOG_ERR, "ioctl (2)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  436. return ucs2_to_utf8_dup(hubpath->RootHubName, hubpath->ActualLength);
  437. }
  438. static
  439. void _vcom_devinfo_scan_windows__hcntlr(struct lowlevel_device_info ** const devinfo_list, HDEVINFO *devinfo, const int i)
  440. {
  441. SP_DEVICE_INTERFACE_DATA devifacedata = {
  442. .cbSize = sizeof(devifacedata),
  443. };
  444. if (!SetupDiEnumDeviceInterfaces(*devinfo, 0, (LPGUID)&WIN_GUID_DEVINTERFACE_USB_HOST_CONTROLLER, i, &devifacedata))
  445. applogfailinfor(, LOG_ERR, "SetupDiEnumDeviceInterfaces", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  446. DWORD detailsz;
  447. if (!(!SetupDiGetDeviceInterfaceDetail(*devinfo, &devifacedata, NULL, 0, &detailsz, NULL) && GetLastError() == ERROR_INSUFFICIENT_BUFFER))
  448. applogfailinfor(, LOG_ERR, "SetupDiEnumDeviceInterfaceDetail (1)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  449. PSP_DEVICE_INTERFACE_DETAIL_DATA detail = alloca(detailsz);
  450. detail->cbSize = sizeof(*detail);
  451. if (!SetupDiGetDeviceInterfaceDetail(*devinfo, &devifacedata, detail, detailsz, &detailsz, NULL))
  452. applogfailinfor(, LOG_ERR, "SetupDiEnumDeviceInterfaceDetail (2)", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  453. HANDLE hcntlrh = CreateFile(detail->DevicePath, GENERIC_WRITE, FILE_SHARE_WRITE, NULL, OPEN_EXISTING, 0, NULL);
  454. if (hcntlrh == INVALID_HANDLE_VALUE)
  455. applogfailinfor(, LOG_DEBUG, "open USB host controller device", "%s", bfg_strerror(GetLastError(), BST_SYSTEM));
  456. char * const hubpath = windows_usb_get_root_hub_path(hcntlrh);
  457. CloseHandle(hcntlrh);
  458. _vcom_devinfo_scan_windows__hub(devinfo_list, hubpath);
  459. free(hubpath);
  460. }
  461. static
  462. void _vcom_devinfo_scan_windows(struct lowlevel_device_info ** const devinfo_list)
  463. {
  464. HDEVINFO devinfo;
  465. devinfo = SetupDiGetClassDevs(&WIN_GUID_DEVINTERFACE_USB_HOST_CONTROLLER, NULL, NULL, (DIGCF_PRESENT | DIGCF_DEVICEINTERFACE));
  466. SP_DEVINFO_DATA devinfodata = {
  467. .cbSize = sizeof(devinfodata),
  468. };
  469. for (int i = 0; SetupDiEnumDeviceInfo(devinfo, i, &devinfodata); ++i)
  470. _vcom_devinfo_scan_windows__hcntlr(devinfo_list, &devinfo, i);
  471. SetupDiDestroyDeviceInfoList(devinfo);
  472. }
  473. #endif
  474. #ifdef WIN32
  475. #define LOAD_SYM(sym) do { \
  476. if (!(sym = dlsym(dll, #sym))) { \
  477. applog(LOG_DEBUG, "Failed to load " #sym ", not using FTDI autodetect"); \
  478. goto out; \
  479. } \
  480. } while(0)
  481. static
  482. char *_ftdi_get_string(char *buf, int i, DWORD flags)
  483. {
  484. if (FT_OK != FT_ListDevices((PVOID)i, buf, FT_LIST_BY_INDEX | flags))
  485. return NULL;
  486. return buf[0] ? buf : NULL;
  487. }
  488. static
  489. void _vcom_devinfo_scan_ftdi(struct lowlevel_device_info ** const devinfo_list)
  490. {
  491. char devpath[] = "\\\\.\\COMnnnnn";
  492. char *devpathnum = &devpath[7];
  493. char **bufptrs;
  494. char *buf;
  495. char serial[64];
  496. struct lowlevel_device_info *devinfo;
  497. DWORD i;
  498. FT_STATUS ftStatus;
  499. DWORD numDevs;
  500. HMODULE dll = LoadLibrary("FTD2XX.DLL");
  501. if (!dll) {
  502. applog(LOG_DEBUG, "FTD2XX.DLL failed to load, not using FTDI autodetect");
  503. return;
  504. }
  505. LOAD_SYM(FT_ListDevices);
  506. LOAD_SYM(FT_Open);
  507. LOAD_SYM(FT_GetComPortNumber);
  508. LOAD_SYM(FT_Close);
  509. ftStatus = FT_ListDevices(&numDevs, NULL, FT_LIST_NUMBER_ONLY);
  510. if (ftStatus != FT_OK) {
  511. applog(LOG_DEBUG, "FTDI device count failed, not using FTDI autodetect");
  512. goto out;
  513. }
  514. applog(LOG_DEBUG, "FTDI reports %u devices", (unsigned)numDevs);
  515. buf = alloca(65 * numDevs);
  516. bufptrs = alloca(sizeof(*bufptrs) * (numDevs + 1));
  517. for (i = 0; i < numDevs; ++i)
  518. bufptrs[i] = &buf[i * 65];
  519. bufptrs[numDevs] = NULL;
  520. ftStatus = FT_ListDevices(bufptrs, &numDevs, FT_LIST_ALL | FT_OPEN_BY_DESCRIPTION);
  521. if (ftStatus != FT_OK) {
  522. applog(LOG_DEBUG, "FTDI device list failed, not using FTDI autodetect");
  523. goto out;
  524. }
  525. for (i = numDevs; i > 0; ) {
  526. --i;
  527. bufptrs[i][64] = '\0';
  528. FT_HANDLE ftHandle;
  529. if (FT_OK != FT_Open(i, &ftHandle))
  530. continue;
  531. LONG lComPortNumber;
  532. ftStatus = FT_GetComPortNumber(ftHandle, &lComPortNumber);
  533. FT_Close(ftHandle);
  534. if (FT_OK != ftStatus || lComPortNumber < 0)
  535. continue;
  536. applog(LOG_ERR, "FT_GetComPortNumber(%p (%ld), %ld)", ftHandle, (long)i, (long)lComPortNumber);
  537. sprintf(devpathnum, "%d", (int)lComPortNumber);
  538. devinfo = _vcom_devinfo_findorcreate(devinfo_list, devpath);
  539. BFGINIT(devinfo->product, (bufptrs[i] && bufptrs[i][0]) ? strdup(bufptrs[i]) : NULL);
  540. BFGINIT(devinfo->serial, maybe_strdup(_ftdi_get_string(serial, i, FT_OPEN_BY_SERIAL_NUMBER)));
  541. }
  542. out:
  543. dlclose(dll);
  544. }
  545. #endif
  546. #ifdef WIN32
  547. extern void _vcom_devinfo_scan_querydosdevice(struct lowlevel_device_info **);
  548. #else
  549. extern void _vcom_devinfo_scan_lsdev(struct lowlevel_device_info **);
  550. #endif
  551. extern bool lowl_usb_attach_kernel_driver(const struct lowlevel_device_info *);
  552. bool vcom_lowl_probe_wrapper(const struct lowlevel_device_info * const info, detectone_func_t detectone)
  553. {
  554. if (info->lowl != &lowl_vcom)
  555. {
  556. #ifdef HAVE_LIBUSB
  557. if (info->lowl == &lowl_usb)
  558. {
  559. if (lowl_usb_attach_kernel_driver(info))
  560. bfg_need_detect_rescan = true;
  561. }
  562. #endif
  563. return false;
  564. }
  565. detectone_meta_info = (struct detectone_meta_info_t){
  566. .manufacturer = info->manufacturer,
  567. .product = info->product,
  568. .serial = info->serial,
  569. };
  570. const bool rv = detectone(info->path);
  571. clear_detectone_meta_info();
  572. return rv;
  573. }
  574. bool _serial_autodetect_found_cb(struct lowlevel_device_info * const devinfo, void *userp)
  575. {
  576. detectone_func_t detectone = userp;
  577. if (bfg_claim_any(NULL, devinfo->path, devinfo->devid))
  578. {
  579. applog(LOG_DEBUG, "%s (%s) is already claimed, skipping probe", devinfo->path, devinfo->devid);
  580. return false;
  581. }
  582. if (devinfo->lowl != &lowl_vcom)
  583. {
  584. #ifdef HAVE_LIBUSB
  585. if (devinfo->lowl == &lowl_usb)
  586. {
  587. if (lowl_usb_attach_kernel_driver(devinfo))
  588. bfg_need_detect_rescan = true;
  589. }
  590. else
  591. #endif
  592. applog(LOG_WARNING, "Non-VCOM %s (%s) matched", devinfo->path, devinfo->devid);
  593. return false;
  594. }
  595. detectone_meta_info = (struct detectone_meta_info_t){
  596. .manufacturer = devinfo->manufacturer,
  597. .product = devinfo->product,
  598. .serial = devinfo->serial,
  599. };
  600. const bool rv = detectone(devinfo->path);
  601. clear_detectone_meta_info();
  602. return rv;
  603. }
  604. int _serial_autodetect(detectone_func_t detectone, ...)
  605. {
  606. va_list needles;
  607. char *needles_array[0x10];
  608. int needlecount = 0;
  609. va_start(needles, detectone);
  610. while ( (needles_array[needlecount++] = va_arg(needles, void *)) )
  611. {}
  612. va_end(needles);
  613. return _lowlevel_detect(_serial_autodetect_found_cb, NULL, (const char **)needles_array, detectone);
  614. }
  615. static
  616. struct lowlevel_device_info *vcom_devinfo_scan()
  617. {
  618. struct lowlevel_device_info *devinfo_hash = NULL;
  619. struct lowlevel_device_info *devinfo_list = NULL;
  620. struct lowlevel_device_info *devinfo, *tmp;
  621. // All 3 USB Strings available:
  622. #ifndef WIN32
  623. _vcom_devinfo_scan_sysfs(&devinfo_hash);
  624. #endif
  625. #ifdef HAVE_WIN_DDKUSB
  626. _vcom_devinfo_scan_windows(&devinfo_hash);
  627. #endif
  628. #ifdef HAVE_LIBUDEV
  629. _vcom_devinfo_scan_udev(&devinfo_hash);
  630. #endif
  631. // Missing Manufacturer:
  632. #ifdef WIN32
  633. _vcom_devinfo_scan_ftdi(&devinfo_hash);
  634. #endif
  635. // All blobbed together:
  636. #ifndef WIN32
  637. _vcom_devinfo_scan_devserial(&devinfo_hash);
  638. #endif
  639. // No info:
  640. #ifdef WIN32
  641. _vcom_devinfo_scan_querydosdevice(&devinfo_hash);
  642. #else
  643. _vcom_devinfo_scan_lsdev(&devinfo_hash);
  644. #endif
  645. // Convert hash to simple list
  646. HASH_ITER(hh, devinfo_hash, devinfo, tmp)
  647. {
  648. LL_PREPEND(devinfo_list, devinfo);
  649. }
  650. HASH_CLEAR(hh, devinfo_hash);
  651. return devinfo_list;
  652. }
  653. struct device_drv *bfg_claim_serial(struct device_drv * const api, const bool verbose, const char * const devpath)
  654. {
  655. char * const devs = _vcom_unique_id(devpath);
  656. if (!devs)
  657. return false;
  658. struct device_drv * const rv = bfg_claim_any(api, (verbose ? devpath : NULL), devs);
  659. free(devs);
  660. return rv;
  661. }
  662. // This code is purely for debugging but is very useful for that
  663. // It also took quite a bit of effort so I left it in
  664. // #define TERMIOS_DEBUG 1
  665. // Here to include it at compile time
  666. // It's off by default
  667. #ifndef WIN32
  668. #ifdef TERMIOS_DEBUG
  669. #define BITSSET "Y"
  670. #define BITSNOTSET "N"
  671. int tiospeed(speed_t speed)
  672. {
  673. switch (speed) {
  674. #define IOSPEED(baud) \
  675. case B ## baud: \
  676. return baud; \
  677. // END
  678. #include "iospeeds_local.h"
  679. #undef IOSPEED
  680. default:
  681. return -1;
  682. }
  683. }
  684. void termios_debug(const char *devpath, struct termios *my_termios, const char *msg)
  685. {
  686. applog(LOG_DEBUG, "TIOS: Open %s attributes %s: ispeed=%d ospeed=%d",
  687. devpath, msg, tiospeed(cfgetispeed(my_termios)), tiospeed(cfgetispeed(my_termios)));
  688. #define ISSETI(b) ((my_termios->c_iflag | (b)) ? BITSSET : BITSNOTSET)
  689. 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",
  690. ISSETI(IGNBRK), ISSETI(BRKINT), ISSETI(IGNPAR), ISSETI(PARMRK),
  691. ISSETI(INPCK), ISSETI(ISTRIP), ISSETI(INLCR), ISSETI(IGNCR),
  692. ISSETI(ICRNL), ISSETI(IUCLC), ISSETI(IXON), ISSETI(IXANY),
  693. ISSETI(IXOFF), ISSETI(IMAXBEL), ISSETI(IUTF8));
  694. #define ISSETO(b) ((my_termios->c_oflag | (b)) ? BITSSET : BITSNOTSET)
  695. #define VALO(b) (my_termios->c_oflag | (b))
  696. 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",
  697. ISSETO(OPOST), ISSETO(OLCUC), ISSETO(ONLCR), ISSETO(OCRNL),
  698. ISSETO(ONOCR), ISSETO(ONLRET), ISSETO(OFILL), ISSETO(OFDEL),
  699. VALO(NLDLY), VALO(CRDLY), VALO(TABDLY), VALO(BSDLY),
  700. VALO(VTDLY), VALO(FFDLY));
  701. #define ISSETC(b) ((my_termios->c_cflag | (b)) ? BITSSET : BITSNOTSET)
  702. #define VALC(b) (my_termios->c_cflag | (b))
  703. applog(LOG_DEBUG, "TIOS: c_cflag: CBAUDEX=%s CSIZE=%d CSTOPB=%s CREAD=%s PARENB=%s PARODD=%s HUPCL=%s CLOCAL=%s"
  704. #ifdef LOBLK
  705. " LOBLK=%s"
  706. #endif
  707. " CMSPAR=%s CRTSCTS=%s",
  708. ISSETC(CBAUDEX), VALC(CSIZE), ISSETC(CSTOPB), ISSETC(CREAD),
  709. ISSETC(PARENB), ISSETC(PARODD), ISSETC(HUPCL), ISSETC(CLOCAL),
  710. #ifdef LOBLK
  711. ISSETC(LOBLK),
  712. #endif
  713. ISSETC(CMSPAR), ISSETC(CRTSCTS));
  714. #define ISSETL(b) ((my_termios->c_lflag | (b)) ? BITSSET : BITSNOTSET)
  715. 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"
  716. #ifdef DEFECHO
  717. " DEFECHO=%s"
  718. #endif
  719. " FLUSHO=%s NOFLSH=%s TOSTOP=%s PENDIN=%s IEXTEN=%s",
  720. ISSETL(ISIG), ISSETL(ICANON), ISSETL(XCASE), ISSETL(ECHO),
  721. ISSETL(ECHOE), ISSETL(ECHOK), ISSETL(ECHONL), ISSETL(ECHOCTL),
  722. ISSETL(ECHOPRT), ISSETL(ECHOKE),
  723. #ifdef DEFECHO
  724. ISSETL(DEFECHO),
  725. #endif
  726. ISSETL(FLUSHO), ISSETL(NOFLSH), ISSETL(TOSTOP), ISSETL(PENDIN),
  727. ISSETL(IEXTEN));
  728. #define VALCC(b) (my_termios->c_cc[b])
  729. 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"
  730. #ifdef VSWTCH
  731. " VSWTCH=0x%02x"
  732. #endif
  733. " VSTART=0x%02x VSTOP=0x%02x VSUSP=0x%02x"
  734. #ifdef VDSUSP
  735. " VDSUSP=0x%02x"
  736. #endif
  737. " VLNEXT=0x%02x VWERASE=0x%02x VREPRINT=0x%02x VDISCARD=0x%02x"
  738. #ifdef VSTATUS
  739. " VSTATUS=0x%02x"
  740. #endif
  741. ,
  742. VALCC(VINTR), VALCC(VQUIT), VALCC(VERASE), VALCC(VKILL),
  743. VALCC(VEOF), VALCC(VMIN), VALCC(VEOL), VALCC(VTIME),
  744. VALCC(VEOL2),
  745. #ifdef VSWTCH
  746. VALCC(VSWTCH),
  747. #endif
  748. VALCC(VSTART), VALCC(VSTOP), VALCC(VSUSP),
  749. #ifdef VDSUSP
  750. VALCC(VDSUSP),
  751. #endif
  752. VALCC(VLNEXT), VALCC(VWERASE),
  753. VALCC(VREPRINT), VALCC(VDISCARD)
  754. #ifdef VSTATUS
  755. ,VALCC(VSTATUS)
  756. #endif
  757. );
  758. }
  759. #endif /* TERMIOS_DEBUG */
  760. speed_t tiospeed_t(int baud)
  761. {
  762. switch (baud) {
  763. #define IOSPEED(baud) \
  764. case baud: \
  765. return B ## baud; \
  766. // END
  767. #include "iospeeds_local.h"
  768. #undef IOSPEED
  769. default:
  770. return B0;
  771. }
  772. }
  773. #endif /* WIN32 */
  774. bool valid_baud(int baud)
  775. {
  776. switch (baud) {
  777. #define IOSPEED(baud) \
  778. case baud: \
  779. return true; \
  780. // END
  781. #include "iospeeds_local.h"
  782. #undef IOSPEED
  783. default:
  784. return false;
  785. }
  786. }
  787. /* NOTE: Linux only supports uint8_t (decisecond) timeouts; limiting it in
  788. * this interface buys us warnings when bad constants are passed in.
  789. */
  790. int serial_open(const char *devpath, unsigned long baud, uint8_t timeout, bool purge)
  791. {
  792. #ifdef WIN32
  793. HANDLE hSerial = CreateFile(devpath, GENERIC_READ | GENERIC_WRITE, 0, NULL, OPEN_EXISTING, 0, NULL);
  794. if (unlikely(hSerial == INVALID_HANDLE_VALUE))
  795. {
  796. DWORD e = GetLastError();
  797. switch (e) {
  798. case ERROR_ACCESS_DENIED:
  799. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  800. break;
  801. case ERROR_SHARING_VIOLATION:
  802. applog(LOG_ERR, "%s is already in use by another process", devpath);
  803. break;
  804. default:
  805. applog(LOG_DEBUG, "Open %s failed, GetLastError:%u", devpath, (unsigned)e);
  806. break;
  807. }
  808. return -1;
  809. }
  810. if (baud)
  811. {
  812. COMMCONFIG comCfg = {0};
  813. comCfg.dwSize = sizeof(COMMCONFIG);
  814. comCfg.wVersion = 1;
  815. comCfg.dcb.DCBlength = sizeof(DCB);
  816. comCfg.dcb.BaudRate = baud;
  817. comCfg.dcb.fBinary = 1;
  818. comCfg.dcb.fDtrControl = DTR_CONTROL_ENABLE;
  819. comCfg.dcb.fRtsControl = RTS_CONTROL_ENABLE;
  820. comCfg.dcb.ByteSize = 8;
  821. SetCommConfig(hSerial, &comCfg, sizeof(comCfg));
  822. }
  823. // Code must specify a valid timeout value (0 means don't timeout)
  824. const DWORD ctoms = ((DWORD)timeout * 100);
  825. COMMTIMEOUTS cto = {ctoms, 0, ctoms, 0, ctoms};
  826. SetCommTimeouts(hSerial, &cto);
  827. if (purge) {
  828. PurgeComm(hSerial, PURGE_RXABORT);
  829. PurgeComm(hSerial, PURGE_TXABORT);
  830. PurgeComm(hSerial, PURGE_RXCLEAR);
  831. PurgeComm(hSerial, PURGE_TXCLEAR);
  832. }
  833. return _open_osfhandle((intptr_t)hSerial, 0);
  834. #else
  835. int fdDev = open(devpath, O_RDWR | O_CLOEXEC | O_NOCTTY);
  836. if (unlikely(fdDev == -1))
  837. {
  838. if (errno == EACCES)
  839. applog(LOG_ERR, "Do not have user privileges required to open %s", devpath);
  840. else
  841. applog(LOG_DEBUG, "Open %s failed: %s", devpath, bfg_strerror(errno, BST_ERRNO));
  842. return -1;
  843. }
  844. #if defined(LOCK_EX) && defined(LOCK_NB)
  845. if (likely(!flock(fdDev, LOCK_EX | LOCK_NB)))
  846. applog(LOG_DEBUG, "Acquired exclusive advisory lock on %s", devpath);
  847. else
  848. if (errno == EWOULDBLOCK)
  849. {
  850. applog(LOG_ERR, "%s is already in use by another process", devpath);
  851. close(fdDev);
  852. return -1;
  853. }
  854. else
  855. applog(LOG_WARNING, "Failed to acquire exclusive lock on %s: %s (ignoring)", devpath, bfg_strerror(errno, BST_ERRNO));
  856. #endif
  857. struct termios my_termios;
  858. tcgetattr(fdDev, &my_termios);
  859. #ifdef TERMIOS_DEBUG
  860. termios_debug(devpath, &my_termios, "before");
  861. #endif
  862. if (baud)
  863. {
  864. speed_t speed = tiospeed_t(baud);
  865. if (speed == B0)
  866. applog(LOG_WARNING, "Unrecognized baud rate: %lu", baud);
  867. else
  868. {
  869. cfsetispeed(&my_termios, speed);
  870. cfsetospeed(&my_termios, speed);
  871. }
  872. }
  873. my_termios.c_cflag &= ~(CSIZE | PARENB);
  874. my_termios.c_cflag |= CS8;
  875. my_termios.c_cflag |= CREAD;
  876. #ifdef USE_AVALON
  877. // my_termios.c_cflag |= CRTSCTS;
  878. #endif
  879. my_termios.c_cflag |= CLOCAL;
  880. my_termios.c_iflag &= ~(IGNBRK | BRKINT | PARMRK |
  881. ISTRIP | INLCR | IGNCR | ICRNL | IXON);
  882. my_termios.c_oflag &= ~OPOST;
  883. my_termios.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
  884. // Code must specify a valid timeout value (0 means don't timeout)
  885. my_termios.c_cc[VTIME] = (cc_t)timeout;
  886. my_termios.c_cc[VMIN] = 0;
  887. #ifdef TERMIOS_DEBUG
  888. termios_debug(devpath, &my_termios, "settings");
  889. #endif
  890. tcsetattr(fdDev, TCSANOW, &my_termios);
  891. #ifdef TERMIOS_DEBUG
  892. tcgetattr(fdDev, &my_termios);
  893. termios_debug(devpath, &my_termios, "after");
  894. #endif
  895. if (purge)
  896. tcflush(fdDev, TCIOFLUSH);
  897. return fdDev;
  898. #endif
  899. }
  900. int serial_close(const int fd)
  901. {
  902. #if defined(LOCK_EX) && defined(LOCK_NB) && defined(LOCK_UN)
  903. flock(fd, LOCK_UN);
  904. #endif
  905. return close(fd);
  906. }
  907. ssize_t _serial_read(int fd, char *buf, size_t bufsiz, char *eol)
  908. {
  909. ssize_t len, tlen = 0;
  910. while (bufsiz) {
  911. len = read(fd, buf, eol ? 1 : bufsiz);
  912. if (len < 1)
  913. break;
  914. tlen += len;
  915. if (eol && *eol == buf[0])
  916. break;
  917. buf += len;
  918. bufsiz -= len;
  919. }
  920. return tlen;
  921. }
  922. #ifndef WIN32
  923. int get_serial_cts(int fd)
  924. {
  925. int flags;
  926. if (!fd)
  927. return -1;
  928. ioctl(fd, TIOCMGET, &flags);
  929. return (flags & TIOCM_CTS) ? 1 : 0;
  930. }
  931. int set_serial_rts(int fd, int rts)
  932. {
  933. int flags;
  934. if (!fd)
  935. return -1;
  936. ioctl(fd, TIOCMGET, &flags);
  937. if (rts)
  938. flags |= TIOCM_RTS;
  939. else
  940. flags &= ~TIOCM_RTS;
  941. ioctl(fd, TIOCMSET, &flags);
  942. return flags & TIOCM_CTS;
  943. }
  944. #else
  945. int get_serial_cts(const int fd)
  946. {
  947. if (!fd)
  948. return -1;
  949. const HANDLE fh = (HANDLE)_get_osfhandle(fd);
  950. if (!fh)
  951. return -1;
  952. DWORD flags;
  953. if (!GetCommModemStatus(fh, &flags))
  954. return -1;
  955. return (flags & MS_CTS_ON) ? 1 : 0;
  956. }
  957. #endif // ! WIN32
  958. struct lowlevel_driver lowl_vcom = {
  959. .dname = "vcom",
  960. .devinfo_scan = vcom_devinfo_scan,
  961. };