From 2c46bcc3b3ab0bc52efb5f0ea28eccc303dcdf33 Mon Sep 17 00:00:00 2001
From: David <david@somewebsite.co.uk>
Date: Wed, 8 Feb 2023 14:36:00 +0000
Subject: [PATCH] Debug messages

---
 src/simple_adas.cpp | 22 ++++++++++++++++++++++
 1 file changed, 22 insertions(+)

diff --git a/src/simple_adas.cpp b/src/simple_adas.cpp
index 4ae753b..05e98b7 100644
--- a/src/simple_adas.cpp
+++ b/src/simple_adas.cpp
@@ -126,6 +126,28 @@ void adas_api::SimpleAdas::write()
             - estop: true
     */
 
+   switch( this->status().as_state() )
+    {
+        case StatusFrame::AsState::OFF: 
+            std::cout << "AS OFF" << std::endl;
+            break;
+        case StatusFrame::AsState::READY:
+            std::cout << "AS READY" << std::endl;
+            break;
+        case StatusFrame::AsState::DRIVING:
+            std::cout << "AS DRIVING" << std::endl;
+            break;
+        case StatusFrame::AsState::FINISHED:
+            std::cout << "AS FINISHED" << std::endl;
+            break;
+        case StatusFrame::AsState::EMERGENCY:
+            std::cout << "AS EMERGENCY" << std::endl;
+            break;
+        default: 
+            std::cout << "AS default" << std::endl;
+            break;
+    }
+
     /* mission status */
     switch( this->status().as_state() )
     {