|
|
|
|
|
|
|
|
|
|
|
|
|
|
int LFR_UART::writeDataToFile(int8_t *buff, uint32_t bufferLength) { |
|
|
int LFR_UART::writeDataToFile(int8_t *buff, uint32_t bufferLength) { |
|
|
//std::cout << "Sending uart: " << std::bitset<8>(buff[0]) << std::endl; |
|
|
//std::cout << "Sending uart: " << std::bitset<8>(buff[0]) << std::endl; |
|
|
std::cout << "Sending uart: " << std::bitset<8>(buff[0]) << ", " << std::bitset<8>(buff[1]) << ", " << std::bitset<8>(buff[2]) << ", " << std::bitset<8>(buff[3]) << " csum: " << std::bitset<8>(buff[4]) << std::endl; |
|
|
|
|
|
|
|
|
std::cout << "Sending Uart: " << std::bitset<8>(buff[0]) << ", " << std::bitset<8>(buff[1]) << ", " << std::bitset<8>(buff[2]) << ", " << std::bitset<8>(buff[3]) << " csum: " << std::bitset<8>(buff[4]) << std::endl; |
|
|
return write(this->fileDescriptor, buff, bufferLength); |
|
|
return write(this->fileDescriptor, buff, bufferLength); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void LFR_UART::sendTelegram(double wheel1, double wheel2, double wheel3, double wheel4){ |
|
|
void LFR_UART::sendTelegram(double wheel1, double wheel2, double wheel3, double wheel4){ |
|
|
std::chrono::milliseconds now = std::chrono::duration_cast<std::chrono::milliseconds>(std::chrono::system_clock::now().time_since_epoch()); |
|
|
std::chrono::milliseconds now = std::chrono::duration_cast<std::chrono::milliseconds>(std::chrono::system_clock::now().time_since_epoch()); |
|
|
unsigned int deltaMs = static_cast<unsigned int>((now-last).count()); |
|
|
unsigned int deltaMs = static_cast<unsigned int>((now-last).count()); |
|
|
if (deltaMs < 250) |
|
|
|
|
|
|
|
|
if (deltaMs < 250 && (std::fabs(wheel1)+std::fabs(wheel2)+std::fabs(wheel3)+std::fabs(wheel4)) > 0.0005) |
|
|
{ |
|
|
{ |
|
|
std::cout << "Too fast" << std::endl; |
|
|
std::cout << "Too fast" << std::endl; |
|
|
return; |
|
|
return; |