Read auto mode sensors
Change-Id: Ib8a3716022805bf02258637f23635c71578a7105
diff --git a/y2016/joystick_reader.cc b/y2016/joystick_reader.cc
index ab23df1..75f48a4 100644
--- a/y2016/joystick_reader.cc
+++ b/y2016/joystick_reader.cc
@@ -378,7 +378,13 @@
LOG(INFO, "Starting auto mode\n");
actors::AutonomousActionParams params;
- params.mode = 0;
+ actors::auto_mode.FetchLatest();
+ if (actors::auto_mode.get() != nullptr) {
+ params.mode = actors::auto_mode->mode;
+ } else {
+ LOG(WARNING, "no auto mode values\n");
+ params.mode = 0;
+ }
action_queue_.EnqueueAction(actors::MakeAutonomousAction(params));
}