diff --git a/src/monitor.cpp b/src/monitor.cpp index c5d0393..0cb85d6 100644 --- a/src/monitor.cpp +++ b/src/monitor.cpp @@ -40,37 +40,37 @@ void Monitor::sportModeStateCallback(const void* message) { static_cast(message); // Print position data - std::cout << "Position: " - << state->position()[0] << ", " - << state->position()[1] << ", " - << state->position()[2] << std::endl; + // std::cout << "Position: " + // << state->position()[0] << ", " + // << state->position()[1] << ", " + // << state->position()[2] << std::endl; - // Print IMU data - const auto& imu = state->imu_state(); + // // Print IMU data + // const auto& imu = state->imu_state(); - std::cout << "IMU Quaternion: " - << imu.quaternion()[0] << ", " - << imu.quaternion()[1] << ", " - << imu.quaternion()[2] << ", " - << imu.quaternion()[3] << std::endl; + // std::cout << "IMU Quaternion: " + // << imu.quaternion()[0] << ", " + // << imu.quaternion()[1] << ", " + // << imu.quaternion()[2] << ", " + // << imu.quaternion()[3] << std::endl; - std::cout << "IMU Gyroscope: " - << imu.gyroscope()[0] << ", " - << imu.gyroscope()[1] << ", " - << imu.gyroscope()[2] << std::endl; + // std::cout << "IMU Gyroscope: " + // << imu.gyroscope()[0] << ", " + // << imu.gyroscope()[1] << ", " + // << imu.gyroscope()[2] << std::endl; - std::cout << "IMU Accelerometer: " - << imu.accelerometer()[0] << ", " - << imu.accelerometer()[1] << ", " - << imu.accelerometer()[2] << std::endl; + // std::cout << "IMU Accelerometer: " + // << imu.accelerometer()[0] << ", " + // << imu.accelerometer()[1] << ", " + // << imu.accelerometer()[2] << std::endl; - std::cout << "IMU RPY: " - << imu.rpy()[0] << ", " - << imu.rpy()[1] << ", " - << imu.rpy()[2] << std::endl; + // std::cout << "IMU RPY: " + // << imu.rpy()[0] << ", " + // << imu.rpy()[1] << ", " + // << imu.rpy()[2] << std::endl; - std::cout << "IMU Temperature: " << imu.temperature() << std::endl; - std::cout << "---" << std::endl; + // std::cout << "IMU Temperature: " << imu.temperature() << std::endl; + // std::cout << "---" << std::endl; } void Monitor::odometryCallback(const void* message) {