Add print

Propulsive-Landing · Oct 1, 2024 · e457d5a · e457d5a
1 parent 0884dfc
commit e457d5a
Show file tree

Hide file tree

Showing 2 changed files with 5 additions and 1 deletion.
diff --git 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
@@ -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*/