diff --git a/drone_sensors/src/height_sensor.cpp b/drone_sensors/src/height_sensor.cpp index 2c3a7c63..39ba2ded 100644 --- a/drone_sensors/src/height_sensor.cpp +++ b/drone_sensors/src/height_sensor.cpp @@ -55,6 +55,11 @@ class HeightSensorPublisher : public rclcpp::Node serial_port.close(); } + + void test() + { + RCLCPP_INFO(this->get_logger(), "Je moeder is een plopkoek"); + } rclcpp::TimerBase::SharedPtr timer_; rclcpp::Publisher::SharedPtr publisher_; std::fstream serial_port; // serial port for reading from device @@ -63,7 +68,13 @@ class HeightSensorPublisher : public rclcpp::Node int main(int argc, char *argv[]) { rclcpp::init(argc,argv); - rclcpp::spin(std::make_shared()); + + rclcpp::executors::SingleThreadedExecutor executor; + auto node = std::make_shared(); + node.get()->setup_serial_port(); + executor.add_node(node); + executor.spin(); + // rclcpp::spin(std::make_shared()); rclcpp::shutdown(); return 0;