mainloop plops yz-plane again

MotionCore/MainLoop.cpp

@@ -43,7 +43,7 @@ void MainLoop::run()
     static std::chrono::steady_clock::time_point lastBegin =
         std::chrono::high_resolution_clock::now();
 
-   //YZConsolePlotter plot(-200, 200, 20, 2);
+   YZConsolePlotter plot(-200, 200, 20, 2);
 
     double j0Pos = 0;
     double j1Pos = 0;
@@ -63,7 +63,7 @@ void MainLoop::run()
             isRunning = false;
         }
 
-        constexpr double speed = 3000;
+        constexpr double speed = 5000;
         VkbInputs vkbi = leftVKB.get();
 
         // Calculate new joint positions
@@ -85,8 +85,8 @@ void MainLoop::run()
         }
        
         const Vector3d ef = arm.getJ2().getGlobalEndpoint();
-        std::cout << j2Pos << std::endl;
-        //plot.draw(ef);
+        //std::cout << ef << std::endl;
+        plot.draw(ef);
 
         arm.update(frametime);