openbsd_usb.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823
  1. /*
  2. * Copyright © 2011-2013 Martin Pieuchot <mpi@openbsd.org>
  3. *
  4. * This library is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU Lesser General Public
  6. * License as published by the Free Software Foundation; either
  7. * version 2.1 of the License, or (at your option) any later version.
  8. *
  9. * This library is distributed in the hope that it will be useful,
  10. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  12. * Lesser General Public License for more details.
  13. *
  14. * You should have received a copy of the GNU Lesser General Public
  15. * License along with this library; if not, write to the Free Software
  16. * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  17. */
  18. #include <sys/time.h>
  19. #include <sys/types.h>
  20. #include <errno.h>
  21. #include <fcntl.h>
  22. #include <stdio.h>
  23. #include <stdlib.h>
  24. #include <string.h>
  25. #include <unistd.h>
  26. #include <dev/usb/usb.h>
  27. #include "libusb.h"
  28. #include "libusbi.h"
  29. struct device_priv {
  30. char *devname; /* name of the ugen(4) node */
  31. int fd; /* device file descriptor */
  32. unsigned char *cdesc; /* active config descriptor */
  33. usb_device_descriptor_t ddesc; /* usb device descriptor */
  34. };
  35. struct handle_priv {
  36. int pipe[2]; /* for event notification */
  37. int endpoints[USB_MAX_ENDPOINTS];
  38. };
  39. /*
  40. * Backend functions
  41. */
  42. static int obsd_get_device_list(struct libusb_context *,
  43. struct discovered_devs **);
  44. static int obsd_open(struct libusb_device_handle *);
  45. static void obsd_close(struct libusb_device_handle *);
  46. static int obsd_get_device_descriptor(struct libusb_device *, unsigned char *,
  47. int *);
  48. static int obsd_get_active_config_descriptor(struct libusb_device *,
  49. unsigned char *, size_t, int *);
  50. static int obsd_get_config_descriptor(struct libusb_device *, uint8_t,
  51. unsigned char *, size_t, int *);
  52. static int obsd_get_configuration(struct libusb_device_handle *, int *);
  53. static int obsd_set_configuration(struct libusb_device_handle *, int);
  54. static int obsd_claim_interface(struct libusb_device_handle *, int);
  55. static int obsd_release_interface(struct libusb_device_handle *, int);
  56. static int obsd_set_interface_altsetting(struct libusb_device_handle *, int,
  57. int);
  58. static int obsd_clear_halt(struct libusb_device_handle *, unsigned char);
  59. static int obsd_reset_device(struct libusb_device_handle *);
  60. static void obsd_destroy_device(struct libusb_device *);
  61. static int obsd_submit_transfer(struct usbi_transfer *);
  62. static int obsd_cancel_transfer(struct usbi_transfer *);
  63. static void obsd_clear_transfer_priv(struct usbi_transfer *);
  64. static int obsd_handle_events(struct libusb_context *ctx, struct pollfd *,
  65. nfds_t, int);
  66. static int obsd_clock_gettime(int, struct timespec *);
  67. /*
  68. * Private functions
  69. */
  70. static int _errno_to_libusb(int);
  71. static int _cache_active_config_descriptor(struct libusb_device *);
  72. static int _sync_control_transfer(struct usbi_transfer *);
  73. static int _sync_gen_transfer(struct usbi_transfer *);
  74. static int _access_endpoint(struct libusb_transfer *);
  75. static int _bus_open(int);
  76. const struct usbi_os_backend openbsd_backend = {
  77. "Synchronous OpenBSD backend",
  78. 0,
  79. NULL, /* init() */
  80. NULL, /* exit() */
  81. obsd_get_device_list,
  82. NULL, /* hotplug_poll */
  83. obsd_open,
  84. obsd_close,
  85. obsd_get_device_descriptor,
  86. obsd_get_active_config_descriptor,
  87. obsd_get_config_descriptor,
  88. NULL, /* get_config_descriptor_by_value() */
  89. obsd_get_configuration,
  90. obsd_set_configuration,
  91. obsd_claim_interface,
  92. obsd_release_interface,
  93. obsd_set_interface_altsetting,
  94. obsd_clear_halt,
  95. obsd_reset_device,
  96. NULL, /* kernel_driver_active() */
  97. NULL, /* detach_kernel_driver() */
  98. NULL, /* attach_kernel_driver() */
  99. obsd_destroy_device,
  100. obsd_submit_transfer,
  101. obsd_cancel_transfer,
  102. obsd_clear_transfer_priv,
  103. obsd_handle_events,
  104. obsd_clock_gettime,
  105. sizeof(struct device_priv),
  106. sizeof(struct handle_priv),
  107. 0, /* transfer_priv_size */
  108. 0, /* add_iso_packet_size */
  109. };
  110. #define DEVPATH "/dev/"
  111. #define USBDEV DEVPATH "usb"
  112. int
  113. obsd_get_device_list(struct libusb_context * ctx,
  114. struct discovered_devs **discdevs)
  115. {
  116. struct discovered_devs *ddd;
  117. struct libusb_device *dev;
  118. struct device_priv *dpriv;
  119. struct usb_device_info di;
  120. struct usb_device_ddesc dd;
  121. unsigned long session_id;
  122. char devices[USB_MAX_DEVICES];
  123. char busnode[16];
  124. char *udevname;
  125. int fd, addr, i, j;
  126. usbi_dbg("");
  127. for (i = 0; i < 8; i++) {
  128. snprintf(busnode, sizeof(busnode), USBDEV "%d", i);
  129. if ((fd = open(busnode, O_RDWR)) < 0) {
  130. if (errno != ENOENT && errno != ENXIO)
  131. usbi_err(ctx, "could not open %s", busnode);
  132. continue;
  133. }
  134. bzero(devices, sizeof(devices));
  135. for (addr = 1; addr < USB_MAX_DEVICES; addr++) {
  136. if (devices[addr])
  137. continue;
  138. di.udi_addr = addr;
  139. if (ioctl(fd, USB_DEVICEINFO, &di) < 0)
  140. continue;
  141. /*
  142. * XXX If ugen(4) is attached to the USB device
  143. * it will be used.
  144. */
  145. udevname = NULL;
  146. for (j = 0; j < USB_MAX_DEVNAMES; j++)
  147. if (!strncmp("ugen", di.udi_devnames[j], 4)) {
  148. udevname = strdup(di.udi_devnames[j]);
  149. break;
  150. }
  151. session_id = (di.udi_bus << 8 | di.udi_addr);
  152. dev = usbi_get_device_by_session_id(ctx, session_id);
  153. if (dev == NULL) {
  154. dev = usbi_alloc_device(ctx, session_id);
  155. if (dev == NULL) {
  156. close(fd);
  157. return (LIBUSB_ERROR_NO_MEM);
  158. }
  159. dev->bus_number = di.udi_bus;
  160. dev->device_address = di.udi_addr;
  161. dev->speed = di.udi_speed;
  162. dpriv = (struct device_priv *)dev->os_priv;
  163. dpriv->fd = -1;
  164. dpriv->cdesc = NULL;
  165. dpriv->devname = udevname;
  166. dd.udd_bus = di.udi_bus;
  167. dd.udd_addr = di.udi_addr;
  168. if (ioctl(fd, USB_DEVICE_GET_DDESC, &dd) < 0) {
  169. libusb_unref_device(dev);
  170. continue;
  171. }
  172. dpriv->ddesc = dd.udd_desc;
  173. if (_cache_active_config_descriptor(dev)) {
  174. libusb_unref_device(dev);
  175. continue;
  176. }
  177. if (usbi_sanitize_device(dev))
  178. libusb_unref_device(dev);
  179. }
  180. ddd = discovered_devs_append(*discdevs, dev);
  181. if (ddd == NULL) {
  182. close(fd);
  183. return (LIBUSB_ERROR_NO_MEM);
  184. }
  185. *discdevs = ddd;
  186. devices[addr] = 1;
  187. }
  188. close(fd);
  189. }
  190. return (LIBUSB_SUCCESS);
  191. }
  192. int
  193. obsd_open(struct libusb_device_handle *handle)
  194. {
  195. struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
  196. struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
  197. char devnode[16];
  198. if (dpriv->devname) {
  199. /*
  200. * Only open ugen(4) attached devices read-write, all
  201. * read-only operations are done through the bus node.
  202. */
  203. snprintf(devnode, sizeof(devnode), DEVPATH "%s.00",
  204. dpriv->devname);
  205. dpriv->fd = open(devnode, O_RDWR);
  206. if (dpriv->fd < 0)
  207. return _errno_to_libusb(errno);
  208. usbi_dbg("open %s: fd %d", devnode, dpriv->fd);
  209. }
  210. if (pipe(hpriv->pipe) < 0)
  211. return _errno_to_libusb(errno);
  212. return usbi_add_pollfd(HANDLE_CTX(handle), hpriv->pipe[0], POLLIN);
  213. }
  214. void
  215. obsd_close(struct libusb_device_handle *handle)
  216. {
  217. struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
  218. struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
  219. if (dpriv->devname) {
  220. usbi_dbg("close: fd %d", dpriv->fd);
  221. close(dpriv->fd);
  222. dpriv->fd = -1;
  223. }
  224. usbi_remove_pollfd(HANDLE_CTX(handle), hpriv->pipe[0]);
  225. close(hpriv->pipe[0]);
  226. close(hpriv->pipe[1]);
  227. }
  228. int
  229. obsd_get_device_descriptor(struct libusb_device *dev, unsigned char *buf,
  230. int *host_endian)
  231. {
  232. struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
  233. usbi_dbg("");
  234. memcpy(buf, &dpriv->ddesc, DEVICE_DESC_LENGTH);
  235. *host_endian = 0;
  236. return (LIBUSB_SUCCESS);
  237. }
  238. int
  239. obsd_get_active_config_descriptor(struct libusb_device *dev,
  240. unsigned char *buf, size_t len, int *host_endian)
  241. {
  242. struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
  243. usb_config_descriptor_t *ucd = (usb_config_descriptor_t *)dpriv->cdesc;
  244. len = MIN(len, UGETW(ucd->wTotalLength));
  245. usbi_dbg("len %d", len);
  246. memcpy(buf, dpriv->cdesc, len);
  247. *host_endian = 0;
  248. return (len);
  249. }
  250. int
  251. obsd_get_config_descriptor(struct libusb_device *dev, uint8_t idx,
  252. unsigned char *buf, size_t len, int *host_endian)
  253. {
  254. struct usb_device_fdesc udf;
  255. int fd, err;
  256. if ((fd = _bus_open(dev->bus_number)) < 0)
  257. return _errno_to_libusb(errno);
  258. udf.udf_bus = dev->bus_number;
  259. udf.udf_addr = dev->device_address;
  260. udf.udf_config_index = idx;
  261. udf.udf_size = len;
  262. udf.udf_data = buf;
  263. usbi_dbg("index %d, len %d", udf.udf_config_index, len);
  264. if (ioctl(fd, USB_DEVICE_GET_FDESC, &udf) < 0) {
  265. err = errno;
  266. close(fd);
  267. return _errno_to_libusb(err);
  268. }
  269. close(fd);
  270. *host_endian = 0;
  271. return (len);
  272. }
  273. int
  274. obsd_get_configuration(struct libusb_device_handle *handle, int *config)
  275. {
  276. struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
  277. usb_config_descriptor_t *ucd = (usb_config_descriptor_t *)dpriv->cdesc;
  278. *config = ucd->bConfigurationValue;
  279. usbi_dbg("bConfigurationValue %d", *config);
  280. return (LIBUSB_SUCCESS);
  281. }
  282. int
  283. obsd_set_configuration(struct libusb_device_handle *handle, int config)
  284. {
  285. struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
  286. if (dpriv->devname == NULL)
  287. return (LIBUSB_ERROR_NOT_SUPPORTED);
  288. usbi_dbg("bConfigurationValue %d", config);
  289. if (ioctl(dpriv->fd, USB_SET_CONFIG, &config) < 0)
  290. return _errno_to_libusb(errno);
  291. return _cache_active_config_descriptor(handle->dev);
  292. }
  293. int
  294. obsd_claim_interface(struct libusb_device_handle *handle, int iface)
  295. {
  296. struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
  297. int i;
  298. for (i = 0; i < USB_MAX_ENDPOINTS; i++)
  299. hpriv->endpoints[i] = -1;
  300. return (LIBUSB_SUCCESS);
  301. }
  302. int
  303. obsd_release_interface(struct libusb_device_handle *handle, int iface)
  304. {
  305. struct handle_priv *hpriv = (struct handle_priv *)handle->os_priv;
  306. int i;
  307. for (i = 0; i < USB_MAX_ENDPOINTS; i++)
  308. if (hpriv->endpoints[i] >= 0)
  309. close(hpriv->endpoints[i]);
  310. return (LIBUSB_SUCCESS);
  311. }
  312. int
  313. obsd_set_interface_altsetting(struct libusb_device_handle *handle, int iface,
  314. int altsetting)
  315. {
  316. struct device_priv *dpriv = (struct device_priv *)handle->dev->os_priv;
  317. struct usb_alt_interface intf;
  318. if (dpriv->devname == NULL)
  319. return (LIBUSB_ERROR_NOT_SUPPORTED);
  320. usbi_dbg("iface %d, setting %d", iface, altsetting);
  321. memset(&intf, 0, sizeof(intf));
  322. intf.uai_interface_index = iface;
  323. intf.uai_alt_no = altsetting;
  324. if (ioctl(dpriv->fd, USB_SET_ALTINTERFACE, &intf) < 0)
  325. return _errno_to_libusb(errno);
  326. return (LIBUSB_SUCCESS);
  327. }
  328. int
  329. obsd_clear_halt(struct libusb_device_handle *handle, unsigned char endpoint)
  330. {
  331. struct usb_ctl_request req;
  332. int fd, err;
  333. if ((fd = _bus_open(handle->dev->bus_number)) < 0)
  334. return _errno_to_libusb(errno);
  335. usbi_dbg("");
  336. req.ucr_addr = handle->dev->device_address;
  337. req.ucr_request.bmRequestType = UT_WRITE_ENDPOINT;
  338. req.ucr_request.bRequest = UR_CLEAR_FEATURE;
  339. USETW(req.ucr_request.wValue, UF_ENDPOINT_HALT);
  340. USETW(req.ucr_request.wIndex, endpoint);
  341. USETW(req.ucr_request.wLength, 0);
  342. if (ioctl(fd, USB_REQUEST, &req) < 0) {
  343. err = errno;
  344. close(fd);
  345. return _errno_to_libusb(err);
  346. }
  347. close(fd);
  348. return (LIBUSB_SUCCESS);
  349. }
  350. int
  351. obsd_reset_device(struct libusb_device_handle *handle)
  352. {
  353. usbi_dbg("");
  354. return (LIBUSB_ERROR_NOT_SUPPORTED);
  355. }
  356. void
  357. obsd_destroy_device(struct libusb_device *dev)
  358. {
  359. struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
  360. usbi_dbg("");
  361. free(dpriv->cdesc);
  362. free(dpriv->devname);
  363. }
  364. int
  365. obsd_submit_transfer(struct usbi_transfer *itransfer)
  366. {
  367. struct libusb_transfer *transfer;
  368. struct handle_priv *hpriv;
  369. int err = 0;
  370. usbi_dbg("");
  371. transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
  372. hpriv = (struct handle_priv *)transfer->dev_handle->os_priv;
  373. switch (transfer->type) {
  374. case LIBUSB_TRANSFER_TYPE_CONTROL:
  375. err = _sync_control_transfer(itransfer);
  376. break;
  377. case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
  378. if (IS_XFEROUT(transfer)) {
  379. /* Isochronous write is not supported */
  380. err = LIBUSB_ERROR_NOT_SUPPORTED;
  381. break;
  382. }
  383. err = _sync_gen_transfer(itransfer);
  384. break;
  385. case LIBUSB_TRANSFER_TYPE_BULK:
  386. case LIBUSB_TRANSFER_TYPE_INTERRUPT:
  387. if (IS_XFEROUT(transfer) &&
  388. transfer->flags & LIBUSB_TRANSFER_ADD_ZERO_PACKET) {
  389. err = LIBUSB_ERROR_NOT_SUPPORTED;
  390. break;
  391. }
  392. err = _sync_gen_transfer(itransfer);
  393. break;
  394. }
  395. if (err)
  396. return (err);
  397. if (write(hpriv->pipe[1], &itransfer, sizeof(itransfer)) < 0)
  398. return _errno_to_libusb(errno);
  399. return (LIBUSB_SUCCESS);
  400. }
  401. int
  402. obsd_cancel_transfer(struct usbi_transfer *itransfer)
  403. {
  404. usbi_dbg("");
  405. return (LIBUSB_ERROR_NOT_SUPPORTED);
  406. }
  407. void
  408. obsd_clear_transfer_priv(struct usbi_transfer *itransfer)
  409. {
  410. usbi_dbg("");
  411. /* Nothing to do */
  412. }
  413. int
  414. obsd_handle_events(struct libusb_context *ctx, struct pollfd *fds, nfds_t nfds,
  415. int num_ready)
  416. {
  417. struct libusb_device_handle *handle;
  418. struct handle_priv *hpriv = NULL;
  419. struct usbi_transfer *itransfer;
  420. struct pollfd *pollfd;
  421. int i, err = 0;
  422. usbi_dbg("");
  423. pthread_mutex_lock(&ctx->open_devs_lock);
  424. for (i = 0; i < nfds && num_ready > 0; i++) {
  425. pollfd = &fds[i];
  426. if (!pollfd->revents)
  427. continue;
  428. hpriv = NULL;
  429. num_ready--;
  430. list_for_each_entry(handle, &ctx->open_devs, list,
  431. struct libusb_device_handle) {
  432. hpriv = (struct handle_priv *)handle->os_priv;
  433. if (hpriv->pipe[0] == pollfd->fd)
  434. break;
  435. hpriv = NULL;
  436. }
  437. if (NULL == hpriv) {
  438. usbi_dbg("fd %d is not an event pipe!", pollfd->fd);
  439. err = ENOENT;
  440. break;
  441. }
  442. if (pollfd->revents & POLLERR) {
  443. usbi_remove_pollfd(HANDLE_CTX(handle), hpriv->pipe[0]);
  444. usbi_handle_disconnect(handle);
  445. continue;
  446. }
  447. if (read(hpriv->pipe[0], &itransfer, sizeof(itransfer)) < 0) {
  448. err = errno;
  449. break;
  450. }
  451. if ((err = usbi_handle_transfer_completion(itransfer,
  452. LIBUSB_TRANSFER_COMPLETED)))
  453. break;
  454. }
  455. pthread_mutex_unlock(&ctx->open_devs_lock);
  456. if (err)
  457. return _errno_to_libusb(err);
  458. return (LIBUSB_SUCCESS);
  459. }
  460. int
  461. obsd_clock_gettime(int clkid, struct timespec *tp)
  462. {
  463. usbi_dbg("clock %d", clkid);
  464. if (clkid == USBI_CLOCK_REALTIME)
  465. return clock_gettime(CLOCK_REALTIME, tp);
  466. if (clkid == USBI_CLOCK_MONOTONIC)
  467. return clock_gettime(CLOCK_MONOTONIC, tp);
  468. return (LIBUSB_ERROR_INVALID_PARAM);
  469. }
  470. int
  471. _errno_to_libusb(int err)
  472. {
  473. usbi_dbg("error: %s (%d)", strerror(err), err);
  474. switch (err) {
  475. case EIO:
  476. return (LIBUSB_ERROR_IO);
  477. case EACCES:
  478. return (LIBUSB_ERROR_ACCESS);
  479. case ENOENT:
  480. return (LIBUSB_ERROR_NO_DEVICE);
  481. case ENOMEM:
  482. return (LIBUSB_ERROR_NO_MEM);
  483. case ETIMEDOUT:
  484. return (LIBUSB_ERROR_TIMEOUT);
  485. }
  486. return (LIBUSB_ERROR_OTHER);
  487. }
  488. int
  489. _cache_active_config_descriptor(struct libusb_device *dev)
  490. {
  491. struct device_priv *dpriv = (struct device_priv *)dev->os_priv;
  492. struct usb_device_cdesc udc;
  493. struct usb_device_fdesc udf;
  494. unsigned char* buf;
  495. int fd, len, err;
  496. if ((fd = _bus_open(dev->bus_number)) < 0)
  497. return _errno_to_libusb(errno);
  498. usbi_dbg("fd %d, addr %d", fd, dev->device_address);
  499. udc.udc_bus = dev->bus_number;
  500. udc.udc_addr = dev->device_address;
  501. udc.udc_config_index = USB_CURRENT_CONFIG_INDEX;
  502. if (ioctl(fd, USB_DEVICE_GET_CDESC, &udc) < 0) {
  503. err = errno;
  504. close(fd);
  505. return _errno_to_libusb(errno);
  506. }
  507. usbi_dbg("active bLength %d", udc.udc_desc.bLength);
  508. len = UGETW(udc.udc_desc.wTotalLength);
  509. buf = malloc(len);
  510. if (buf == NULL)
  511. return (LIBUSB_ERROR_NO_MEM);
  512. udf.udf_bus = dev->bus_number;
  513. udf.udf_addr = dev->device_address;
  514. udf.udf_config_index = udc.udc_config_index;
  515. udf.udf_size = len;
  516. udf.udf_data = buf;
  517. usbi_dbg("index %d, len %d", udf.udf_config_index, len);
  518. if (ioctl(fd, USB_DEVICE_GET_FDESC, &udf) < 0) {
  519. err = errno;
  520. close(fd);
  521. free(buf);
  522. return _errno_to_libusb(err);
  523. }
  524. close(fd);
  525. if (dpriv->cdesc)
  526. free(dpriv->cdesc);
  527. dpriv->cdesc = buf;
  528. return (LIBUSB_SUCCESS);
  529. }
  530. int
  531. _sync_control_transfer(struct usbi_transfer *itransfer)
  532. {
  533. struct libusb_transfer *transfer;
  534. struct libusb_control_setup *setup;
  535. struct device_priv *dpriv;
  536. struct usb_ctl_request req;
  537. transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
  538. dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
  539. setup = (struct libusb_control_setup *)transfer->buffer;
  540. usbi_dbg("type %x request %x value %x index %d length %d timeout %d",
  541. setup->bmRequestType, setup->bRequest,
  542. libusb_le16_to_cpu(setup->wValue),
  543. libusb_le16_to_cpu(setup->wIndex),
  544. libusb_le16_to_cpu(setup->wLength), transfer->timeout);
  545. req.ucr_addr = transfer->dev_handle->dev->device_address;
  546. req.ucr_request.bmRequestType = setup->bmRequestType;
  547. req.ucr_request.bRequest = setup->bRequest;
  548. /* Don't use USETW, libusbx already deals with the endianness */
  549. (*(uint16_t *)req.ucr_request.wValue) = setup->wValue;
  550. (*(uint16_t *)req.ucr_request.wIndex) = setup->wIndex;
  551. (*(uint16_t *)req.ucr_request.wLength) = setup->wLength;
  552. req.ucr_data = transfer->buffer + LIBUSB_CONTROL_SETUP_SIZE;
  553. if ((transfer->flags & LIBUSB_TRANSFER_SHORT_NOT_OK) == 0)
  554. req.ucr_flags = USBD_SHORT_XFER_OK;
  555. if (dpriv->devname == NULL) {
  556. /*
  557. * XXX If the device is not attached to ugen(4) it is
  558. * XXX still possible to submit a control transfer but
  559. * XXX with the default timeout only.
  560. */
  561. int fd, err;
  562. if ((fd = _bus_open(transfer->dev_handle->dev->bus_number)) < 0)
  563. return _errno_to_libusb(errno);
  564. if ((ioctl(fd, USB_REQUEST, &req)) < 0) {
  565. err = errno;
  566. close(fd);
  567. return _errno_to_libusb(err);
  568. }
  569. close(fd);
  570. } else {
  571. if ((ioctl(dpriv->fd, USB_SET_TIMEOUT, &transfer->timeout)) < 0)
  572. return _errno_to_libusb(errno);
  573. if ((ioctl(dpriv->fd, USB_DO_REQUEST, &req)) < 0)
  574. return _errno_to_libusb(errno);
  575. }
  576. itransfer->transferred = req.ucr_actlen;
  577. usbi_dbg("transferred %d", itransfer->transferred);
  578. return (0);
  579. }
  580. int
  581. _access_endpoint(struct libusb_transfer *transfer)
  582. {
  583. struct handle_priv *hpriv;
  584. struct device_priv *dpriv;
  585. char devnode[16];
  586. int fd, endpt;
  587. mode_t mode;
  588. hpriv = (struct handle_priv *)transfer->dev_handle->os_priv;
  589. dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
  590. endpt = UE_GET_ADDR(transfer->endpoint);
  591. mode = IS_XFERIN(transfer) ? O_RDONLY : O_WRONLY;
  592. usbi_dbg("endpoint %d mode %d", endpt, mode);
  593. if (hpriv->endpoints[endpt] < 0) {
  594. /* Pick the right endpoint node */
  595. snprintf(devnode, sizeof(devnode), DEVPATH "%s.%02d",
  596. dpriv->devname, endpt);
  597. /* We may need to read/write to the same endpoint later. */
  598. if (((fd = open(devnode, O_RDWR)) < 0) && (errno == ENXIO))
  599. if ((fd = open(devnode, mode)) < 0)
  600. return (-1);
  601. hpriv->endpoints[endpt] = fd;
  602. }
  603. return (hpriv->endpoints[endpt]);
  604. }
  605. int
  606. _sync_gen_transfer(struct usbi_transfer *itransfer)
  607. {
  608. struct libusb_transfer *transfer;
  609. struct device_priv *dpriv;
  610. int fd, nr = 1;
  611. transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
  612. dpriv = (struct device_priv *)transfer->dev_handle->dev->os_priv;
  613. if (dpriv->devname == NULL)
  614. return (LIBUSB_ERROR_NOT_SUPPORTED);
  615. /*
  616. * Bulk, Interrupt or Isochronous transfer depends on the
  617. * endpoint and thus the node to open.
  618. */
  619. if ((fd = _access_endpoint(transfer)) < 0)
  620. return _errno_to_libusb(errno);
  621. if ((ioctl(fd, USB_SET_TIMEOUT, &transfer->timeout)) < 0)
  622. return _errno_to_libusb(errno);
  623. if (IS_XFERIN(transfer)) {
  624. if ((transfer->flags & LIBUSB_TRANSFER_SHORT_NOT_OK) == 0)
  625. if ((ioctl(fd, USB_SET_SHORT_XFER, &nr)) < 0)
  626. return _errno_to_libusb(errno);
  627. nr = read(fd, transfer->buffer, transfer->length);
  628. } else {
  629. nr = write(fd, transfer->buffer, transfer->length);
  630. }
  631. if (nr < 0)
  632. return _errno_to_libusb(errno);
  633. itransfer->transferred = nr;
  634. return (0);
  635. }
  636. int
  637. _bus_open(int number)
  638. {
  639. char busnode[16];
  640. snprintf(busnode, sizeof(busnode), USBDEV "%d", number);
  641. return open(busnode, O_RDWR);
  642. }