generic_gpio: add io simulator

- used for testing of callbacks to get events without real hw

Signed-off-by: Manuel Traut <manut@mecka.net>

1 files changed, 32 insertions, 20 deletions

diff --git a/io/bin/generic_gpio/generic_gpio.cpp b/io/bin/generic_gpio/generic_gpio.cpp
index 2100e40..35986ea 100644
--- a/io/bin/generic_gpio/generic_gpio.cpp
+++ b/io/bin/generic_gpio/generic_gpio.cpp
@@ -7,40 +7,54 @@
 
 #include <iostream>
 
-class Io_manager : public  ACE_Task < ACE_MT_SYNCH > {
-	public:
-		Io_manager () { }
-		~Io_manager () { }
-
-	private:
-		int svc (void) {
-			while (1) {
-				/** TODO: implement some cyclic gpio stuff */
-				sleep (1);
-			}
-		}
-};
-
 class My_digital : public Distrio_Digital_i {
 	public:
 		My_digital (std::string io_name) : Distrio_Digital_i (io_name) { }
 
 		::Distrio::Error *set () {
+			update_timestamp ();
+			val = 1;
 			std::cout << "set" << std::endl;
 			return distrio_success ();
 		}
 
 		::Distrio::Error *reset () {
+			update_timestamp ();
+			val = 0;
 			std::cout << "reset" << std::endl;
 			return distrio_success ();
 		}
+
+		::Distrio::Error *get (::CORBA::Long_out value) {
+			value = val;
+			std::cout << "get" << std::endl;
+			return distrio_success ();
+		}
+};
+
+class Io_simulator : public  ACE_Task < ACE_MT_SYNCH > {
+	public:
+		Io_simulator (My_digital *_io) { io = _io; }
+		~Io_simulator () { }
+
+	private:
+		My_digital *io;
+
+		int svc (void) {
+			while (1) {
+				io->raise ();
+				sleep (3);
+				io->fall ();
+				sleep (5);
+			}
+		}
 };
 
 ACE_TMAIN (int argc, ACE_TCHAR *argv[])
 {
 	int ret = 0;
 	My_digital *digital;
-	/* Io_manager manager; */
+	Io_simulator *sim;
 
 	if (init_corba (argc, argv))
 		return -EINVAL;
@@ -55,13 +69,11 @@ ACE_TMAIN (int argc, ACE_TCHAR *argv[])
 		goto out;
 	}
 
-	std::cout << "registered id: " << digital->id () << std::endl;
+	sim = new Io_simulator (digital);
 
-	/* TODO: activate if cyclic stuff is needed
-	manager.activate ();
-	manager.wait ();
-	*/
+	std::cout << "registered id: " << digital->id () << std::endl;
 
+	sim->activate ();
 	join_orb ();
 
 out: