update drivers

This commit is contained in:
NuoDaJia02
2025-11-21 14:14:24 +08:00
parent 080af2f7fa
commit fac220ccf4
3480 changed files with 833545 additions and 25 deletions

View File

@@ -40,7 +40,7 @@ void QuaternionToRPYDeg(double qw, double qx, double qy, double qz, double &roll
pitch = pitch * 180.0 / 3.1415926;
yaw = yaw * 180.0 / 3.1415926;
// rpy_file<<roll<<","<<pitch<<","<<yaw<<std::endl;
std::cout << "Roll: " << roll << ", Pitch: " << pitch << ", Yaw: " << yaw << std::endl;
// std::cout << "Roll: " << roll << ", Pitch: " << pitch << ", Yaw: " << yaw << std::endl;
}
int main(int argc, char **argv)
@@ -89,5 +89,5 @@ int main(int argc, char **argv)
rclcpp::spin(node);
rclcpp::shutdown();
rpy_file.close();
// rpy_file.close();
}