Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/lib/usbdev/src/hub.c

    r7711296 rfb422312  
    6666 *
    6767 * @param connection Opened connection to host controller.
    68  * @param preferred Preferred SUB address.
    69  * @param strict Fail if the preferred address is not avialable.
    7068 * @param speed Speed of the new device (device that will be assigned
    7169 *    the returned address).
     
    7371 */
    7472usb_address_t usb_hc_request_address(usb_hc_connection_t *connection,
    75     usb_address_t preferred, bool strict, usb_speed_t speed)
     73    usb_speed_t speed)
    7674{
    7775        CHECK_CONNECTION(connection);
    78 
     76       
    7977        async_exch_t *exch = async_exchange_begin(connection->hc_sess);
    80         if (!exch)
    81                 return (usb_address_t)ENOMEM;
    82 
    83         usb_address_t address = preferred;
    84         const int ret = usbhc_request_address(exch, &address, strict, speed);
    85 
     78       
     79        sysarg_t address;
     80        int rc = async_req_2_1(exch, DEV_IFACE_ID(USBHC_DEV_IFACE),
     81            IPC_M_USBHC_REQUEST_ADDRESS, speed,
     82            &address);
     83       
    8684        async_exchange_end(exch);
    87         return ret == EOK ? address : ret;
     85       
     86        if (rc != EOK)
     87                return (usb_address_t) rc;
     88       
     89        return (usb_address_t) address;
    8890}
    8991
     
    9496 * @return Error code.
    9597 */
    96 int usb_hc_register_device(usb_hc_connection_t *connection,
     98int usb_hc_register_device(usb_hc_connection_t * connection,
    9799    const usb_hub_attached_device_t *attached_device)
    98100{
    99101        CHECK_CONNECTION(connection);
    100         if (attached_device == NULL || attached_device->fun == NULL)
    101                 return EINVAL;
    102 
     102       
     103        if (attached_device == NULL)
     104                return EBADMEM;
     105       
    103106        async_exch_t *exch = async_exchange_begin(connection->hc_sess);
    104         if (!exch)
    105                 return ENOMEM;
    106         const int ret = usbhc_bind_address(exch,
     107        int rc = async_req_3_0(exch, DEV_IFACE_ID(USBHC_DEV_IFACE),
     108            IPC_M_USBHC_BIND_ADDRESS,
    107109            attached_device->address, attached_device->fun->handle);
    108110        async_exchange_end(exch);
    109 
    110         return ret;
     111       
     112        return rc;
    111113}
    112114
     
    121123{
    122124        CHECK_CONNECTION(connection);
    123 
     125       
    124126        async_exch_t *exch = async_exchange_begin(connection->hc_sess);
    125         if (!exch)
    126                 return ENOMEM;
    127         const int ret = usbhc_release_address(exch, address);
     127        int rc = async_req_2_0(exch, DEV_IFACE_ID(USBHC_DEV_IFACE),
     128            IPC_M_USBHC_RELEASE_ADDRESS, address);
    128129        async_exchange_end(exch);
    129 
    130         return ret;
    131 }
    132 
    133 /** Change address of connected device.
    134  * This function automatically updates the backing connection to point to
    135  * the new address. It also unregisterrs the old endpoint and registers
    136  * a new one.
    137  * This creates whole bunch of problems:
    138  *  1. All pipes using this wire are broken because they are not
    139  *     registered for new address
    140  *  2. All other pipes for this device are using wrong address,
    141  *     possibly targeting completely different device
    142  *
    143  * @param pipe Control endpoint pipe (session must be already started).
    144  * @param new_address New USB address to be set (in native endianness).
    145  * @return Error code.
    146  */
    147 static int usb_request_set_address(usb_pipe_t *pipe, usb_address_t new_address,
    148     usb_hc_connection_t *hc_conn)
    149 {
    150         if ((new_address < 0) || (new_address >= USB11_ADDRESS_MAX)) {
    151                 return EINVAL;
    152         }
    153         assert(pipe);
    154         assert(hc_conn);
    155         assert(pipe->wire != NULL);
    156 
    157         const uint16_t addr = uint16_host2usb((uint16_t)new_address);
    158 
    159         int rc = usb_control_request_set(pipe,
    160             USB_REQUEST_TYPE_STANDARD, USB_REQUEST_RECIPIENT_DEVICE,
    161             USB_DEVREQ_SET_ADDRESS, addr, 0, NULL, 0);
    162 
    163         if (rc != EOK) {
    164                 return rc;
    165         }
    166 
    167         /* TODO: prevent others from accessing the wire now. */
    168         if (usb_pipe_unregister(pipe, hc_conn) != EOK) {
    169                 usb_log_warning(
    170                     "Failed to unregister the old pipe on address change.\n");
    171         }
    172         /* The address is already changed so set it in the wire */
    173         pipe->wire->address = new_address;
    174         rc = usb_pipe_register(pipe, 0, hc_conn);
    175         if (rc != EOK)
    176                 return EADDRNOTAVAIL;
    177 
    178         return EOK;
     130       
     131        return rc;
     132}
     133
     134
     135static void unregister_control_endpoint_on_default_address(
     136    usb_hc_connection_t *connection)
     137{
     138        usb_device_connection_t dev_conn;
     139        int rc = usb_device_connection_initialize_on_default_address(&dev_conn,
     140            connection);
     141        if (rc != EOK) {
     142                return;
     143        }
     144
     145        usb_pipe_t ctrl_pipe;
     146        rc = usb_pipe_initialize_default_control(&ctrl_pipe, &dev_conn);
     147        if (rc != EOK) {
     148                return;
     149        }
     150
     151        usb_pipe_unregister(&ctrl_pipe, connection);
    179152}
    180153
     
    198171 *
    199172 * @param[in] parent Parent device (i.e. the hub device).
    200  * @param[in] connection Connection to host controller. Must be non-null.
     173 * @param[in] connection Connection to host controller.
    201174 * @param[in] dev_speed New device speed.
    202175 * @param[in] enable_port Function for enabling signaling through the port the
     
    204177 * @param[in] arg Any data argument to @p enable_port.
    205178 * @param[out] assigned_address USB address of the device.
    206  * @param[in] dev_ops Child device ops. Will use default if not provided.
     179 * @param[in] dev_ops Child device ops.
    207180 * @param[in] new_dev_data Arbitrary pointer to be stored in the child
    208  *      as @c driver_data. Will allocate and assign usb_hub_attached_device_t
    209  *      structure if NULL.
     181 *      as @c driver_data.
    210182 * @param[out] new_fun Storage where pointer to allocated child function
    211  *      will be written. Must be non-null.
     183 *      will be written.
    212184 * @return Error code.
    213  * @retval EINVAL Either connection or new_fun is a NULL pointer.
    214185 * @retval ENOENT Connection to HC not opened.
    215186 * @retval EADDRNOTAVAIL Failed retrieving free address from host controller.
     
    219190 *      request or requests for descriptors when creating match ids).
    220191 */
    221 int usb_hc_new_device_wrapper(ddf_dev_t *parent,
    222     usb_hc_connection_t *connection, usb_speed_t dev_speed,
     192int usb_hc_new_device_wrapper(ddf_dev_t *parent, usb_hc_connection_t *connection,
     193    usb_speed_t dev_speed,
    223194    int (*enable_port)(void *arg), void *arg, usb_address_t *assigned_address,
    224195    ddf_dev_ops_t *dev_ops, void *new_dev_data, ddf_fun_t **new_fun)
    225196{
    226         if (new_fun == NULL || connection == NULL)
    227                 return EINVAL;
    228 
    229         // TODO: Why not use provided connection?
    230         usb_hc_connection_t hc_conn;
    231         usb_hc_connection_initialize(&hc_conn, connection->hc_handle);
     197        assert(connection != NULL);
     198        // FIXME: this is awful, we are accessing directly the structure.
     199        usb_hc_connection_t hc_conn = {
     200                .hc_handle = connection->hc_handle,
     201                .hc_sess = NULL
     202        };
    232203
    233204        int rc;
     
    244215        }
    245216
     217
    246218        /*
    247219         * Request new address.
    248220         */
    249         usb_address_t dev_addr =
    250             usb_hc_request_address(&hc_conn, 0, false, dev_speed);
     221        usb_address_t dev_addr = usb_hc_request_address(&hc_conn, dev_speed);
    251222        if (dev_addr < 0) {
    252223                rc = EADDRNOTAVAIL;
     
    269240
    270241        usb_pipe_t ctrl_pipe;
    271         rc = usb_pipe_initialize_default_control(&ctrl_pipe, &dev_conn);
     242        rc = usb_pipe_initialize_default_control(&ctrl_pipe,
     243            &dev_conn);
    272244        if (rc != EOK) {
    273245                rc = ENOTCONN;
     
    276248
    277249        do {
    278                 rc = usb_hc_request_address(&hc_conn, USB_ADDRESS_DEFAULT,
    279                     true, dev_speed);
    280                 if (rc == ENOENT) {
     250                rc = usb_pipe_register_with_speed(&ctrl_pipe, dev_speed, 0,
     251                    &hc_conn);
     252                if (rc != EOK) {
    281253                        /* Do not overheat the CPU ;-). */
    282254                        async_usleep(ENDPOINT_0_0_REGISTER_ATTEMPT_DELAY_USEC);
    283255                }
    284         } while (rc == ENOENT);
    285         if (rc < 0) {
    286                 goto leave_release_free_address;
    287         }
    288 
    289         /* Register control pipe on default address. */
    290         rc = usb_pipe_register(&ctrl_pipe, 0, &hc_conn);
    291         if (rc != EOK) {
    292                 rc = ENOTCONN;
    293                 goto leave_release_default_address;
    294         }
    295 
     256        } while (rc != EOK);
    296257        struct timeval end_time;
    297258
     
    306267         * above might use much of this time so we should only wait to fill
    307268         * up the 100ms quota*/
    308         const suseconds_t elapsed = tv_sub(&end_time, &start_time);
     269        suseconds_t elapsed = tv_sub(&end_time, &start_time);
    309270        if (elapsed < 100000) {
    310271                async_usleep(100000 - elapsed);
    311272        }
    312273
    313         /* Endpoint is registered. We can enable the port and change address. */
     274        /*
     275         * Endpoint is registered. We can enable the port and change
     276         * device address.
     277         */
    314278        rc = enable_port(arg);
    315279        if (rc != EOK) {
     
    323287        async_usleep(10000);
    324288
    325         /* Get max_packet_size value. */
    326289        rc = usb_pipe_probe_default_control(&ctrl_pipe);
    327290        if (rc != EOK) {
     
    330293        }
    331294
    332         rc = usb_request_set_address(&ctrl_pipe, dev_addr, &hc_conn);
     295        rc = usb_request_set_address(&ctrl_pipe, dev_addr);
    333296        if (rc != EOK) {
    334297                rc = ESTALL;
     
    336299        }
    337300
    338         /* Address changed. We can release the default, thus
    339          * allowing other to access the default address. */
    340         usb_hc_unregister_device(&hc_conn, USB_ADDRESS_DEFAULT);
    341 
    342         /* Register the device with devman. */
     301        /*
     302         * Address changed. We can release the original endpoint, thus
     303         * allowing other to access the default address.
     304         */
     305        unregister_control_endpoint_on_default_address(&hc_conn);
     306
     307        /*
     308         * Time to register the new endpoint.
     309         */
     310        rc = usb_pipe_register(&ctrl_pipe, 0, &hc_conn);
     311        if (rc != EOK) {
     312                goto leave_release_free_address;
     313        }
     314
     315        /*
     316         * It is time to register the device with devman.
     317         */
    343318        /* FIXME: create device_register that will get opened ctrl pipe. */
    344319        ddf_fun_t *child_fun;
    345         rc = usb_device_register_child_in_devman(&ctrl_pipe,
     320        rc = usb_device_register_child_in_devman(dev_addr, dev_conn.hc_handle,
    346321            parent, dev_ops, new_dev_data, &child_fun);
    347322        if (rc != EOK) {
    348                 goto leave_release_free_address;
    349         }
    350 
    351         const usb_hub_attached_device_t new_device = {
     323                rc = ESTALL;
     324                goto leave_release_free_address;
     325        }
     326
     327        /*
     328         * And now inform the host controller about the handle.
     329         */
     330        usb_hub_attached_device_t new_device = {
    352331                .address = dev_addr,
    353332                .fun = child_fun,
    354333        };
    355 
    356 
    357         /* Inform the host controller about the handle. */
    358334        rc = usb_hc_register_device(&hc_conn, &new_device);
    359335        if (rc != EOK) {
    360                 /* We know nothing about that data. */
    361                 if (new_dev_data)
    362                         child_fun->driver_data = NULL;
    363                 /* The child function is already created. */
    364                 ddf_fun_destroy(child_fun);
    365336                rc = EDESTADDRREQ;
    366337                goto leave_release_free_address;
    367338        }
    368339
     340
     341        /*
     342         * And we are done.
     343         */
    369344        if (assigned_address != NULL) {
    370345                *assigned_address = dev_addr;
    371346        }
    372 
    373         *new_fun = child_fun;
     347        if (new_fun != NULL) {
     348                *new_fun = child_fun;
     349        }
    374350
    375351        rc = EOK;
     
    381357         */
    382358leave_release_default_address:
    383         usb_hc_unregister_device(&hc_conn, USB_ADDRESS_DEFAULT);
     359        usb_pipe_unregister(&ctrl_pipe, &hc_conn);
    384360
    385361leave_release_free_address:
    386         /* This might be either 0:0 or dev_addr:0 */
    387         if (usb_pipe_unregister(&ctrl_pipe, &hc_conn) != EOK)
    388                 usb_log_warning("%s: Failed to unregister default pipe.\n",
    389                     __FUNCTION__);
    390 
    391         if (usb_hc_unregister_device(&hc_conn, dev_addr) != EOK)
    392                 usb_log_warning("%s: Failed to unregister device.\n",
    393                     __FUNCTION__);
     362        usb_hc_unregister_device(&hc_conn, dev_addr);
    394363
    395364close_connection:
    396365        if (usb_hc_connection_close(&hc_conn) != EOK)
    397                 usb_log_warning("%s: Failed to close hc connection.\n",
    398                     __FUNCTION__);
     366                usb_log_warning("usb_hc_new_device_wrapper(): Failed to close "
     367                    "connection.\n");
    399368
    400369        return rc;
Note: See TracChangeset for help on using the changeset viewer.