Oups

11 years ago · e757787776
1 changed files with 2 additions and 2 deletions
--- a/src/normal_estimator-pca.cpp
+++ b/src/normal_estimator-pca.cpp
@ -55,8 +55,8 @@ class Callback {
      
      //h = altitude(msg);
      th = 
-            2 * atan (eg(2,1)
-                       /(1 + eg(1,1)));
+            2 * atan (eg(1,0)
+                       /(1 + eg(0,0)));

      // publication
      ROS_INFO("Plan published");