From e457d5a9d7a1c28e670a29aaa7f76b734933fe95 Mon Sep 17 00:00:00 2001 From: gabekole Date: Tue, 1 Oct 2024 18:16:25 -0400 Subject: [PATCH] Add print --- src/Controller.cpp | 4 ++++ src/Mode.cpp | 2 +- 2 files changed, 5 insertions(+), 1 deletion(-) diff --git a/src/Controller.cpp b/src/Controller.cpp index 921b9d9..d583473 100644 --- a/src/Controller.cpp +++ b/src/Controller.cpp @@ -140,6 +140,10 @@ void Controller::CalculateInput(){ if(input.norm() > MissionConstants::kMaximumTvcAngle){ input = input*MissionConstants::kMaximumTvcAngle/input.norm(); } + + + std::cout << "Calculating input: " << std::to_string(input(0)) << ", " << std::to_string(input(0)) << std::endl; + // Figures out what angle we need to move the servos and then set them // [TODO] Move to hardware tvc_angles = TvcMath(input); tvc.SetTVCX(input(0)); diff --git a/src/Mode.cpp b/src/Mode.cpp index 9994b8d..ac27952 100644 --- a/src/Mode.cpp +++ b/src/Mode.cpp @@ -220,7 +220,7 @@ bool Mode::Update(Navigation& navigation, Controller& controller, Igniter& ignit // Update navigations and controller's loopTime to be changeTime which should be 0.005 each time navigation.loopTime = change_time; controller.loopTime = change_time; - // TODO [MOVE TO FUNCTION CALLS FOR CONTROLLER AND NAVIGATION] + // TODO [MOVE TO FUNCTION CALLS FOR CONTROLLER AND NAV] /* Handle behavior based on current phase. Update phase*/