diff --git a/MotionCore/MainLoop.cpp b/MotionCore/MainLoop.cpp index bf675bb..81d55b0 100755 --- a/MotionCore/MainLoop.cpp +++ b/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);