propagate mavlink messages to ui

1 files changed, 6 insertions, 1 deletions

diff --git a/vfd-uav/src/main/scala/vfd/uav/SerialConnection.scala b/vfd-uav/src/main/scala/vfd/uav/SerialConnection.scala
index cfdf60f..1cb1fbd 100644
--- a/vfd-uav/src/main/scala/vfd/uav/SerialConnection.scala
+++ b/vfd-uav/src/main/scala/vfd/uav/SerialConnection.scala
@@ -24,7 +24,9 @@ class SerialConnection(id: Byte, heartbeat: Option[FiniteDuration], port: String
 
   override def preStart() = {
     heartbeat foreach { interval =>
-      context.system.scheduler.schedule(interval, interval, self, Connection.Send(Heartbeat))
+      context.system.scheduler.schedule(interval, interval) {
+        self ! Connection.Send(Heartbeat)
+      }
     }
   }
 
@@ -63,6 +65,8 @@ class SerialConnection(id: Byte, heartbeat: Option[FiniteDuration], port: String
 
   }
   
+  val parser = new Parser(pckt => println(Message.unpack(pckt.messageId, pckt.payload)))
+  
  
   def _opened(operator: ActorRef): Receive = {
 
@@ -75,6 +79,7 @@ class SerialConnection(id: Byte, heartbeat: Option[FiniteDuration], port: String
       context become closed
 
     case Serial.Received(bstr) =>
+      for (b <- bstr) parser.push(b)
       sendAll(Connection.Received(bstr))
 
     case Connection.Send(bstr) =>