A ROS 2 version for TJU-YOPO-Simple

The Controller/src/utils directory contains C++ and message utilities required by other components. Build it first within the Controller workspace:
cd Controller
colcon build --packages-select utils --symlink-installcd Controller
colcon buildcd Simulator
colcon build Open three separate terminals to run the full system:
cd Controller
source install/setup.bash
ros2 launch so3_quadrotor_simulator simulator_attitude_control.launch.pycd Simulator
source install/setup.bash
ros2 run sensor_simulator sensor_simulator_cudacd YOPO
# Source Controller to access quadrotor_msgs
source ~/Controller/install/setup.bash
python3 test_yopo_ros.py