update drivers
This commit is contained in:
@@ -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();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user