1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609 |
- /*
- *
- * Copyright (c) 2016, Oracle and/or its affiliates.
- *
- * This library is free software; you can redistribute it and/or
- * modify it under the terms of the GNU Lesser General Public
- * License as published by the Free Software Foundation; either
- * version 2.1 of the License, or (at your option) any later version.
- *
- * This library is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * Lesser General Public License for more details.
- *
- * You should have received a copy of the GNU Lesser General Public
- * License along with this library; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
- */
- #include <config.h>
- #include <sys/time.h>
- #include <sys/types.h>
- #include <sys/stat.h>
- #include <strings.h>
- #include <errno.h>
- #include <fcntl.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <wait.h>
- #include <unistd.h>
- #include <aio.h>
- #include <libdevinfo.h>
- #include <sys/nvpair.h>
- #include <sys/devctl.h>
- #include <sys/usb/clients/ugen/usb_ugen.h>
- #include <sys/usb/usba.h>
- #include <sys/pci.h>
- #include "libusbi.h"
- #include "sunos_usb.h"
- #define UPDATEDRV_PATH "/usr/sbin/update_drv"
- #define UPDATEDRV "update_drv"
- #define DEFAULT_LISTSIZE 6
- typedef struct {
- int nargs;
- int listsize;
- char **string;
- } string_list_t;
- /*
- * Backend functions
- */
- static int sunos_get_device_list(struct libusb_context *,
- struct discovered_devs **);
- static int sunos_open(struct libusb_device_handle *);
- static void sunos_close(struct libusb_device_handle *);
- static int sunos_get_active_config_descriptor(struct libusb_device *,
- void *, size_t);
- static int sunos_get_config_descriptor(struct libusb_device *, uint8_t,
- void *, size_t);
- static int sunos_get_configuration(struct libusb_device_handle *, uint8_t *);
- static int sunos_set_configuration(struct libusb_device_handle *, int);
- static int sunos_claim_interface(struct libusb_device_handle *, uint8_t);
- static int sunos_release_interface(struct libusb_device_handle *, uint8_t);
- static int sunos_set_interface_altsetting(struct libusb_device_handle *,
- uint8_t, uint8_t);
- static int sunos_clear_halt(struct libusb_device_handle *, unsigned char);
- static void sunos_destroy_device(struct libusb_device *);
- static int sunos_submit_transfer(struct usbi_transfer *);
- static int sunos_cancel_transfer(struct usbi_transfer *);
- static int sunos_handle_transfer_completion(struct usbi_transfer *);
- static int sunos_kernel_driver_active(struct libusb_device_handle *, uint8_t);
- static int sunos_detach_kernel_driver(struct libusb_device_handle *, uint8_t);
- static int sunos_attach_kernel_driver(struct libusb_device_handle *, uint8_t);
- static int sunos_usb_open_ep0(sunos_dev_handle_priv_t *hpriv, sunos_dev_priv_t *dpriv);
- static int sunos_usb_ioctl(struct libusb_device *dev, int cmd);
- static int sunos_get_link(di_devlink_t devlink, void *arg)
- {
- walk_link_t *larg = (walk_link_t *)arg;
- const char *p;
- const char *q;
- if (larg->path) {
- char *content = (char *)di_devlink_content(devlink);
- char *start = strstr(content, "/devices/");
- start += strlen("/devices");
- usbi_dbg(NULL, "%s", start);
- /* line content must have minor node */
- if (start == NULL ||
- strncmp(start, larg->path, larg->len) != 0 ||
- start[larg->len] != ':')
- return (DI_WALK_CONTINUE);
- }
- p = di_devlink_path(devlink);
- q = strrchr(p, '/');
- usbi_dbg(NULL, "%s", q);
- *(larg->linkpp) = strndup(p, strlen(p) - strlen(q));
- return (DI_WALK_TERMINATE);
- }
- static int sunos_physpath_to_devlink(
- const char *node_path, const char *match, char **link_path)
- {
- walk_link_t larg;
- di_devlink_handle_t hdl;
- *link_path = NULL;
- larg.linkpp = link_path;
- if ((hdl = di_devlink_init(NULL, 0)) == NULL) {
- usbi_dbg(NULL, "di_devlink_init failure");
- return (-1);
- }
- larg.len = strlen(node_path);
- larg.path = (char *)node_path;
- (void) di_devlink_walk(hdl, match, NULL, DI_PRIMARY_LINK,
- (void *)&larg, sunos_get_link);
- (void) di_devlink_fini(&hdl);
- if (*link_path == NULL) {
- usbi_dbg(NULL, "there is no devlink for this path");
- return (-1);
- }
- return 0;
- }
- static int
- sunos_usb_ioctl(struct libusb_device *dev, int cmd)
- {
- int fd;
- nvlist_t *nvlist;
- char *end;
- char *phypath;
- char *hubpath;
- char path_arg[PATH_MAX];
- sunos_dev_priv_t *dpriv;
- devctl_ap_state_t devctl_ap_state;
- struct devctl_iocdata iocdata;
- dpriv = usbi_get_device_priv(dev);
- phypath = dpriv->phypath;
- end = strrchr(phypath, '/');
- if (end == NULL)
- return (-1);
- hubpath = strndup(phypath, end - phypath);
- if (hubpath == NULL)
- return (-1);
- end = strrchr(hubpath, '@');
- if (end == NULL) {
- free(hubpath);
- return (-1);
- }
- end++;
- usbi_dbg(DEVICE_CTX(dev), "unitaddr: %s", end);
- nvlist_alloc(&nvlist, NV_UNIQUE_NAME_TYPE, KM_NOSLEEP);
- nvlist_add_int32(nvlist, "port", dev->port_number);
- //find the hub path
- snprintf(path_arg, sizeof(path_arg), "/devices%s:hubd", hubpath);
- usbi_dbg(DEVICE_CTX(dev), "ioctl hub path: %s", path_arg);
- fd = open(path_arg, O_RDONLY);
- if (fd < 0) {
- usbi_err(DEVICE_CTX(dev), "open failed: errno %d (%s)", errno, strerror(errno));
- nvlist_free(nvlist);
- free(hubpath);
- return (-1);
- }
- memset(&iocdata, 0, sizeof(iocdata));
- memset(&devctl_ap_state, 0, sizeof(devctl_ap_state));
- nvlist_pack(nvlist, (char **)&iocdata.nvl_user, &iocdata.nvl_usersz, NV_ENCODE_NATIVE, 0);
- iocdata.cmd = DEVCTL_AP_GETSTATE;
- iocdata.flags = 0;
- iocdata.c_nodename = (char *)"hub";
- iocdata.c_unitaddr = end;
- iocdata.cpyout_buf = &devctl_ap_state;
- usbi_dbg(DEVICE_CTX(dev), "%p, %" PRIuPTR, iocdata.nvl_user, iocdata.nvl_usersz);
- errno = 0;
- if (ioctl(fd, DEVCTL_AP_GETSTATE, &iocdata) == -1) {
- usbi_err(DEVICE_CTX(dev), "ioctl failed: fd %d, cmd %x, errno %d (%s)",
- fd, DEVCTL_AP_GETSTATE, errno, strerror(errno));
- } else {
- usbi_dbg(DEVICE_CTX(dev), "dev rstate: %d", devctl_ap_state.ap_rstate);
- usbi_dbg(DEVICE_CTX(dev), "dev ostate: %d", devctl_ap_state.ap_ostate);
- }
- errno = 0;
- iocdata.cmd = cmd;
- if (ioctl(fd, (int)cmd, &iocdata) != 0) {
- usbi_err(DEVICE_CTX(dev), "ioctl failed: fd %d, cmd %x, errno %d (%s)",
- fd, cmd, errno, strerror(errno));
- sleep(2);
- }
- close(fd);
- free(iocdata.nvl_user);
- nvlist_free(nvlist);
- free(hubpath);
- return (-errno);
- }
- static int
- sunos_kernel_driver_active(struct libusb_device_handle *dev_handle, uint8_t interface)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(dev_handle->dev);
- UNUSED(interface);
- usbi_dbg(HANDLE_CTX(dev_handle), "%s", dpriv->ugenpath);
- return (dpriv->ugenpath == NULL);
- }
- /*
- * Private functions
- */
- static int _errno_to_libusb(int);
- static int sunos_usb_get_status(struct libusb_context *ctx, int fd);
- static string_list_t *
- sunos_new_string_list(void)
- {
- string_list_t *list;
- list = calloc(1, sizeof(string_list_t));
- if (list == NULL)
- return (NULL);
- list->string = calloc(DEFAULT_LISTSIZE, sizeof(char *));
- if (list->string == NULL) {
- free(list);
- return (NULL);
- }
- list->nargs = 0;
- list->listsize = DEFAULT_LISTSIZE;
- return (list);
- }
- static int
- sunos_append_to_string_list(string_list_t *list, const char *arg)
- {
- char *str = strdup(arg);
- if (str == NULL)
- return (-1);
- if ((list->nargs + 1) == list->listsize) { /* +1 is for NULL */
- char **tmp = realloc(list->string,
- sizeof(char *) * (list->listsize + 1));
- if (tmp == NULL) {
- free(str);
- return (-1);
- }
- list->string = tmp;
- list->string[list->listsize++] = NULL;
- }
- list->string[list->nargs++] = str;
- return (0);
- }
- static void
- sunos_free_string_list(string_list_t *list)
- {
- int i;
- for (i = 0; i < list->nargs; i++) {
- free(list->string[i]);
- }
- free(list->string);
- free(list);
- }
- static char **
- sunos_build_argv_list(string_list_t *list)
- {
- return (list->string);
- }
- static int
- sunos_exec_command(struct libusb_context *ctx, const char *path,
- string_list_t *list)
- {
- pid_t pid;
- int status;
- int waitstat;
- int exit_status;
- char **argv_list;
- argv_list = sunos_build_argv_list(list);
- if (argv_list == NULL)
- return (-1);
- pid = fork();
- if (pid == 0) {
- /* child */
- execv(path, argv_list);
- _exit(127);
- } else if (pid > 0) {
- /* parent */
- do {
- waitstat = waitpid(pid, &status, 0);
- } while ((waitstat == -1 && errno == EINTR) ||
- (waitstat == 0 && !WIFEXITED(status) && !WIFSIGNALED(status)));
- if (waitstat == 0) {
- if (WIFEXITED(status))
- exit_status = WEXITSTATUS(status);
- else
- exit_status = WTERMSIG(status);
- } else {
- usbi_err(ctx, "waitpid failed: errno %d (%s)", errno, strerror(errno));
- exit_status = -1;
- }
- } else {
- /* fork failed */
- usbi_err(ctx, "fork failed: errno %d (%s)", errno, strerror(errno));
- exit_status = -1;
- }
- return (exit_status);
- }
- static int
- sunos_detach_kernel_driver(struct libusb_device_handle *dev_handle,
- uint8_t interface_number)
- {
- struct libusb_context *ctx = HANDLE_CTX(dev_handle);
- string_list_t *list;
- char path_arg[PATH_MAX];
- sunos_dev_priv_t *dpriv;
- int r;
- UNUSED(interface_number);
- dpriv = usbi_get_device_priv(dev_handle->dev);
- snprintf(path_arg, sizeof(path_arg), "\'\"%s\"\'", dpriv->phypath);
- usbi_dbg(HANDLE_CTX(dev_handle), "%s", path_arg);
- list = sunos_new_string_list();
- if (list == NULL)
- return (LIBUSB_ERROR_NO_MEM);
- /* attach ugen driver */
- r = 0;
- r |= sunos_append_to_string_list(list, UPDATEDRV);
- r |= sunos_append_to_string_list(list, "-a"); /* add rule */
- r |= sunos_append_to_string_list(list, "-i"); /* specific device */
- r |= sunos_append_to_string_list(list, path_arg); /* physical path */
- r |= sunos_append_to_string_list(list, "ugen");
- if (r) {
- sunos_free_string_list(list);
- return (LIBUSB_ERROR_NO_MEM);
- }
- r = sunos_exec_command(ctx, UPDATEDRV_PATH, list);
- sunos_free_string_list(list);
- if (r < 0)
- return (LIBUSB_ERROR_OTHER);
- /* reconfigure the driver node */
- r = 0;
- r |= sunos_usb_ioctl(dev_handle->dev, DEVCTL_AP_DISCONNECT);
- r |= sunos_usb_ioctl(dev_handle->dev, DEVCTL_AP_CONFIGURE);
- if (r)
- usbi_warn(HANDLE_CTX(dev_handle), "one or more ioctls failed");
- snprintf(path_arg, sizeof(path_arg), "^usb/%x.%x",
- dev_handle->dev->device_descriptor.idVendor,
- dev_handle->dev->device_descriptor.idProduct);
- sunos_physpath_to_devlink(dpriv->phypath, path_arg, &dpriv->ugenpath);
- if (access(dpriv->ugenpath, F_OK) == -1) {
- usbi_err(HANDLE_CTX(dev_handle), "fail to detach kernel driver");
- return (LIBUSB_ERROR_IO);
- }
- return sunos_usb_open_ep0(usbi_get_device_handle_priv(dev_handle), dpriv);
- }
- static int
- sunos_attach_kernel_driver(struct libusb_device_handle *dev_handle,
- uint8_t interface_number)
- {
- struct libusb_context *ctx = HANDLE_CTX(dev_handle);
- string_list_t *list;
- char path_arg[PATH_MAX];
- sunos_dev_priv_t *dpriv;
- int r;
- UNUSED(interface_number);
- /* we open the dev in detach driver, so we need close it first. */
- sunos_close(dev_handle);
- dpriv = usbi_get_device_priv(dev_handle->dev);
- snprintf(path_arg, sizeof(path_arg), "\'\"%s\"\'", dpriv->phypath);
- usbi_dbg(HANDLE_CTX(dev_handle), "%s", path_arg);
- list = sunos_new_string_list();
- if (list == NULL)
- return (LIBUSB_ERROR_NO_MEM);
- /* detach ugen driver */
- r = 0;
- r |= sunos_append_to_string_list(list, UPDATEDRV);
- r |= sunos_append_to_string_list(list, "-d"); /* add rule */
- r |= sunos_append_to_string_list(list, "-i"); /* specific device */
- r |= sunos_append_to_string_list(list, path_arg); /* physical path */
- r |= sunos_append_to_string_list(list, "ugen");
- if (r) {
- sunos_free_string_list(list);
- return (LIBUSB_ERROR_NO_MEM);
- }
- r = sunos_exec_command(ctx, UPDATEDRV_PATH, list);
- sunos_free_string_list(list);
- if (r < 0)
- return (LIBUSB_ERROR_OTHER);
- /* reconfigure the driver node */
- r = 0;
- r |= sunos_usb_ioctl(dev_handle->dev, DEVCTL_AP_CONFIGURE);
- r |= sunos_usb_ioctl(dev_handle->dev, DEVCTL_AP_DISCONNECT);
- r |= sunos_usb_ioctl(dev_handle->dev, DEVCTL_AP_CONFIGURE);
- if (r)
- usbi_warn(HANDLE_CTX(dev_handle), "one or more ioctls failed");
- return 0;
- }
- static int
- sunos_fill_in_dev_info(di_node_t node, struct libusb_device *dev)
- {
- int proplen;
- int *i, n, *addr, *port_prop;
- char *phypath;
- uint8_t *rdata;
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(dev);
- char match_str[PATH_MAX];
- /* Device descriptors */
- proplen = di_prop_lookup_bytes(DDI_DEV_T_ANY, node,
- "usb-dev-descriptor", &rdata);
- if (proplen <= 0) {
- return (LIBUSB_ERROR_IO);
- }
- bcopy(rdata, &dev->device_descriptor, LIBUSB_DT_DEVICE_SIZE);
- /* Raw configuration descriptors */
- proplen = di_prop_lookup_bytes(DDI_DEV_T_ANY, node,
- "usb-raw-cfg-descriptors", &rdata);
- if (proplen <= 0) {
- usbi_dbg(DEVICE_CTX(dev), "can't find raw config descriptors");
- return (LIBUSB_ERROR_IO);
- }
- dpriv->raw_cfgdescr = calloc(1, proplen);
- if (dpriv->raw_cfgdescr == NULL) {
- return (LIBUSB_ERROR_NO_MEM);
- } else {
- bcopy(rdata, dpriv->raw_cfgdescr, proplen);
- dpriv->cfgvalue = ((struct libusb_config_descriptor *)
- rdata)->bConfigurationValue;
- }
- n = di_prop_lookup_ints(DDI_DEV_T_ANY, node, "reg", &port_prop);
- if ((n != 1) || (*port_prop <= 0)) {
- return (LIBUSB_ERROR_IO);
- }
- dev->port_number = *port_prop;
- /* device physical path */
- phypath = di_devfs_path(node);
- if (phypath) {
- dpriv->phypath = strdup(phypath);
- snprintf(match_str, sizeof(match_str), "^usb/%x.%x",
- dev->device_descriptor.idVendor,
- dev->device_descriptor.idProduct);
- usbi_dbg(DEVICE_CTX(dev), "match is %s", match_str);
- sunos_physpath_to_devlink(dpriv->phypath, match_str, &dpriv->ugenpath);
- di_devfs_path_free(phypath);
- } else {
- free(dpriv->raw_cfgdescr);
- return (LIBUSB_ERROR_IO);
- }
- /* address */
- n = di_prop_lookup_ints(DDI_DEV_T_ANY, node, "assigned-address", &addr);
- if (n != 1 || *addr == 0) {
- usbi_dbg(DEVICE_CTX(dev), "can't get address");
- } else {
- dev->device_address = *addr;
- }
- /* speed */
- if (di_prop_lookup_ints(DDI_DEV_T_ANY, node, "low-speed", &i) >= 0) {
- dev->speed = LIBUSB_SPEED_LOW;
- } else if (di_prop_lookup_ints(DDI_DEV_T_ANY, node, "high-speed", &i) >= 0) {
- dev->speed = LIBUSB_SPEED_HIGH;
- } else if (di_prop_lookup_ints(DDI_DEV_T_ANY, node, "full-speed", &i) >= 0) {
- dev->speed = LIBUSB_SPEED_FULL;
- } else if (di_prop_lookup_ints(DDI_DEV_T_ANY, node, "super-speed", &i) >= 0) {
- dev->speed = LIBUSB_SPEED_SUPER;
- }
- usbi_dbg(DEVICE_CTX(dev), "vid=%x pid=%x, path=%s, bus_nmber=0x%x, port_number=%d, speed=%d",
- dev->device_descriptor.idVendor, dev->device_descriptor.idProduct,
- dpriv->phypath, dev->bus_number, dev->port_number, dev->speed);
- return (LIBUSB_SUCCESS);
- }
- static int
- sunos_add_devices(di_devlink_t link, void *arg)
- {
- struct devlink_cbarg *largs = (struct devlink_cbarg *)arg;
- struct node_args *nargs;
- di_node_t myself, dn;
- uint64_t session_id = 0;
- uint64_t sid = 0;
- uint64_t bdf = 0;
- struct libusb_device *dev;
- sunos_dev_priv_t *devpriv;
- int n, *j;
- int i = 0;
- int *addr_prop;
- uint8_t bus_number = 0;
- uint32_t * regbuf = NULL;
- uint32_t reg;
- UNUSED(link);
- nargs = (struct node_args *)largs->nargs;
- myself = largs->myself;
- /*
- * Construct session ID.
- * session ID = dev_addr | hub addr |parent hub addr|...|root hub bdf
- * 8 bits 8bits 8 bits 16bits
- */
- if (myself == DI_NODE_NIL)
- return (DI_WALK_CONTINUE);
- dn = myself;
- /* find the root hub */
- while (di_prop_lookup_ints(DDI_DEV_T_ANY, dn, "root-hub", &j) != 0) {
- usbi_dbg(NULL, "find_root_hub:%s", di_devfs_path(dn));
- n = di_prop_lookup_ints(DDI_DEV_T_ANY, dn,
- "assigned-address", &addr_prop);
- session_id |= ((addr_prop[0] & 0xff) << i++ * 8);
- dn = di_parent_node(dn);
- }
- /* dn is the root hub node */
- n = di_prop_lookup_ints(DDI_DEV_T_ANY, dn, "reg", (int **)®buf);
- reg = regbuf[0];
- bdf = (PCI_REG_BUS_G(reg) << 8) | (PCI_REG_DEV_G(reg) << 3) | PCI_REG_FUNC_G(reg);
- /* bdf must larger than i*8 bits */
- session_id |= (bdf << i * 8);
- bus_number = (PCI_REG_DEV_G(reg) << 3) | PCI_REG_FUNC_G(reg);
- usbi_dbg(NULL, "device bus address=%s:%x, name:%s",
- di_bus_addr(myself), bus_number, di_node_name(dn));
- usbi_dbg(NULL, "session id org:%" PRIx64, session_id);
- /* dn is the usb device */
- for (dn = di_child_node(myself); dn != DI_NODE_NIL; dn = di_sibling_node(dn)) {
- usbi_dbg(NULL, "device path:%s", di_devfs_path(dn));
- /* skip hub devices, because its driver can not been unload */
- if (di_prop_lookup_ints(DDI_DEV_T_ANY, dn, "usb-port-count", &addr_prop) != -1)
- continue;
- /* usb_addr */
- n = di_prop_lookup_ints(DDI_DEV_T_ANY, dn,
- "assigned-address", &addr_prop);
- if ((n != 1) || (addr_prop[0] == 0)) {
- usbi_dbg(NULL, "cannot get valid usb_addr");
- continue;
- }
- sid = (session_id << 8) | (addr_prop[0] & 0xff) ;
- usbi_dbg(NULL, "session id %" PRIX64, sid);
- dev = usbi_get_device_by_session_id(nargs->ctx, sid);
- if (dev == NULL) {
- dev = usbi_alloc_device(nargs->ctx, sid);
- if (dev == NULL) {
- usbi_dbg(NULL, "can't alloc device");
- continue;
- }
- devpriv = usbi_get_device_priv(dev);
- dev->bus_number = bus_number;
- if (sunos_fill_in_dev_info(dn, dev) != LIBUSB_SUCCESS) {
- libusb_unref_device(dev);
- usbi_dbg(NULL, "get information fail");
- continue;
- }
- if (usbi_sanitize_device(dev) < 0) {
- libusb_unref_device(dev);
- usbi_dbg(NULL, "sanatize failed: ");
- return (DI_WALK_TERMINATE);
- }
- } else {
- devpriv = usbi_get_device_priv(dev);
- usbi_dbg(NULL, "Dev %s exists", devpriv->ugenpath);
- }
- if (discovered_devs_append(*(nargs->discdevs), dev) == NULL) {
- usbi_dbg(NULL, "cannot append device");
- }
- /*
- * we alloc and hence ref this dev. We don't need to ref it
- * hereafter. Front end or app should take care of their ref.
- */
- libusb_unref_device(dev);
- usbi_dbg(NULL, "Device %s %s id=0x%" PRIx64 ", devcount:%" PRIuPTR
- ", bdf=%" PRIx64,
- devpriv->ugenpath, di_devfs_path(dn), (uint64_t)sid,
- (*nargs->discdevs)->len, bdf);
- }
- return (DI_WALK_CONTINUE);
- }
- static int
- sunos_walk_minor_node_link(di_node_t node, void *args)
- {
- di_minor_t minor = DI_MINOR_NIL;
- char *minor_path;
- struct devlink_cbarg arg;
- struct node_args *nargs = (struct node_args *)args;
- di_devlink_handle_t devlink_hdl = nargs->dlink_hdl;
- /* walk each minor to find usb devices */
- while ((minor = di_minor_next(node, minor)) != DI_MINOR_NIL) {
- minor_path = di_devfs_minor_path(minor);
- arg.nargs = args;
- arg.myself = node;
- arg.minor = minor;
- (void) di_devlink_walk(devlink_hdl,
- "^usb/hub[0-9]+", minor_path,
- DI_PRIMARY_LINK, (void *)&arg, sunos_add_devices);
- di_devfs_path_free(minor_path);
- }
- /* switch to a different node */
- nargs->last_ugenpath = NULL;
- return (DI_WALK_CONTINUE);
- }
- int
- sunos_get_device_list(struct libusb_context * ctx,
- struct discovered_devs **discdevs)
- {
- di_node_t root_node;
- struct node_args args;
- di_devlink_handle_t devlink_hdl;
- args.ctx = ctx;
- args.discdevs = discdevs;
- args.last_ugenpath = NULL;
- if ((root_node = di_init("/", DINFOCPYALL)) == DI_NODE_NIL) {
- usbi_dbg(ctx, "di_int() failed: errno %d (%s)", errno, strerror(errno));
- return (LIBUSB_ERROR_IO);
- }
- if ((devlink_hdl = di_devlink_init(NULL, 0)) == NULL) {
- di_fini(root_node);
- usbi_dbg(ctx, "di_devlink_init() failed: errno %d (%s)", errno, strerror(errno));
- return (LIBUSB_ERROR_IO);
- }
- args.dlink_hdl = devlink_hdl;
- /* walk each node to find USB devices */
- if (di_walk_node(root_node, DI_WALK_SIBFIRST, &args,
- sunos_walk_minor_node_link) == -1) {
- usbi_dbg(ctx, "di_walk_node() failed: errno %d (%s)", errno, strerror(errno));
- di_fini(root_node);
- return (LIBUSB_ERROR_IO);
- }
- di_fini(root_node);
- di_devlink_fini(&devlink_hdl);
- usbi_dbg(ctx, "%zu devices", (*discdevs)->len);
- return ((*discdevs)->len);
- }
- static int
- sunos_usb_open_ep0(sunos_dev_handle_priv_t *hpriv, sunos_dev_priv_t *dpriv)
- {
- char filename[PATH_MAX + 1];
- if (hpriv->eps[0].datafd > 0) {
- return (LIBUSB_SUCCESS);
- }
- snprintf(filename, PATH_MAX, "%s/cntrl0", dpriv->ugenpath);
- usbi_dbg(NULL, "opening %s", filename);
- hpriv->eps[0].datafd = open(filename, O_RDWR);
- if (hpriv->eps[0].datafd < 0) {
- return(_errno_to_libusb(errno));
- }
- snprintf(filename, PATH_MAX, "%s/cntrl0stat", dpriv->ugenpath);
- hpriv->eps[0].statfd = open(filename, O_RDONLY);
- if (hpriv->eps[0].statfd < 0) {
- close(hpriv->eps[0].datafd);
- hpriv->eps[0].datafd = -1;
- return(_errno_to_libusb(errno));
- }
- return (LIBUSB_SUCCESS);
- }
- static void
- sunos_usb_close_all_eps(sunos_dev_handle_priv_t *hdev)
- {
- int i;
- /* not close ep0 */
- for (i = 1; i < USB_MAXENDPOINTS; i++) {
- if (hdev->eps[i].datafd != -1) {
- (void) close(hdev->eps[i].datafd);
- hdev->eps[i].datafd = -1;
- }
- if (hdev->eps[i].statfd != -1) {
- (void) close(hdev->eps[i].statfd);
- hdev->eps[i].statfd = -1;
- }
- }
- }
- static void
- sunos_usb_close_ep0(sunos_dev_handle_priv_t *hdev)
- {
- if (hdev->eps[0].datafd >= 0) {
- close(hdev->eps[0].datafd);
- close(hdev->eps[0].statfd);
- hdev->eps[0].datafd = -1;
- hdev->eps[0].statfd = -1;
- }
- }
- static uchar_t
- sunos_usb_ep_index(uint8_t ep_addr)
- {
- return ((ep_addr & LIBUSB_ENDPOINT_ADDRESS_MASK) +
- ((ep_addr & LIBUSB_ENDPOINT_DIR_MASK) ? 16 : 0));
- }
- static int
- sunos_find_interface(struct libusb_device_handle *hdev,
- uint8_t endpoint, uint8_t *interface)
- {
- struct libusb_config_descriptor *config;
- int r;
- int iface_idx;
- r = libusb_get_active_config_descriptor(hdev->dev, &config);
- if (r < 0) {
- return (LIBUSB_ERROR_INVALID_PARAM);
- }
- for (iface_idx = 0; iface_idx < config->bNumInterfaces; iface_idx++) {
- const struct libusb_interface *iface =
- &config->interface[iface_idx];
- int altsetting_idx;
- for (altsetting_idx = 0; altsetting_idx < iface->num_altsetting;
- altsetting_idx++) {
- const struct libusb_interface_descriptor *altsetting =
- &iface->altsetting[altsetting_idx];
- int ep_idx;
- for (ep_idx = 0; ep_idx < altsetting->bNumEndpoints;
- ep_idx++) {
- const struct libusb_endpoint_descriptor *ep =
- &altsetting->endpoint[ep_idx];
- if (ep->bEndpointAddress == endpoint) {
- *interface = iface_idx;
- libusb_free_config_descriptor(config);
- return (LIBUSB_SUCCESS);
- }
- }
- }
- }
- libusb_free_config_descriptor(config);
- return (LIBUSB_ERROR_INVALID_PARAM);
- }
- static int
- sunos_check_device_and_status_open(struct libusb_device_handle *hdl,
- uint8_t ep_addr, int ep_type)
- {
- char filename[PATH_MAX + 1], statfilename[PATH_MAX + 1];
- char cfg_num[16], alt_num[16];
- int fd, fdstat, mode;
- uint8_t ifc = 0;
- uint8_t ep_index;
- sunos_dev_handle_priv_t *hpriv;
- usbi_dbg(HANDLE_CTX(hdl), "open ep 0x%02x", ep_addr);
- hpriv = usbi_get_device_handle_priv(hdl);
- ep_index = sunos_usb_ep_index(ep_addr);
- /* ep already opened */
- if ((hpriv->eps[ep_index].datafd > 0) &&
- (hpriv->eps[ep_index].statfd > 0)) {
- usbi_dbg(HANDLE_CTX(hdl), "ep 0x%02x already opened, return success",
- ep_addr);
- return (0);
- }
- if (sunos_find_interface(hdl, ep_addr, &ifc) < 0) {
- usbi_dbg(HANDLE_CTX(hdl), "can't find interface for endpoint 0x%02x",
- ep_addr);
- return (EACCES);
- }
- /* create filename */
- if (hpriv->config_index > 0) {
- (void) snprintf(cfg_num, sizeof(cfg_num), "cfg%d",
- hpriv->config_index + 1);
- } else {
- bzero(cfg_num, sizeof(cfg_num));
- }
- if (hpriv->altsetting[ifc] > 0) {
- (void) snprintf(alt_num, sizeof(alt_num), ".%d",
- hpriv->altsetting[ifc]);
- } else {
- bzero(alt_num, sizeof(alt_num));
- }
- (void) snprintf(filename, PATH_MAX, "%s/%sif%d%s%s%d",
- hpriv->dpriv->ugenpath, cfg_num, ifc, alt_num,
- (ep_addr & LIBUSB_ENDPOINT_DIR_MASK) ? "in" :
- "out", (ep_addr & LIBUSB_ENDPOINT_ADDRESS_MASK));
- (void) snprintf(statfilename, PATH_MAX, "%sstat", filename);
- /*
- * In case configuration has been switched, the xfer endpoint needs
- * to be opened before the status endpoint, due to a ugen issue.
- * However, to enable the one transfer mode for an Interrupt-In pipe,
- * the status endpoint needs to be opened before the xfer endpoint.
- * So, open the xfer mode first and close it immediately
- * as a workaround. This will handle the configuration switch.
- * Then, open the status endpoint. If for an Interrupt-in pipe,
- * write the USB_EP_INTR_ONE_XFER control to the status endpoint
- * to enable the one transfer mode. Then, re-open the xfer mode.
- */
- if (ep_type == LIBUSB_TRANSFER_TYPE_ISOCHRONOUS) {
- mode = O_RDWR;
- } else if (ep_addr & LIBUSB_ENDPOINT_IN) {
- mode = O_RDONLY;
- } else {
- mode = O_WRONLY;
- }
- /* Open the xfer endpoint first */
- if ((fd = open(filename, mode)) == -1) {
- usbi_dbg(HANDLE_CTX(hdl), "can't open %s: errno %d (%s)", filename, errno,
- strerror(errno));
- return (errno);
- }
- /* And immediately close the xfer endpoint */
- (void) close(fd);
- /*
- * Open the status endpoint.
- * If for an Interrupt-IN pipe, need to enable the one transfer mode
- * by writing USB_EP_INTR_ONE_XFER control to the status endpoint
- * before opening the xfer endpoint
- */
- if ((ep_type == LIBUSB_TRANSFER_TYPE_INTERRUPT) &&
- (ep_addr & LIBUSB_ENDPOINT_IN)) {
- char control = USB_EP_INTR_ONE_XFER;
- ssize_t count;
- /* Open the status endpoint with RDWR */
- if ((fdstat = open(statfilename, O_RDWR)) == -1) {
- usbi_dbg(HANDLE_CTX(hdl), "can't open %s RDWR: errno %d (%s)",
- statfilename, errno, strerror(errno));
- return (errno);
- } else {
- count = write(fdstat, &control, sizeof(control));
- if (count != 1) {
- /* this should have worked */
- usbi_dbg(HANDLE_CTX(hdl), "can't write to %s: errno %d (%s)",
- statfilename, errno, strerror(errno));
- (void) close(fdstat);
- return (errno);
- }
- }
- } else {
- if ((fdstat = open(statfilename, O_RDONLY)) == -1) {
- usbi_dbg(HANDLE_CTX(hdl), "can't open %s: errno %d (%s)", statfilename, errno,
- strerror(errno));
- return (errno);
- }
- }
- /* Re-open the xfer endpoint */
- if ((fd = open(filename, mode)) == -1) {
- usbi_dbg(HANDLE_CTX(hdl), "can't open %s: errno %d (%s)", filename, errno,
- strerror(errno));
- (void) close(fdstat);
- return (errno);
- }
- hpriv->eps[ep_index].datafd = fd;
- hpriv->eps[ep_index].statfd = fdstat;
- usbi_dbg(HANDLE_CTX(hdl), "ep=0x%02x datafd=%d, statfd=%d", ep_addr, fd, fdstat);
- return (0);
- }
- int
- sunos_open(struct libusb_device_handle *handle)
- {
- sunos_dev_handle_priv_t *hpriv;
- sunos_dev_priv_t *dpriv;
- int i;
- int ret;
- hpriv = usbi_get_device_handle_priv(handle);
- dpriv = usbi_get_device_priv(handle->dev);
- hpriv->dpriv = dpriv;
- /* set all file descriptors to "closed" */
- for (i = 0; i < USB_MAXENDPOINTS; i++) {
- hpriv->eps[i].datafd = -1;
- hpriv->eps[i].statfd = -1;
- }
- if (sunos_kernel_driver_active(handle, 0)) {
- /* pretend we can open the device */
- return (LIBUSB_SUCCESS);
- }
- if ((ret = sunos_usb_open_ep0(hpriv, dpriv)) != LIBUSB_SUCCESS) {
- usbi_dbg(HANDLE_CTX(handle), "fail: %d", ret);
- return (ret);
- }
- return (LIBUSB_SUCCESS);
- }
- void
- sunos_close(struct libusb_device_handle *handle)
- {
- sunos_dev_handle_priv_t *hpriv;
- usbi_dbg(HANDLE_CTX(handle), " ");
- hpriv = usbi_get_device_handle_priv(handle);
- sunos_usb_close_all_eps(hpriv);
- sunos_usb_close_ep0(hpriv);
- }
- int
- sunos_get_active_config_descriptor(struct libusb_device *dev,
- void *buf, size_t len)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(dev);
- struct libusb_config_descriptor *cfg;
- int proplen;
- di_node_t node;
- uint8_t *rdata;
- /*
- * Keep raw configuration descriptors updated, in case config
- * has ever been changed through setCfg.
- */
- if ((node = di_init(dpriv->phypath, DINFOCPYALL)) == DI_NODE_NIL) {
- usbi_dbg(DEVICE_CTX(dev), "di_int() failed: errno %d (%s)", errno,
- strerror(errno));
- return (LIBUSB_ERROR_IO);
- }
- proplen = di_prop_lookup_bytes(DDI_DEV_T_ANY, node,
- "usb-raw-cfg-descriptors", &rdata);
- if (proplen <= 0) {
- usbi_dbg(DEVICE_CTX(dev), "can't find raw config descriptors");
- return (LIBUSB_ERROR_IO);
- }
- dpriv->raw_cfgdescr = realloc(dpriv->raw_cfgdescr, proplen);
- if (dpriv->raw_cfgdescr == NULL) {
- return (LIBUSB_ERROR_NO_MEM);
- } else {
- bcopy(rdata, dpriv->raw_cfgdescr, proplen);
- dpriv->cfgvalue = ((struct libusb_config_descriptor *)
- rdata)->bConfigurationValue;
- }
- di_fini(node);
- cfg = (struct libusb_config_descriptor *)dpriv->raw_cfgdescr;
- len = MIN(len, libusb_le16_to_cpu(cfg->wTotalLength));
- memcpy(buf, dpriv->raw_cfgdescr, len);
- usbi_dbg(DEVICE_CTX(dev), "path:%s len %zu", dpriv->phypath, len);
- return (len);
- }
- int
- sunos_get_config_descriptor(struct libusb_device *dev, uint8_t idx,
- void *buf, size_t len)
- {
- UNUSED(idx);
- /* XXX */
- return(sunos_get_active_config_descriptor(dev, buf, len));
- }
- int
- sunos_get_configuration(struct libusb_device_handle *handle, uint8_t *config)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(handle->dev);
- *config = dpriv->cfgvalue;
- usbi_dbg(HANDLE_CTX(handle), "bConfigurationValue %u", *config);
- return (LIBUSB_SUCCESS);
- }
- int
- sunos_set_configuration(struct libusb_device_handle *handle, int config)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(handle->dev);
- sunos_dev_handle_priv_t *hpriv;
- usbi_dbg(HANDLE_CTX(handle), "bConfigurationValue %d", config);
- hpriv = usbi_get_device_handle_priv(handle);
- if (dpriv->ugenpath == NULL)
- return (LIBUSB_ERROR_NOT_SUPPORTED);
- if (config < 1)
- return (LIBUSB_ERROR_NOT_SUPPORTED);
- dpriv->cfgvalue = config;
- hpriv->config_index = config - 1;
- return (LIBUSB_SUCCESS);
- }
- int
- sunos_claim_interface(struct libusb_device_handle *handle, uint8_t iface)
- {
- UNUSED(handle);
- usbi_dbg(HANDLE_CTX(handle), "iface %u", iface);
- return (LIBUSB_SUCCESS);
- }
- int
- sunos_release_interface(struct libusb_device_handle *handle, uint8_t iface)
- {
- sunos_dev_handle_priv_t *hpriv = usbi_get_device_handle_priv(handle);
- usbi_dbg(HANDLE_CTX(handle), "iface %u", iface);
- /* XXX: can we release it? */
- hpriv->altsetting[iface] = 0;
- return (LIBUSB_SUCCESS);
- }
- int
- sunos_set_interface_altsetting(struct libusb_device_handle *handle, uint8_t iface,
- uint8_t altsetting)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(handle->dev);
- sunos_dev_handle_priv_t *hpriv = usbi_get_device_handle_priv(handle);
- usbi_dbg(HANDLE_CTX(handle), "iface %u, setting %u", iface, altsetting);
- if (dpriv->ugenpath == NULL)
- return (LIBUSB_ERROR_NOT_FOUND);
- /* XXX: can we switch altsetting? */
- hpriv->altsetting[iface] = altsetting;
- return (LIBUSB_SUCCESS);
- }
- static void
- usb_dump_data(const void *data, size_t size)
- {
- const uint8_t *p = data;
- size_t i;
- if (getenv("LIBUSB_DEBUG") == NULL) {
- return;
- }
- (void) fprintf(stderr, "data dump:");
- for (i = 0; i < size; i++) {
- if (i % 16 == 0) {
- (void) fprintf(stderr, "\n%08zx ", i);
- }
- (void) fprintf(stderr, "%02x ", p[i]);
- }
- (void) fprintf(stderr, "\n");
- }
- static void
- sunos_async_callback(union sigval arg)
- {
- struct sunos_transfer_priv *tpriv =
- (struct sunos_transfer_priv *)arg.sival_ptr;
- struct libusb_transfer *xfer = tpriv->transfer;
- struct aiocb *aiocb = &tpriv->aiocb;
- int ret;
- sunos_dev_handle_priv_t *hpriv;
- uint8_t ep;
- libusb_device_handle *dev_handle;
- dev_handle = xfer->dev_handle;
- /* libusb can forcibly interrupt transfer in do_close() */
- if (dev_handle != NULL) {
- hpriv = usbi_get_device_handle_priv(dev_handle);
- ep = sunos_usb_ep_index(xfer->endpoint);
- ret = aio_error(aiocb);
- if (ret != 0) {
- xfer->status = sunos_usb_get_status(TRANSFER_CTX(xfer), hpriv->eps[ep].statfd);
- } else {
- xfer->actual_length =
- LIBUSB_TRANSFER_TO_USBI_TRANSFER(xfer)->transferred =
- aio_return(aiocb);
- }
- usb_dump_data(xfer->buffer, xfer->actual_length);
- usbi_dbg(TRANSFER_CTX(xfer), "ret=%d, len=%d, actual_len=%d", ret, xfer->length,
- xfer->actual_length);
- /* async notification */
- usbi_signal_transfer_completion(LIBUSB_TRANSFER_TO_USBI_TRANSFER(xfer));
- }
- }
- static int
- sunos_do_async_io(struct libusb_transfer *transfer)
- {
- int ret = -1;
- struct aiocb *aiocb;
- sunos_dev_handle_priv_t *hpriv;
- uint8_t ep;
- struct sunos_transfer_priv *tpriv;
- usbi_dbg(TRANSFER_CTX(transfer), " ");
- tpriv = usbi_get_transfer_priv(LIBUSB_TRANSFER_TO_USBI_TRANSFER(transfer));
- hpriv = usbi_get_device_handle_priv(transfer->dev_handle);
- ep = sunos_usb_ep_index(transfer->endpoint);
- tpriv->transfer = transfer;
- aiocb = &tpriv->aiocb;
- bzero(aiocb, sizeof(*aiocb));
- aiocb->aio_fildes = hpriv->eps[ep].datafd;
- aiocb->aio_buf = transfer->buffer;
- aiocb->aio_nbytes = transfer->length;
- aiocb->aio_lio_opcode =
- ((transfer->endpoint & LIBUSB_ENDPOINT_DIR_MASK) ==
- LIBUSB_ENDPOINT_IN) ? LIO_READ:LIO_WRITE;
- aiocb->aio_sigevent.sigev_notify = SIGEV_THREAD;
- aiocb->aio_sigevent.sigev_value.sival_ptr = tpriv;
- aiocb->aio_sigevent.sigev_notify_function = sunos_async_callback;
- if (aiocb->aio_lio_opcode == LIO_READ) {
- ret = aio_read(aiocb);
- } else {
- ret = aio_write(aiocb);
- }
- return (ret);
- }
- /* return the number of bytes read/written */
- static ssize_t
- usb_do_io(struct libusb_context *ctx, int fd, int stat_fd, void *data, size_t size, int flag, int *status)
- {
- int error;
- ssize_t ret = -1;
- usbi_dbg(ctx, "usb_do_io(): datafd=%d statfd=%d size=0x%zx flag=%s",
- fd, stat_fd, size, flag? "WRITE":"READ");
- switch (flag) {
- case READ:
- errno = 0;
- ret = read(fd, data, size);
- usb_dump_data(data, size);
- break;
- case WRITE:
- usb_dump_data(data, size);
- errno = 0;
- ret = write(fd, data, size);
- break;
- }
- usbi_dbg(ctx, "usb_do_io(): amount=%zd", ret);
- if (ret < 0) {
- int save_errno = errno;
- usbi_dbg(ctx, "TID=%x io %s errno %d (%s)", pthread_self(),
- flag?"WRITE":"READ", errno, strerror(errno));
- /* sunos_usb_get_status will do a read and overwrite errno */
- error = sunos_usb_get_status(ctx, stat_fd);
- usbi_dbg(ctx, "io status=%d errno %d (%s)", error,
- save_errno, strerror(save_errno));
- if (status) {
- *status = save_errno;
- }
- return (save_errno);
- } else if (status) {
- *status = 0;
- }
- return (ret);
- }
- static int
- solaris_submit_ctrl_on_default(struct libusb_transfer *transfer)
- {
- ssize_t ret = -1, setup_ret;
- int status;
- sunos_dev_handle_priv_t *hpriv;
- struct libusb_device_handle *hdl = transfer->dev_handle;
- uint16_t wLength;
- uint8_t *data = transfer->buffer;
- hpriv = usbi_get_device_handle_priv(hdl);
- wLength = transfer->length - LIBUSB_CONTROL_SETUP_SIZE;
- if (hpriv->eps[0].datafd == -1) {
- usbi_dbg(TRANSFER_CTX(transfer), "ep0 not opened");
- return (LIBUSB_ERROR_NOT_FOUND);
- }
- if ((data[0] & LIBUSB_ENDPOINT_DIR_MASK) == LIBUSB_ENDPOINT_IN) {
- usbi_dbg(TRANSFER_CTX(transfer), "IN request");
- ret = usb_do_io(TRANSFER_CTX(transfer), hpriv->eps[0].datafd,
- hpriv->eps[0].statfd, data, LIBUSB_CONTROL_SETUP_SIZE,
- WRITE, &status);
- } else {
- usbi_dbg(TRANSFER_CTX(transfer), "OUT request");
- ret = usb_do_io(TRANSFER_CTX(transfer), hpriv->eps[0].datafd, hpriv->eps[0].statfd,
- transfer->buffer, transfer->length, WRITE,
- (int *)&transfer->status);
- }
- setup_ret = ret;
- if (ret < (ssize_t)LIBUSB_CONTROL_SETUP_SIZE) {
- usbi_dbg(TRANSFER_CTX(transfer), "error sending control msg: %zd", ret);
- return (LIBUSB_ERROR_IO);
- }
- ret = transfer->length - LIBUSB_CONTROL_SETUP_SIZE;
- /* Read the remaining bytes for IN request */
- if ((wLength) && ((data[0] & LIBUSB_ENDPOINT_DIR_MASK) ==
- LIBUSB_ENDPOINT_IN)) {
- usbi_dbg(TRANSFER_CTX(transfer), "DATA: %d", transfer->length - (int)setup_ret);
- ret = usb_do_io(TRANSFER_CTX(transfer), hpriv->eps[0].datafd,
- hpriv->eps[0].statfd,
- transfer->buffer + LIBUSB_CONTROL_SETUP_SIZE,
- wLength, READ, (int *)&transfer->status);
- }
- if (ret >= 0) {
- LIBUSB_TRANSFER_TO_USBI_TRANSFER(transfer)->transferred = ret;
- }
- usbi_dbg(TRANSFER_CTX(transfer), "Done: ctrl data bytes %zd", ret);
- /**
- * Sync transfer handling.
- * We should release transfer lock here and later get it back
- * as usbi_handle_transfer_completion() takes its own transfer lock.
- */
- usbi_mutex_unlock(&LIBUSB_TRANSFER_TO_USBI_TRANSFER(transfer)->lock);
- ret = usbi_handle_transfer_completion(LIBUSB_TRANSFER_TO_USBI_TRANSFER(transfer),
- transfer->status);
- usbi_mutex_lock(&LIBUSB_TRANSFER_TO_USBI_TRANSFER(transfer)->lock);
- return (ret);
- }
- int
- sunos_clear_halt(struct libusb_device_handle *handle, unsigned char endpoint)
- {
- int ret;
- usbi_dbg(HANDLE_CTX(handle), "endpoint=0x%02x", endpoint);
- ret = libusb_control_transfer(handle, LIBUSB_ENDPOINT_OUT |
- LIBUSB_RECIPIENT_ENDPOINT | LIBUSB_REQUEST_TYPE_STANDARD,
- LIBUSB_REQUEST_CLEAR_FEATURE, 0, endpoint, NULL, 0, 1000);
- usbi_dbg(HANDLE_CTX(handle), "ret=%d", ret);
- return (ret);
- }
- void
- sunos_destroy_device(struct libusb_device *dev)
- {
- sunos_dev_priv_t *dpriv = usbi_get_device_priv(dev);
- usbi_dbg(DEVICE_CTX(dev), "destroy everything");
- free(dpriv->raw_cfgdescr);
- free(dpriv->ugenpath);
- free(dpriv->phypath);
- }
- int
- sunos_submit_transfer(struct usbi_transfer *itransfer)
- {
- struct libusb_transfer *transfer;
- struct libusb_device_handle *hdl;
- int err = 0;
- transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
- hdl = transfer->dev_handle;
- err = sunos_check_device_and_status_open(hdl,
- transfer->endpoint, transfer->type);
- if (err < 0) {
- return (_errno_to_libusb(err));
- }
- switch (transfer->type) {
- case LIBUSB_TRANSFER_TYPE_CONTROL:
- /* sync transfer */
- usbi_dbg(ITRANSFER_CTX(itransfer), "CTRL transfer: %d", transfer->length);
- err = solaris_submit_ctrl_on_default(transfer);
- break;
- case LIBUSB_TRANSFER_TYPE_BULK:
- /* fallthru */
- case LIBUSB_TRANSFER_TYPE_INTERRUPT:
- if (transfer->type == LIBUSB_TRANSFER_TYPE_BULK)
- usbi_dbg(ITRANSFER_CTX(itransfer), "BULK transfer: %d", transfer->length);
- else
- usbi_dbg(ITRANSFER_CTX(itransfer), "INTR transfer: %d", transfer->length);
- err = sunos_do_async_io(transfer);
- break;
- case LIBUSB_TRANSFER_TYPE_ISOCHRONOUS:
- /* Isochronous/Stream is not supported */
- /* fallthru */
- case LIBUSB_TRANSFER_TYPE_BULK_STREAM:
- if (transfer->type == LIBUSB_TRANSFER_TYPE_ISOCHRONOUS)
- usbi_dbg(ITRANSFER_CTX(itransfer), "ISOC transfer: %d", transfer->length);
- else
- usbi_dbg(ITRANSFER_CTX(itransfer), "BULK STREAM transfer: %d", transfer->length);
- err = LIBUSB_ERROR_NOT_SUPPORTED;
- break;
- }
- return (err);
- }
- int
- sunos_cancel_transfer(struct usbi_transfer *itransfer)
- {
- sunos_xfer_priv_t *tpriv;
- sunos_dev_handle_priv_t *hpriv;
- struct libusb_transfer *transfer;
- struct aiocb *aiocb;
- uint8_t ep;
- int ret;
- tpriv = usbi_get_transfer_priv(itransfer);
- aiocb = &tpriv->aiocb;
- transfer = USBI_TRANSFER_TO_LIBUSB_TRANSFER(itransfer);
- hpriv = usbi_get_device_handle_priv(transfer->dev_handle);
- ep = sunos_usb_ep_index(transfer->endpoint);
- ret = aio_cancel(hpriv->eps[ep].datafd, aiocb);
- usbi_dbg(ITRANSFER_CTX(itransfer), "aio->fd=%d fd=%d ret = %d, %s", aiocb->aio_fildes,
- hpriv->eps[ep].datafd, ret, (ret == AIO_CANCELED)?
- strerror(0):strerror(errno));
- if (ret != AIO_CANCELED) {
- ret = _errno_to_libusb(errno);
- } else {
- /*
- * we don't need to call usbi_handle_transfer_cancellation(),
- * because we'll handle everything in sunos_async_callback.
- */
- ret = LIBUSB_SUCCESS;
- }
- return (ret);
- }
- int
- sunos_handle_transfer_completion(struct usbi_transfer *itransfer)
- {
- return usbi_handle_transfer_completion(itransfer, LIBUSB_TRANSFER_COMPLETED);
- }
- int
- _errno_to_libusb(int err)
- {
- usbi_dbg(NULL, "error: %s (%d)", strerror(err), err);
- switch (err) {
- case EIO:
- return (LIBUSB_ERROR_IO);
- case EACCES:
- return (LIBUSB_ERROR_ACCESS);
- case ENOENT:
- return (LIBUSB_ERROR_NO_DEVICE);
- case ENOMEM:
- return (LIBUSB_ERROR_NO_MEM);
- case ETIMEDOUT:
- return (LIBUSB_ERROR_TIMEOUT);
- }
- return (LIBUSB_ERROR_OTHER);
- }
- /*
- * sunos_usb_get_status:
- * gets status of endpoint
- *
- * Returns: ugen's last cmd status
- */
- static int
- sunos_usb_get_status(struct libusb_context *ctx, int fd)
- {
- int status;
- ssize_t ret;
- usbi_dbg(ctx, "sunos_usb_get_status(): fd=%d", fd);
- ret = read(fd, &status, sizeof(status));
- if (ret == sizeof(status)) {
- switch (status) {
- case USB_LC_STAT_NOERROR:
- usbi_dbg(ctx, "No Error");
- break;
- case USB_LC_STAT_CRC:
- usbi_dbg(ctx, "CRC Timeout Detected\n");
- break;
- case USB_LC_STAT_BITSTUFFING:
- usbi_dbg(ctx, "Bit Stuffing Violation\n");
- break;
- case USB_LC_STAT_DATA_TOGGLE_MM:
- usbi_dbg(ctx, "Data Toggle Mismatch\n");
- break;
- case USB_LC_STAT_STALL:
- usbi_dbg(ctx, "End Point Stalled\n");
- break;
- case USB_LC_STAT_DEV_NOT_RESP:
- usbi_dbg(ctx, "Device is Not Responding\n");
- break;
- case USB_LC_STAT_PID_CHECKFAILURE:
- usbi_dbg(ctx, "PID Check Failure\n");
- break;
- case USB_LC_STAT_UNEXP_PID:
- usbi_dbg(ctx, "Unexpected PID\n");
- break;
- case USB_LC_STAT_DATA_OVERRUN:
- usbi_dbg(ctx, "Data Exceeded Size\n");
- break;
- case USB_LC_STAT_DATA_UNDERRUN:
- usbi_dbg(ctx, "Less data received\n");
- break;
- case USB_LC_STAT_BUFFER_OVERRUN:
- usbi_dbg(ctx, "Buffer Size Exceeded\n");
- break;
- case USB_LC_STAT_BUFFER_UNDERRUN:
- usbi_dbg(ctx, "Buffer Underrun\n");
- break;
- case USB_LC_STAT_TIMEOUT:
- usbi_dbg(ctx, "Command Timed Out\n");
- break;
- case USB_LC_STAT_NOT_ACCESSED:
- usbi_dbg(ctx, "Not Accessed by h/w\n");
- break;
- case USB_LC_STAT_UNSPECIFIED_ERR:
- usbi_dbg(ctx, "Unspecified Error\n");
- break;
- case USB_LC_STAT_NO_BANDWIDTH:
- usbi_dbg(ctx, "No Bandwidth\n");
- break;
- case USB_LC_STAT_HW_ERR:
- usbi_dbg(ctx, "Host Controller h/w Error\n");
- break;
- case USB_LC_STAT_SUSPENDED:
- usbi_dbg(ctx, "Device was Suspended\n");
- break;
- case USB_LC_STAT_DISCONNECTED:
- usbi_dbg(ctx, "Device was Disconnected\n");
- break;
- case USB_LC_STAT_INTR_BUF_FULL:
- usbi_dbg(ctx, "Interrupt buffer was full\n");
- break;
- case USB_LC_STAT_INVALID_REQ:
- usbi_dbg(ctx, "Request was Invalid\n");
- break;
- case USB_LC_STAT_INTERRUPTED:
- usbi_dbg(ctx, "Request was Interrupted\n");
- break;
- case USB_LC_STAT_NO_RESOURCES:
- usbi_dbg(ctx, "No resources available for "
- "request\n");
- break;
- case USB_LC_STAT_INTR_POLLING_FAILED:
- usbi_dbg(ctx, "Failed to Restart Poll");
- break;
- default:
- usbi_dbg(ctx, "Error Not Determined %d\n",
- status);
- break;
- }
- } else {
- usbi_dbg(ctx, "read stat error: %s",strerror(errno));
- status = -1;
- }
- return (status);
- }
- const struct usbi_os_backend usbi_backend = {
- .name = "Solaris",
- .caps = 0,
- .get_device_list = sunos_get_device_list,
- .get_active_config_descriptor = sunos_get_active_config_descriptor,
- .get_config_descriptor = sunos_get_config_descriptor,
- .open = sunos_open,
- .close = sunos_close,
- .get_configuration = sunos_get_configuration,
- .set_configuration = sunos_set_configuration,
- .claim_interface = sunos_claim_interface,
- .release_interface = sunos_release_interface,
- .set_interface_altsetting = sunos_set_interface_altsetting,
- .clear_halt = sunos_clear_halt,
- .kernel_driver_active = sunos_kernel_driver_active,
- .detach_kernel_driver = sunos_detach_kernel_driver,
- .attach_kernel_driver = sunos_attach_kernel_driver,
- .destroy_device = sunos_destroy_device,
- .submit_transfer = sunos_submit_transfer,
- .cancel_transfer = sunos_cancel_transfer,
- .handle_transfer_completion = sunos_handle_transfer_completion,
- .device_priv_size = sizeof(sunos_dev_priv_t),
- .device_handle_priv_size = sizeof(sunos_dev_handle_priv_t),
- .transfer_priv_size = sizeof(sunos_xfer_priv_t),
- };
|