Browse Source

Let signals to stop always pass

master
Tim Zeuner 1 year ago
parent
commit
397e6fe331
2 changed files with 3 additions and 2 deletions
  1. 2
    2
      Communication/uart_communication.cpp
  2. 1
    0
      Communication/uart_communication.h

+ 2
- 2
Communication/uart_communication.cpp View File



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;

+ 1
- 0
Communication/uart_communication.h View File

#include <exception> #include <exception>
#include <iostream> #include <iostream>
#include <chrono> #include <chrono>
#include <cmath>


#include <bitset> #include <bitset>



Loading…
Cancel
Save