power(false),
halted(false),
active_accessory(0),
+ command_timeout(200*Time::msec),
s88(*this),
mfx_search(*this),
thread(*this)
void ArduControl::flush()
{
+ while(!command_queue.empty() || !accessory_queue.empty())
+ tick();
}
void ArduControl::save_state() const
return true;
}
+template<typename T>
+bool ArduControl::Queue<T>::empty() const
+{
+ return items.empty();
+}
+
ArduControl::RefreshTask::RefreshTask():
next(cycle.end()),
if(get_work(cmd))
{
bool success = true;
+ bool resync = false;
for(unsigned i=0; (success && i<cmd.repeat_count); ++i)
- success = (do_command(cmd)==COMMAND_OK);
+ {
+ unsigned result = do_command(cmd, control.command_timeout);
+ success = (result==COMMAND_OK);
+ resync = (result==0);
+ }
+
if(success && cmd.tag)
control.completed_commands.push(cmd.tag);
+
+ if(resync)
+ {
+ if(control.debug>=1)
+ IO::print("Synchronization with ArduControl lost, attempting to recover\n");
+ for(unsigned i=0; (resync && i<16); ++i)
+ {
+ control.serial.put('\xFF');
+ while(IO::poll(control.serial, IO::P_INPUT, control.command_timeout))
+ resync = (control.serial.get()!=0xFF);
+ }
+ if(resync)
+ {
+ if(control.debug>=1)
+ IO::print("Resynchronization failed, giving up\n");
+ done = true;
+ }
+ else
+ {
+ if(control.debug>=1)
+ IO::print("Resynchronization successful\n");
+ if(cmd.tag)
+ control.command_queue.push(cmd);
+ }
+ }
}
else
Time::sleep(10*Time::msec);
cmd.command[1] = rates[0]>>8;
cmd.command[2] = rates[0];
cmd.length = 3;
- if(do_command(cmd)==COMMAND_OK)
+ if(do_command(cmd, Time::sec)==COMMAND_OK)
{
control.serial.set_baud_rate(rates[0]);
Time::sleep(Time::sec);
- if(do_command(cmd)==COMMAND_OK)
+ if(do_command(cmd, Time::sec)==COMMAND_OK)
{
if(control.debug>=1)
IO::print("Rate changed to %d bits/s\n", rates[0]);
return true;
}
-unsigned ArduControl::ControlThread::do_command(const PendingCommand &cmd)
+unsigned ArduControl::ControlThread::do_command(const PendingCommand &cmd, const Time::TimeDelta &timeout)
{
if(control.debug>=2)
{
if(result)
got_data = IO::poll(control.serial, IO::P_INPUT, Time::zero);
else
- got_data = IO::poll(control.serial, IO::P_INPUT);
+ got_data = IO::poll(control.serial, IO::P_INPUT, timeout);
if(!got_data)
break;
char reply[15];
unsigned pos = 0;
while(pos<rlength)
+ {
+ if(!IO::poll(control.serial, IO::P_INPUT, timeout))
+ return 0;
pos += control.serial.read(reply+pos, rlength-pos);
+ }
if(control.debug>=2)
{