Inintial verison of fake orientation #22

szenergy · May 23, 2022 · c3a2d74 · c3a2d74
1 parent 919dd63
commit c3a2d74
Show file tree

Hide file tree

Showing 4 changed files with 248 additions and 121 deletions.
diff --git a/CMakeLists.txt b/CMakeLists.txt
@@ -69,7 +69,7 @@ link_directories("/usr/local/lib/")
 ## Declare a C++ executable
 ## With catkin_make all packages are built within a single CMake context
 ## The recommended prefix ensures that target names across packages don't collide
-add_executable(duronode src/duro.cpp src/utm.cpp)
+add_executable(duronode src/duro.cpp src/utm.cpp src/fake_orientation.cpp)
 #add_executable(libsbp_tcp_example src/tcp_example.c)
 
 ## Rename C++ executable without prefix

diff --git a/include/fake_orientation.hpp b/include/fake_orientation.hpp
@@ -0,0 +1,23 @@
+#ifndef FAKE_ORI_HPP
+#define FAKE_ORI_HPP
+#include <vector>
+#include <iostream>
+
+
+class FakeOri{
+  public:  
+    double fake_orientation;
+    int status;
+    std::vector <double> x_vect;
+    std::vector <double> y_vect;
+    std::vector <double> ori_vect;
+    void addXY(double x, double y);
+    void setStatus(int fix_mode);
+    void printAll();
+    double calcOrientation(int p1, int p2) const;
+    double getDistance() const;
+    double getOri() const;
+
+};
+
+#endif