X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibmarklin%2Fcontrol.cpp;h=ae26a179a9aa2f4b51585584b4d289ff6e59d4cc;hb=dcfa1e9503b7e97b61396d7458f0b2e5896779cd;hp=30e99e6e4f5266cfa1878735bf3a4a21ded55920;hpb=09843b65a4a8aa1e7f53bd3d2ec1e431d29bf513;p=r2c2.git

diff --git a/source/libmarklin/control.cpp b/source/libmarklin/control.cpp
index 30e99e6..ae26a17 100644
--- a/source/libmarklin/control.cpp
+++ b/source/libmarklin/control.cpp
@@ -8,8 +8,8 @@ Distributed under the GPL
 #include <fcntl.h>
 #include <termios.h>
 #include <sys/poll.h>
-#include <iostream>
 #include <msp/core/except.h>
+#include <msp/io/print.h>
 #include <msp/time/units.h>
 #include <msp/time/utils.h>
 #include "command.h"
@@ -72,7 +72,7 @@ void Control::open(const string &dev)
 		pollfd pfd = { serial_fd, POLLIN, 0 };
 		if(poll(&pfd, 1, 500)>0)
 		{
-			cout<<"IB detected at "<<baud[i]<<" bits/s\n";
+			IO::print("IB detected at %d bits/s\n", baud[i]);
 			char buf[2];
 			p50 = (read(serial_fd, buf, 2)==2);
 			ok = true;
@@ -123,6 +123,12 @@ Command &Control::command(Cmd cmd, const unsigned char *data, unsigned len)
 	return queue.back();
 }
 
+void Control::flush()
+{
+	for(list<Command>::iterator i=queue.begin(); i!=queue.end(); ++i)
+		i->send(serial_fd);
+}
+
 void Control::add_turnout(Turnout &t)
 {
 	turnouts[t.get_address()] = &t;
@@ -199,7 +205,7 @@ void Control::tick()
 		{
 			Reply reply = Reply::read(serial_fd, queue.front().get_command());
 			if(debug)
-				cout<<"R: "<<reply<<'\n';
+				IO::print("R: %s\n", reply);
 
 			queue.front().signal_done.emit(reply);
 			queue.erase(queue.begin());
@@ -211,7 +217,7 @@ void Control::tick()
 	if(!queue.empty())
 	{
 		if(debug)
-			cout<<"W: "<<queue.front()<<'\n';
+			IO::print("W: %s\n", queue.front());
 
 		if(serial_fd>=0)
 			queue.front().send(serial_fd);
@@ -256,7 +262,7 @@ void Control::turnout_event_done(const Reply &reply)
 	{
 		unsigned addr = (data[i*2+1])+((data[i*2+2]&7)<<8);
 		bool status = !(data[i*2+2]&0x80);
-		cout<<"Turnout "<<addr<<", status "<<status<<'\n';
+		IO::print("Turnout %d, status %d\n", addr, status);
 		signal_turnout_event.emit(addr, status);
 	}
 }
@@ -268,10 +274,7 @@ void Control::sensor_event_done(const Reply &reply)
 	{
 		unsigned module = data[i];
 
-		cout<<"S88 module "<<module<<", status ";
-		for(unsigned j=0; j<16; ++j)
-			cout<<((data[i+1+j/8]>>(7-j%8))&1);
-		cout<<'\n';
+		IO::print("S88 module %d, status %08b%08b\n", module, data[1], data[2]);
 
 		for(unsigned j=0; j<16; ++j)
 			signal_sensor_event.emit(module*16+j-15, (data[i+1+j/8]>>(7-j%8))&1);