mirror of
https://github.com/hyperion-project/hyperion.ng.git
synced 2023-10-10 13:36:59 +02:00
d679affeb4
* commit debug code to save it due to merge * migrate first devices to new device registry and configure on runtime * fadecandy and rs232 resets device if config is set * try to hunt crash on osx * test commit if this works with osx * refactor spi devices * cleanup * refactor leddevices file, tinkerforge and ws2812b * refactor raw usb devices * refactor udp devices * - add tpm2net driver - remove old udp driver from build (files left in place for reference for new udp driver) - json serverinfo shows available leddevices * finish rework part 2 of leddevices * add schemas for leddevices. currently only compiled in, but not usedx
225 lines
5.8 KiB
C++
225 lines
5.8 KiB
C++
// stl includes
|
|
#include <exception>
|
|
#include <cstring>
|
|
|
|
// Local Hyperion includes
|
|
#include "LedDeviceHyperionUsbasp.h"
|
|
|
|
// Static constants which define the Hyperion Usbasp device
|
|
uint16_t LedDeviceHyperionUsbasp::_usbVendorId = 0x16c0;
|
|
uint16_t LedDeviceHyperionUsbasp::_usbProductId = 0x05dc;
|
|
std::string LedDeviceHyperionUsbasp::_usbProductDescription = "Hyperion led controller";
|
|
|
|
|
|
LedDeviceHyperionUsbasp::LedDeviceHyperionUsbasp(const Json::Value &deviceConfig)
|
|
: LedDevice()
|
|
, _libusbContext(nullptr)
|
|
, _deviceHandle(nullptr)
|
|
{
|
|
setConfig(deviceConfig);
|
|
}
|
|
|
|
LedDeviceHyperionUsbasp::~LedDeviceHyperionUsbasp()
|
|
{
|
|
if (_deviceHandle != nullptr)
|
|
{
|
|
libusb_release_interface(_deviceHandle, 0);
|
|
libusb_attach_kernel_driver(_deviceHandle, 0);
|
|
libusb_close(_deviceHandle);
|
|
|
|
_deviceHandle = nullptr;
|
|
}
|
|
|
|
if (_libusbContext != nullptr)
|
|
{
|
|
libusb_exit(_libusbContext);
|
|
_libusbContext = nullptr;
|
|
}
|
|
}
|
|
|
|
bool LedDeviceHyperionUsbasp::setConfig(const Json::Value &deviceConfig)
|
|
{
|
|
std::string ledType = deviceConfig.get("output", "ws2801").asString();
|
|
if (ledType != "ws2801" && ledType != "ws2812")
|
|
{
|
|
throw std::runtime_error("HyperionUsbasp: invalid output; must be 'ws2801' or 'ws2812'.");
|
|
}
|
|
|
|
_writeLedsCommand = (ledType == "ws2801") ? CMD_WRITE_WS2801 : CMD_WRITE_WS2812;
|
|
|
|
return true;
|
|
}
|
|
|
|
LedDevice* LedDeviceHyperionUsbasp::construct(const Json::Value &deviceConfig)
|
|
{
|
|
return new LedDeviceHyperionUsbasp(deviceConfig);
|
|
}
|
|
|
|
|
|
int LedDeviceHyperionUsbasp::open()
|
|
{
|
|
int error;
|
|
|
|
// initialize the usb context
|
|
if ((error = libusb_init(&_libusbContext)) != LIBUSB_SUCCESS)
|
|
{
|
|
Error(_log, "Error while initializing USB context(%d):%s", error, libusb_error_name(error));
|
|
_libusbContext = nullptr;
|
|
return -1;
|
|
}
|
|
//libusb_set_debug(_libusbContext, 3);
|
|
Debug(_log, "USB context initialized");
|
|
|
|
// retrieve the list of usb devices
|
|
libusb_device ** deviceList;
|
|
ssize_t deviceCount = libusb_get_device_list(_libusbContext, &deviceList);
|
|
|
|
// iterate the list of devices
|
|
for (ssize_t i = 0 ; i < deviceCount; ++i)
|
|
{
|
|
// try to open and initialize the device
|
|
error = testAndOpen(deviceList[i]);
|
|
|
|
if (error == 0)
|
|
{
|
|
// a device was sucessfully opened. break from list
|
|
break;
|
|
}
|
|
}
|
|
|
|
// free the device list
|
|
libusb_free_device_list(deviceList, 1);
|
|
|
|
if (_deviceHandle == nullptr)
|
|
{
|
|
Error(_log, "No %s has been found", _usbProductDescription.c_str());
|
|
}
|
|
|
|
return _deviceHandle == nullptr ? -1 : 0;
|
|
}
|
|
|
|
int LedDeviceHyperionUsbasp::testAndOpen(libusb_device * device)
|
|
{
|
|
libusb_device_descriptor deviceDescriptor;
|
|
int error = libusb_get_device_descriptor(device, &deviceDescriptor);
|
|
if (error != LIBUSB_SUCCESS)
|
|
{
|
|
Error(_log, "Error while retrieving device descriptor(%d): %s", error, libusb_error_name(error));
|
|
return -1;
|
|
}
|
|
|
|
if (deviceDescriptor.idVendor == _usbVendorId &&
|
|
deviceDescriptor.idProduct == _usbProductId &&
|
|
deviceDescriptor.iProduct != 0 &&
|
|
getString(device, deviceDescriptor.iProduct) == _usbProductDescription)
|
|
{
|
|
// get the hardware address
|
|
int busNumber = libusb_get_bus_number(device);
|
|
int addressNumber = libusb_get_device_address(device);
|
|
|
|
Info(_log, "%s found: bus=%d address=%d", _usbProductDescription.c_str(), busNumber, addressNumber);
|
|
|
|
try
|
|
{
|
|
_deviceHandle = openDevice(device);
|
|
Info(_log, "%s successfully opened", _usbProductDescription.c_str() );
|
|
return 0;
|
|
}
|
|
catch(int e)
|
|
{
|
|
_deviceHandle = nullptr;
|
|
Error(_log, "Unable to open %s. Searching for other device(%d): %s", _usbProductDescription.c_str(), e, libusb_error_name(e));
|
|
}
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
|
|
int LedDeviceHyperionUsbasp::write(const std::vector<ColorRgb> &ledValues)
|
|
{
|
|
_ledCount = ledValues.size();
|
|
|
|
int nbytes = libusb_control_transfer(
|
|
_deviceHandle, // device handle
|
|
LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_RECIPIENT_DEVICE | LIBUSB_ENDPOINT_OUT, // request type
|
|
_writeLedsCommand, // request
|
|
0, // value
|
|
0, // index
|
|
(uint8_t *) ledValues.data(), // data
|
|
(3*_ledCount) & 0xffff, // length
|
|
5000); // timeout
|
|
|
|
// Disabling interupts for a little while on the device results in a PIPE error. All seems to keep functioning though...
|
|
if(nbytes < 0 && nbytes != LIBUSB_ERROR_PIPE)
|
|
{
|
|
Error(_log, "Error while writing data to %s (%s)", _usbProductDescription.c_str(), libusb_error_name(nbytes));
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int LedDeviceHyperionUsbasp::switchOff()
|
|
{
|
|
std::vector<ColorRgb> ledValues(_ledCount, ColorRgb::BLACK);
|
|
return write(ledValues);
|
|
}
|
|
|
|
libusb_device_handle * LedDeviceHyperionUsbasp::openDevice(libusb_device *device)
|
|
{
|
|
Logger * log = Logger::getInstance("LedDevice");
|
|
libusb_device_handle * handle = nullptr;
|
|
|
|
int error = libusb_open(device, &handle);
|
|
if (error != LIBUSB_SUCCESS)
|
|
{
|
|
Error(log, "unable to open device(%d): %s",error,libusb_error_name(error));
|
|
throw error;
|
|
}
|
|
|
|
// detach kernel driver if it is active
|
|
if (libusb_kernel_driver_active(handle, 0) == 1)
|
|
{
|
|
error = libusb_detach_kernel_driver(handle, 0);
|
|
if (error != LIBUSB_SUCCESS)
|
|
{
|
|
Error(log, "unable to detach kernel driver(%d): %s",error,libusb_error_name(error));
|
|
libusb_close(handle);
|
|
throw error;
|
|
}
|
|
}
|
|
|
|
error = libusb_claim_interface(handle, 0);
|
|
if (error != LIBUSB_SUCCESS)
|
|
{
|
|
Error(log, "unable to claim interface(%d): %s", error, libusb_error_name(error));
|
|
libusb_attach_kernel_driver(handle, 0);
|
|
libusb_close(handle);
|
|
throw error;
|
|
}
|
|
|
|
return handle;
|
|
}
|
|
|
|
std::string LedDeviceHyperionUsbasp::getString(libusb_device * device, int stringDescriptorIndex)
|
|
{
|
|
libusb_device_handle * handle = nullptr;
|
|
|
|
int error = libusb_open(device, &handle);
|
|
if (error != LIBUSB_SUCCESS)
|
|
{
|
|
throw error;
|
|
}
|
|
|
|
char buffer[256];
|
|
error = libusb_get_string_descriptor_ascii(handle, stringDescriptorIndex, reinterpret_cast<unsigned char *>(buffer), sizeof(buffer));
|
|
if (error <= 0)
|
|
{
|
|
libusb_close(handle);
|
|
throw error;
|
|
}
|
|
|
|
libusb_close(handle);
|
|
return std::string(buffer, error);
|
|
}
|