summaryrefslogtreecommitdiffhomepage
path: root/video-ps3eye/PS3EYEDriver/urb.cpp
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2019-06-21 13:40:39 +0200
committerStanislaw Halik <sthalik@misaki.pl>2019-06-21 13:40:39 +0200
commit68a9ac0475aaf87db2b40940ae4ed88a67610d8e (patch)
tree0223d214fd2a72ea823bd2e5916c4413176bbedc /video-ps3eye/PS3EYEDriver/urb.cpp
parent1896548fce4f4dd45155b65c2affa6596f6a993e (diff)
video/ps3eye: kill wrong ps3eyedriver fork
Diffstat (limited to 'video-ps3eye/PS3EYEDriver/urb.cpp')
-rw-r--r--video-ps3eye/PS3EYEDriver/urb.cpp307
1 files changed, 0 insertions, 307 deletions
diff --git a/video-ps3eye/PS3EYEDriver/urb.cpp b/video-ps3eye/PS3EYEDriver/urb.cpp
deleted file mode 100644
index 7e931490..00000000
--- a/video-ps3eye/PS3EYEDriver/urb.cpp
+++ /dev/null
@@ -1,307 +0,0 @@
-#include "urb.hpp"
-#include "singleton.hpp"
-#include "frame-queue.hpp"
-#include "internal.hpp"
-
-#include <algorithm>
-#include <cstring>
-
-/* Values for bmHeaderInfo (Video and Still Image Payload Headers, 2.4.3.3) */
-enum {
- UVC_STREAM_EOH = (1 << 7),
- UVC_STREAM_ERR = (1 << 6),
- UVC_STREAM_STI = (1 << 5),
- UVC_STREAM_RES = (1 << 4),
- UVC_STREAM_SCR = (1 << 3),
- UVC_STREAM_PTS = (1 << 2),
- UVC_STREAM_EOF = (1 << 1),
- UVC_STREAM_FID = (1 << 0),
-};
-
-void USB_CALLBACK URBDesc::transfer_completed_callback(struct libusb_transfer *xfr)
-{
- URBDesc *urb = reinterpret_cast<URBDesc*>(xfr->user_data);
- enum libusb_transfer_status status = xfr->status;
-
- switch (status)
- {
- case LIBUSB_TRANSFER_TIMED_OUT:
- urb->frame_add(URBDesc::DISCARD_PACKET, nullptr, 0);
- break;
- case LIBUSB_TRANSFER_COMPLETED:
- urb->pkt_scan(xfr->buffer, xfr->actual_length);
- if (int error = libusb_submit_transfer(xfr); error < 0) {
- debug("libusb_submit_transfer(%d), exiting\n", error);
- urb->close_transfers();
- }
- break;
- default:
- debug("transfer 0x%p failed(%d)\n", (void*)xfr, status);
- urb->close_transfers();
- break;
- case LIBUSB_TRANSFER_CANCELLED:
- urb->transfer_cancelled();
- debug("transfer 0x%p cancelled\n", (void*)xfr);
- break;
- }
-
- //debug("length:%u, actual_length:%u\n", xfr->length, xfr->actual_length);
-}
-
-URBDesc::~URBDesc()
-{
- close_transfers();
- free_transfers();
-}
-
-bool URBDesc::start_transfers(libusb_device_handle* handle, uint32_t curr_frame_size)
-{
- // Initialize the frame queue
- frame_size = curr_frame_size;
- frame_queue = std::make_shared<FrameQueue>(frame_size);
-
- // Initialize the current frame pointer to the start of the buffer; it will be updated as frames are completed and pushed onto the frame queue
- cur_frame_start = frame_queue->ptr();
- cur_frame_data_len = 0;
-
- // Find the bulk transfer endpoint
- uint8_t bulk_endpoint = find_ep(libusb_get_device(handle));
- libusb_clear_halt(handle, bulk_endpoint);
-
- // Allocate the transfer buffer
- memset(transfer_buffer, 0, sizeof(transfer_buffer));
-
- bool res = true;
- for (int index = 0; index < NUM_TRANSFERS; ++index)
- {
- // Create & submit the transfer
- xfers[index] = libusb_alloc_transfer(0);
-
- if (!xfers[index])
- {
- debug("libusb_alloc_transfer failed\n");
- res = false;
- break;
- }
-
- libusb_fill_bulk_transfer(xfers[index], handle, bulk_endpoint, transfer_buffer + index * TRANSFER_SIZE, TRANSFER_SIZE, transfer_completed_callback, reinterpret_cast<void*>(this), 0);
-
- if (int status = libusb_submit_transfer(xfers[index]); status != LIBUSB_SUCCESS)
- {
- debug("libusb_submit_transfer status %d\n", status);
- libusb_free_transfer(xfers[index]);
- xfers[index] = nullptr;
- res = false;
- break;
- }
-
- num_active_transfers++;
- }
-
- last_pts = 0;
- last_fid = 0;
-
- USBMgr::instance().camera_started();
-
- return res;
-}
-
-void URBDesc::close_transfers()
-{
- std::unique_lock<std::mutex> lock(num_active_transfers_mutex);
-
- if (teardown)
- return;
- teardown = true;
-
- // Cancel any pending transfers
- for (int i = 0; i < NUM_TRANSFERS; ++i)
- {
- if (!xfers[i])
- continue;
- enum libusb_error status = (enum libusb_error)libusb_cancel_transfer(xfers[i]);
- if (status)
- debug("libusb_cancel_transfer error(%d) %s\n", status, libusb_strerror(status));
- }
- num_active_transfers_condition.notify_one();
-}
-
-void URBDesc::free_transfers()
-{
- std::unique_lock<std::mutex> lock(num_active_transfers_mutex);
-
- // Wait for cancelation to finish
- num_active_transfers_condition.wait(lock, [this] { return num_active_transfers == 0; });
-
- // Free completed transfers
- for (libusb_transfer*& xfer : xfers)
- {
- if (!xfer)
- continue;
- libusb_free_transfer(xfer);
- xfer = nullptr;
- }
-
- USBMgr::instance().camera_stopped();
-}
-
-int URBDesc::transfer_cancelled()
-{
- std::lock_guard<std::mutex> lock(num_active_transfers_mutex);
- int refcnt = --num_active_transfers;
- num_active_transfers_condition.notify_one();
-
- return refcnt;
-}
-
-void URBDesc::frame_add(enum gspca_packet_type packet_type, const uint8_t* data, int len)
-{
- if (packet_type == FIRST_PACKET)
- cur_frame_data_len = 0;
- else
- switch(last_packet_type) // ignore warning.
- {
- case DISCARD_PACKET:
- if (packet_type == LAST_PACKET) {
- last_packet_type = packet_type;
- cur_frame_data_len = 0;
- }
- return;
- case LAST_PACKET:
- return;
- default:
- break;
- }
-
- /* append the packet to the frame buffer */
- if (len > 0)
- {
- if(cur_frame_data_len + len > frame_size)
- {
- packet_type = DISCARD_PACKET;
- cur_frame_data_len = 0;
- } else {
- memcpy(cur_frame_start+cur_frame_data_len, data, (size_t) len);
- cur_frame_data_len += len;
- }
- }
-
- last_packet_type = packet_type;
-
- if (packet_type == LAST_PACKET) {
- cur_frame_data_len = 0;
- cur_frame_start = frame_queue->Enqueue();
- //debug("frame completed %d\n", frame_complete_ind);
- }
-}
-
-void URBDesc::pkt_scan(uint8_t* data, int len)
-{
- uint32_t this_pts;
- uint16_t this_fid;
- int remaining_len = len;
- constexpr int payload_len = 2048; // bulk type
-
- do {
- len = std::min(remaining_len, payload_len);
-
- /* Payloads are prefixed with a UVC-style header. We
- consider a frame to start when the FID toggles, or the PTS
- changes. A frame ends when EOF is set, and we've received
- the correct number of bytes. */
-
- /* Verify UVC header. Header length is always 12 */
- if (data[0] != 12 || len < 12) {
- debug("bad header\n");
- goto discard;
- }
-
- /* Check errors */
- if (data[1] & UVC_STREAM_ERR) {
- debug("payload error\n");
- goto discard;
- }
-
- /* Extract PTS and FID */
- if (!(data[1] & UVC_STREAM_PTS)) {
- debug("PTS not present\n");
- goto discard;
- }
-
- this_pts = (data[5] << 24) | (data[4] << 16) | (data[3] << 8) | data[2];
- this_fid = (uint16_t) ((data[1] & UVC_STREAM_FID) ? 1 : 0);
-
- /* If PTS or FID has changed, start a new frame. */
- if (this_pts != last_pts || this_fid != last_fid) {
- if (last_packet_type == INTER_PACKET)
- {
- /* The last frame was incomplete, so don't keep it or we will glitch */
- frame_add(DISCARD_PACKET, nullptr, 0);
- }
- last_pts = this_pts;
- last_fid = this_fid;
- frame_add(FIRST_PACKET, data + 12, len - 12);
- } /* If this packet is marked as EOF, end the frame */
- else if (data[1] & UVC_STREAM_EOF)
- {
- last_pts = 0;
- if (cur_frame_data_len + len - 12 != frame_size)
- goto discard;
- frame_add(LAST_PACKET, data + 12, len - 12);
- } else {
- /* Add the data from this payload */
- frame_add(INTER_PACKET, data + 12, len - 12);
- }
-
- /* Done this payload */
- goto scan_next;
-
-discard:
- /* Discard data until a new frame starts. */
- frame_add(DISCARD_PACKET, nullptr, 0);
-scan_next:
- remaining_len -= len;
- data += len;
- } while (remaining_len > 0);
-}
-
-/*
- * look for an input transfer endpoint in an alternate setting
- * libusb_endpoint_descriptor
- */
-uint8_t URBDesc::find_ep(struct libusb_device *device)
-{
- const struct libusb_interface_descriptor *altsetting = nullptr;
- const struct libusb_endpoint_descriptor *ep;
- struct libusb_config_descriptor *config = nullptr;
- int i;
- uint8_t ep_addr = 0;
-
- libusb_get_active_config_descriptor(device, &config);
-
- if (!config) return 0;
-
- for (i = 0; i < config->bNumInterfaces; i++) {
- altsetting = config->interface[i].altsetting;
- if (altsetting[0].bInterfaceNumber == 0) {
- break;
- }
- }
-
- if (altsetting)
- for (i = 0; i < altsetting->bNumEndpoints; i++) {
- ep = &altsetting->endpoint[i];
- if ((ep->bmAttributes & LIBUSB_TRANSFER_TYPE_MASK) == LIBUSB_TRANSFER_TYPE_BULK
- && ep->wMaxPacketSize != 0)
- {
- ep_addr = ep->bEndpointAddress;
- break;
- }
- }
-
- libusb_free_config_descriptor(config);
-
- return ep_addr;
-}
-
-