frodovdr/hyperion.ng
1
0
Fork 0
mirror of https://github.com/hyperion-project/hyperion.ng.git synced 2025-03-01 10:33:28 +00:00
Code Issues Packages Projects Releases Wiki Activity

Refactor ftdi provider

Browse Source
This commit is contained in:
LordGrey 2023-04-11 19:59:22 +00:00
parent d8fbfd24a9
commit 757fd39982
1 changed files with 23 additions and 49 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

64
libsrc/leddevice/dev_ftdi/ProviderFtdi.cpp
View File

@ -9,6 +9,8 @@
#define ANY_FTDI_VENDOR 0x0 #define ANY_FTDI_VENDOR 0x0
#define ANY_FTDI_PRODUCT 0x0 #define ANY_FTDI_PRODUCT 0x0
#define FTDI_CHECK_RESULT(statement) if (statement) {setInError(ftdi_get_error_string(_ftdic)); return rc;}
namespace Pin namespace Pin
{ {
// enumerate the AD bus for convenience. // enumerate the AD bus for convenience.
@ -58,51 +60,27 @@ int ProviderFtdi::open()
Debug(_log, "Opening FTDI device=%s", QSTRING_CSTR(_deviceName)); Debug(_log, "Opening FTDI device=%s", QSTRING_CSTR(_deviceName));
if (ftdi_usb_open_string(_ftdic, QSTRING_CSTR(_deviceName)) < 0) FTDI_CHECK_RESULT((rc = ftdi_usb_open_string(_ftdic, QSTRING_CSTR(_deviceName))) < 0);
{
setInError(ftdi_get_error_string(_ftdic));
return -1;
}
/* doing this disable resets things if they were in a bad state */ /* doing this disable resets things if they were in a bad state */
if ((rc = ftdi_disable_bitbang(_ftdic)) < 0) FTDI_CHECK_RESULT((rc = ftdi_disable_bitbang(_ftdic)) < 0);
{ FTDI_CHECK_RESULT((rc = ftdi_setflowctrl(_ftdic, SIO_DISABLE_FLOW_CTRL)) < 0);
setInError(ftdi_get_error_string(_ftdic)); FTDI_CHECK_RESULT((rc = ftdi_set_bitmode(_ftdic, 0x00, BITMODE_RESET)) < 0);
return rc; FTDI_CHECK_RESULT((rc = ftdi_set_bitmode(_ftdic, 0xff, BITMODE_MPSSE)) < 0);
}
if ((rc = ftdi_setflowctrl(_ftdic, SIO_DISABLE_FLOW_CTRL)) < 0)
{
setInError(ftdi_get_error_string(_ftdic));
return rc;
}
if ((rc = ftdi_set_bitmode(_ftdic, 0x00, BITMODE_RESET)) < 0)
{
setInError(ftdi_get_error_string(_ftdic));
return rc;
}
if ((rc = ftdi_set_bitmode(_ftdic, 0xff, BITMODE_MPSSE)) < 0)
{
setInError(ftdi_get_error_string(_ftdic));
return rc;
}
double reference_clock = 60e6; double reference_clock = 60e6;
int divisor = (reference_clock / 2 / _baudRate_Hz) - 1; int divisor = (reference_clock / 2 / _baudRate_Hz) - 1;
uint8_t buf[10] = {0}; std::vector<uint8_t> buf = {
int icmd = 0; DIS_DIV_5,
buf[icmd++] = DIS_DIV_5; TCK_DIVISOR,
buf[icmd++] = TCK_DIVISOR; static_cast<unsigned char>(divisor),
buf[icmd++] = divisor; static_cast<unsigned char>(divisor >> 8),
buf[icmd++] = divisor >> 8; SET_BITS_LOW, // opcode: set low bits (ADBUS[0-7]
buf[icmd++] = SET_BITS_LOW; // opcode: set low bits (ADBUS[0-7]) pinInitialState, // argument: inital pin state
buf[icmd++] = pinInitialState; // argument: initial pin states pinDirection
buf[icmd++] = pinDirection; };
if ((rc = ftdi_write_data(_ftdic, buf, icmd)) != icmd)
{ FTDI_CHECK_RESULT((rc = ftdi_write_data(_ftdic, buf.data(), buf.size())) != buf.size());
setInError(ftdi_get_error_string(_ftdic));
return rc;
}
_isDeviceReady = true; _isDeviceReady = true;
return rc; return rc;
@ -150,11 +128,7 @@ int ProviderFtdi::writeBytes(const qint64 size, const uint8_t *data)
// SET_BITS_LOW takes 2 arguments, so we're inserting data in -3 position from the end // SET_BITS_LOW takes 2 arguments, so we're inserting data in -3 position from the end
buf.insert(buf.end() - 3, &data[0], &data[size]); buf.insert(buf.end() - 3, &data[0], &data[size]);
if ((rc = ftdi_write_data(_ftdic, buf.data(), buf.size())) != buf.size()) FTDI_CHECK_RESULT((rc = ftdi_write_data(_ftdic, buf.data(), buf.size())) != buf.size());
{
setInError(ftdi_get_error_string(_ftdic));
return rc;
}
return rc; return rc;
} }