port_status.h

/*
 * Copyright (c) 2010 Matus Dekanek
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
#ifndef HUB_PORT_STATUS_H
#define HUB_PORT_STATUS_H

#include <bool.h>
#include <sys/types.h>
#include <usb/dev/request.h>
#include "usbhub_private.h"

typedef uint32_t usb_port_status_t;

typedef uint32_t usb_hub_status_t;

static inline void usb_hub_set_port_status_request(
    usb_device_request_setup_packet_t *request, uint16_t port) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_GET_PORT_STATUS;
        request->request = USB_HUB_REQUEST_GET_STATUS;
        request->value = 0;
        request->length = 4;
}

static inline void usb_hub_set_hub_status_request(
    usb_device_request_setup_packet_t *request) {
        request->index = 0;
        request->request_type = USB_HUB_REQ_TYPE_GET_HUB_STATUS;
        request->request = USB_HUB_REQUEST_GET_STATUS;
        request->value = 0;
        request->length = 4;
}

static inline usb_device_request_setup_packet_t *
usb_hub_create_port_status_request(uint16_t port) {
        usb_device_request_setup_packet_t *result =
            malloc(sizeof (usb_device_request_setup_packet_t));
        usb_hub_set_port_status_request(result, port);
        return result;
}

static inline void usb_hub_set_enable_port_feature_request(
    usb_device_request_setup_packet_t *request, uint16_t port,
    uint16_t feature_selector) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_SET_FEATURE;
        request->value = feature_selector;
        request->length = 0;
}

static inline void usb_hub_set_disable_port_feature_request(
    usb_device_request_setup_packet_t *request, uint16_t port,
    uint16_t feature_selector
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_CLEAR_FEATURE;
        request->value = feature_selector;
        request->length = 0;
}

static inline void usb_hub_set_enable_port_request(
    usb_device_request_setup_packet_t *request, uint16_t port
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_SET_FEATURE;
        request->value = USB_HUB_FEATURE_C_PORT_ENABLE;
        request->length = 0;
}

static inline usb_device_request_setup_packet_t *
usb_hub_create_enable_port_request(uint16_t port) {
        usb_device_request_setup_packet_t *result =
            malloc(sizeof (usb_device_request_setup_packet_t));
        usb_hub_set_enable_port_request(result, port);
        return result;
}

static inline void usb_hub_set_disable_port_request(
    usb_device_request_setup_packet_t *request, uint16_t port
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_SET_FEATURE;
        request->value = USB_HUB_FEATURE_C_PORT_SUSPEND;
        request->length = 0;
}

static inline usb_device_request_setup_packet_t *
usb_hub_create_disable_port_request(uint16_t port) {
        usb_device_request_setup_packet_t *result =
            malloc(sizeof (usb_device_request_setup_packet_t));
        usb_hub_set_disable_port_request(result, port);
        return result;
}

static inline void usb_hub_set_reset_port_request(
    usb_device_request_setup_packet_t *request, uint16_t port
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_SET_FEATURE;
        request->value = USB_HUB_FEATURE_PORT_RESET;
        request->length = 0;
}

static inline usb_device_request_setup_packet_t *
usb_hub_create_reset_port_request(uint16_t port) {
        usb_device_request_setup_packet_t *result =
            malloc(sizeof (usb_device_request_setup_packet_t));
        usb_hub_set_reset_port_request(result, port);
        return result;
}

static inline void usb_hub_set_power_port_request(
    usb_device_request_setup_packet_t *request, uint16_t port
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_SET_FEATURE;
        request->value = USB_HUB_FEATURE_PORT_POWER;
        request->length = 0;
}

static inline void usb_hub_unset_power_port_request(
    usb_device_request_setup_packet_t *request, uint16_t port
    ) {
        request->index = port;
        request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE;
        request->request = USB_HUB_REQUEST_CLEAR_FEATURE;
        request->value = USB_HUB_FEATURE_PORT_POWER;
        request->length = 0;
}

static inline bool usb_port_is_status(usb_port_status_t status, int idx) {
        return (status & (1 << idx)) != 0;
}

static inline void usb_port_status_set_bit(
    usb_port_status_t * status, int idx, bool value) {
        (*status) = value ?
            ((*status) | (1 << (idx))) :
            ((*status)&(~(1 << (idx))));
}

static inline bool usb_hub_is_status(usb_hub_status_t status, int idx) {
        return (status & (1 << idx)) != 0;
}

static inline void usb_hub_status_set_bit(
    usb_hub_status_t *status, int idx, bool value) {
        (*status) = value ?
            ((*status) | (1 << (idx))) :
            ((*status)&(~(1 << (idx))));
}

static inline bool usb_port_low_speed(usb_port_status_t status) {
        return usb_port_is_status(status, 9);
}

static inline void usb_port_set_low_speed(usb_port_status_t *status, bool low_speed) {
        usb_port_status_set_bit(status, 9, low_speed);
}

//high speed device attached

static inline bool usb_port_high_speed(usb_port_status_t status) {
        return usb_port_is_status(status, 10);
}

static inline void usb_port_set_high_speed(usb_port_status_t *status, bool high_speed) {
        usb_port_status_set_bit(status, 10, high_speed);
}

static inline usb_speed_t usb_port_speed(usb_port_status_t status) {
        if (usb_port_low_speed(status))
                return USB_SPEED_LOW;
        if (usb_port_high_speed(status))
                return USB_SPEED_HIGH;
        return USB_SPEED_FULL;
}



#endif  /* HUB_PORT_STATUS_H */

---