Commit 1d8355dd by Hideaki Tai

fix for new buffering whill communication

parent f1dff934
......@@ -286,20 +286,16 @@ void sendStatus()
}
}
void waitReply(WhillOmni::LR lr, uint16_t wait_ms = 0)
void waitReply(uint16_t wait_ms = 0)
{
delay(wait_ms);
whill.parse();
while(whill.available(lr))
{
#ifdef DEBUG_INFO
if (whill.dataset(lr) == 0) printSpeedProfile(lr);
else if (whill.dataset(lr) == 1) printSensorInfo(lr);
else Serial.println("invalid dataset number");
#endif
whill.pop(lr);
}
printSpeedProfile(WhillOmni::LR::L);
printSpeedProfile(WhillOmni::LR::R);
printSensorInfo(WhillOmni::LR::L);
printSensorInfo(WhillOmni::LR::R);
}
......
  • Markdown is supported
    0% or
    You are about to add 0 people to the discussion. Proceed with caution.
    Finish editing this message first!
    Please register or sign in to comment