messenger-libusb.cpp

Go to the documentation of this file.

// License: Apache 2.0. See LICENSE file in root directory.
// Copyright(c) 2015 Intel Corporation. All Rights Reserved.

#include "messenger-libusb.h"
#include "device-libusb.h"
#include "handle-libusb.h"
namespace librealsense
{
    namespace platform
    {
        usb_messenger_libusb::usb_messenger_libusb(const std::shared_ptr<usb_device_libusb>& device,
                                                   std::shared_ptr<handle_libusb> handle)
                : _device(device), _handle(handle)
        {

        }

        usb_messenger_libusb::~usb_messenger_libusb()
        {

        }

        usb_status usb_messenger_libusb::reset_endpoint(const rs_usb_endpoint& endpoint, uint32_t timeout_ms)
        {
            int ep = endpoint->get_address();               
            auto sts = libusb_clear_halt(_handle->get(), ep);
            if(sts < 0)
            {
                std::string strerr = strerror(errno);
                LOG_WARNING("reset_endpoint returned error, index: " << ep << ", error: " << strerr << ", number: " << int(errno));
                return libusb_status_to_rs(sts);
            }
            return RS2_USB_STATUS_SUCCESS;
        }

        usb_status usb_messenger_libusb::control_transfer(int request_type, int request, int value, int index, uint8_t* buffer, uint32_t length, uint32_t& transferred, uint32_t timeout_ms)
        {
            auto sts = libusb_control_transfer(_handle->get(), request_type, request, value, index, buffer, length, timeout_ms);
            if(sts < 0)
            {
                std::string strerr = strerror(errno);
                LOG_WARNING("control_transfer returned error, index: " << index << ", error: " << strerr << ", number: " << int(errno));
                return libusb_status_to_rs(sts);
            }
            transferred = uint32_t(sts);
            return RS2_USB_STATUS_SUCCESS;
        }

        usb_status usb_messenger_libusb::bulk_transfer(const std::shared_ptr<usb_endpoint>&  endpoint, uint8_t* buffer, uint32_t length, uint32_t& transferred, uint32_t timeout_ms)
        {
            int actual_length = 0;
            int sts;
            if (endpoint->get_type() == RS2_USB_ENDPOINT_BULK)
                sts = libusb_bulk_transfer(_handle->get(), endpoint->get_address(), buffer, length, &actual_length, timeout_ms);
            else if (endpoint->get_type() == RS2_USB_ENDPOINT_INTERRUPT)
                sts = libusb_interrupt_transfer(_handle->get(), endpoint->get_address(), buffer, length, &actual_length, timeout_ms);
            else {
                LOG_ERROR("Invalid transfer type " << endpoint->get_type() << " on endpoint " << endpoint->get_address());
                return RS2_USB_STATUS_OTHER;
            }

            if(sts < 0)
            {
                std::string strerr = strerror(errno);
                LOG_WARNING("bulk_transfer returned error, endpoint: 0x" << std::hex << int(endpoint->get_address()) << std::dec
                    << ", error: " << strerr << ", err. num: " << int(errno));
                return libusb_status_to_rs(sts);
            }
            transferred = actual_length;
            return RS2_USB_STATUS_SUCCESS;
        }

        rs_usb_request usb_messenger_libusb::create_request(rs_usb_endpoint endpoint)
        {
            auto rv = std::make_shared<usb_request_libusb>(_handle->get(), endpoint);
            rv->set_shared(rv);
            return rv;
        }

        usb_status usb_messenger_libusb::submit_request(const rs_usb_request& request)
        {
            auto nr = reinterpret_cast<libusb_transfer*>(request->get_native_request());
            if(nr->dev_handle == nullptr)
                return RS2_USB_STATUS_INVALID_PARAM;
            auto req = std::dynamic_pointer_cast<usb_request_libusb>(request);
            req->set_active(true);
            auto sts = libusb_submit_transfer(nr);
            if (sts < 0)
            {
                req->set_active(false);
                std::string strerr = strerror(errno);
                LOG_WARNING("usb_request_queue returned error, endpoint: " << (int)request->get_endpoint()->get_address() << " error: " << strerr << ", number: " << (int)errno);
                return libusb_status_to_rs(errno);
            }
            return RS2_USB_STATUS_SUCCESS;
        }

        usb_status usb_messenger_libusb::cancel_request(const rs_usb_request& request)
        {
            auto nr = reinterpret_cast<libusb_transfer*>(request->get_native_request());
            auto sts = libusb_cancel_transfer(nr);
            if (sts < 0 && sts != LIBUSB_ERROR_NOT_FOUND)
            {
                std::string strerr = strerror(errno);
                LOG_WARNING("usb_request_cancel returned error, endpoint: " << (int)request->get_endpoint()->get_address() << " error: " << strerr << ", number: " << (int)errno);
                return libusb_status_to_rs(errno);
            }
            return RS2_USB_STATUS_SUCCESS;
        }
    }
}