lauchmelder/b15f
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

usart revised

Browse source
This commit is contained in:
Tristan Krause 2019-06-06 12:00:52 +02:00
parent 3f0fe49644
commit ff84de538a
7 changed files with 127 additions and 184 deletions
Download patch file Download diff file Expand all files Collapse all files

14
control/src/drv/usart.cpp
View file

@ -75,15 +75,25 @@ void USART::flushOutputBuffer()
void USART::receive(uint8_t *buffer, uint16_t offset, uint8_t len)
{
int bytes_avail, code;
auto start = std::chrono::steady_clock::now();
auto end = std::chrono::steady_clock::now();
do
{
code = ioctl(file_desc, FIONREAD, &bytes_avail);
if(code)
if (code)
throw USARTException(
std::string(__FUNCTION__) + " failed: " + std::string(__FILE__) + "#" + std::to_string(__LINE__) +
", " + strerror(code) + " (code " + std::to_string(code) + ")");
end = std::chrono::steady_clock::now();
long elapsed =
std::chrono::duration_cast<std::chrono::milliseconds>(end - start).count() / 100; // in Dezisekunden
if (elapsed >= timeout)
throw TimeoutException(
std::string(__FUNCTION__) + " failed: " + std::string(__FILE__) + "#" + std::to_string(__LINE__) +
", " + std::to_string(elapsed) + " / " + std::to_string(timeout) + " ds");
}
while(bytes_avail < len);
while (bytes_avail < len);
code = read(file_desc, buffer + offset, len);
if (code != len)