1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
|
/******************************************************************************
**
** Copyright (C) 2016 The Qt Company Ltd.
** Contact: http://www.qt.io/licensing/
**
** This file is part of the Qt Debug Bridge.
**
** $QT_BEGIN_LICENSE:COMM$
**
** Commercial License Usage
** Licensees holding valid commercial Qt licenses may use this file in
** accordance with the commercial license agreement provided with the
** Software or, alternatively, in accordance with the terms contained in
** a written agreement between you and The Qt Company. For licensing terms
** and conditions see http://www.qt.io/terms-conditions. For further
** information use the contact form at http://www.qt.io/contact-us.
**
** $QT_END_LICENSE$
**
******************************************************************************/
#include "usbconnection.h"
#include "../utils/make_unique.h"
#include "../utils/scopeguard.h"
#include "protocol/protocol.h"
#include "usbcommon.h"
#include "usbconnectionreader.h"
#include <QtCore/qdebug.h>
#include <QtCore/qthread.h>
#include <libusb.h>
UsbConnection::UsbConnection(const UsbDevice &device)
: m_device{device.usbDevice},
m_handle{nullptr},
m_interfaceInfo(device.interfaceInfo), // uniform initialization with {} fails with GCC 4.9
m_readThread{nullptr},
m_reader{nullptr},
m_reads{}
{
}
UsbConnection::~UsbConnection()
{
if (m_readThread) {
m_readThread->quit();
m_readThread->wait();
}
if (m_handle) {
libusb_release_interface(m_handle, m_interfaceInfo.number);
libusb_close(m_handle);
}
}
bool UsbConnection::open(OpenMode mode)
{
Q_ASSERT(mode == (QIODevice::ReadWrite | QIODevice::Unbuffered));
QIODevice::open(mode);
libusb_config_descriptor *config;
int ret = libusb_get_active_config_descriptor(m_device.pointer(), &config);
if (ret) {
qDebug("could not get config descriptor: %s\n",
libusb_error_name(ret));
return false;
}
ScopeGuard configGuard = [&]() {
libusb_free_config_descriptor(config);
};
ret = libusb_open(m_device.pointer(), &m_handle);
if (ret) {
qDebug("cannot open device: %s\n", libusb_error_name(ret));
return false;
}
libusb_set_auto_detach_kernel_driver(m_handle, 1);
ret = libusb_claim_interface(m_handle, m_interfaceInfo.number);
if (ret) {
qDebug("cannot claim interface: %s", libusb_error_name(ret));
return false;
}
qDebug("claimed interface %d", m_interfaceInfo.number);
startReader(m_handle, m_interfaceInfo.inAddress);
return true;
}
qint64 UsbConnection::readData(char *data, qint64 maxSize)
{
if (m_reads.isEmpty()) {
qDebug() << "UsbConnection read queue empty in readData";
return -1;
}
QByteArray read = m_reads.dequeue();
Q_ASSERT(read.size() <= maxSize); // TODO: handle too big reads
std::copy(read.begin(), read.end(), data);
return read.size();
}
qint64 UsbConnection::writeData(const char *data, qint64 maxSize)
{
// Send header as a separate transfer to allow separate read on device side
int size = maxSize > qdbHeaderSize ? qdbHeaderSize : maxSize;
int transferred = 0;
int ret = libusb_bulk_transfer(m_handle, m_interfaceInfo.outAddress, (unsigned char*)data, size, &transferred, 0);
if (ret) {
qDebug() << "writeData error:" << libusb_error_name(ret);
return -1;
}
Q_ASSERT(transferred == size); // TODO: handle partial transfers of header
transferred = 0;
if (size < maxSize) {
int rest = maxSize - size;
int ret = libusb_bulk_transfer(m_handle, m_interfaceInfo.outAddress, (unsigned char*)data + size, rest, &transferred, 0);
if (ret) {
qDebug() << "writeData error:" << libusb_error_name(ret);
return -1;
}
}
return size + transferred;
}
void UsbConnection::dataRead(QByteArray data)
{
m_reads.enqueue(data);
emit readyRead();
}
void UsbConnection::startReader(libusb_device_handle *handle, uint8_t inAddress)
{
m_readThread = make_unique<QThread>();
m_reader = make_unique<UsbConnectionReader>(handle, inAddress);
connect(m_reader.get(), &UsbConnectionReader::newRead, this, &UsbConnection::dataRead);
connect(m_readThread.get(), &QThread::started, m_reader.get(), &UsbConnectionReader::executeRead);
m_reader->moveToThread(m_readThread.get());
m_readThread->setObjectName("UsbConnectionReader");
m_readThread->start();
}
|
