eu07/maszyna
1
0
Fork 0
mirror of https://github.com/MaSzyna-EU07/maszyna.git synced 2026-03-22 15:05:03 +01:00
Code Issues Packages Projects Releases Wiki Activity

changes

Browse Source
This commit is contained in:
milek7
2017-09-25 18:08:54 +02:00
parent f2a57dda63
commit 5add2c5f1c
1 changed files with 7 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

10
uart.cpp
View File

@@ -47,13 +47,14 @@ void uart_input::poll()
sp_return ret;
if (sp_input_waiting(port) >= 16)
if ((ret = sp_input_waiting(port)) >= 16)
{
std::array<uint8_t, 16> buffer;
ret = sp_blocking_read(port, (void*)buffer.data(), buffer.size(), 0);
if (ret < 0)
throw std::runtime_error("uart: failed to read from port");
WriteLog("uart: recv");
sp_drain(port);
data_pending = false;
@@ -115,6 +116,8 @@ void uart_input::poll()
old_packet = buffer;
}
WriteLog("uart, available input: " + std::to_string(ret));
if (!data_pending && sp_output_waiting(port) == 0)
{
// TODO: ugly! move it into structure like input_bits
@@ -162,8 +165,9 @@ void uart_input::poll()
buffer[8] |= buzzer << 7;
sp_flush(port, SP_BUF_INPUT); // flush input buffer in preparation for reply packet
// sp_flush(port, SP_BUF_INPUT); // flush input buffer in preparation for reply packet
WriteLog("uart: send");
ret = sp_blocking_write(port, (void*)buffer.data(), buffer.size(), 0);
if (ret != buffer.size())
throw std::runtime_error("uart: failed to write to port");