From a919c5b7f70e05ac29f7a8db7dffd02004c7fddc Mon Sep 17 00:00:00 2001
From: Sem van der Hoeven <semmer99@gmail.com>
Date: Mon, 1 May 2023 15:52:38 +0200
Subject: [PATCH] add test

---
 src/px4_connection/src/px4_controller.cpp | 10 ++++++++++
 1 file changed, 10 insertions(+)

diff --git a/src/px4_connection/src/px4_controller.cpp b/src/px4_connection/src/px4_controller.cpp
index 31b34f11..f7e2cdae 100644
--- a/src/px4_connection/src/px4_controller.cpp
+++ b/src/px4_connection/src/px4_controller.cpp
@@ -30,6 +30,15 @@ using namespace std::placeholders;
 class PX4Controller : public rclcpp::Node
 {
 public:
+
+    void yeet(
+        const std::shared_ptr<px4_connection::srv::SetAttitude::Request> request,
+        const std::shared_ptr<px4_connection::srv::SetAttitude::Response> response)
+    {
+
+
+    }
+
     PX4Controller() : Node("px4_controller")
     {
         // create a publisher on the vehicle attitude setpoint topic
@@ -38,6 +47,7 @@ public:
         trajectory_setpoint_publisher = this->create_publisher<px4_msgs::msg::TrajectorySetpoint>("/fmu/in/trajectory_setpoint", 10);
         // offboard_control_mode_publisher_ = this->create_publisher<px4_msgs::msg::OffboardControlMode>("/fmu/in/offboard_control_mode", 10);
 
+        set_attitude_service_ = this->create_service<px4_connection::srv::SetAttitude>("set_attitude", &yeet);
         // set_attitude_service_ = this->create_service<px4_connection::srv::SetAttitude>("set_attitude", std::bind(&PX4Controller::set_setpoint, this, _1, _2, _3));
 
         //         service_ptr_ = this->create_service<std_srvs::srv::Empty>(