From fb4b8328bfa5a8930b87ec8b7465b8032f4873c5 Mon Sep 17 00:00:00 2001
From: Martin Miller
Date: Tue, 28 Mar 2017 10:06:47 -0500
Subject: move aboveWater () back to main

---
 src/main.cpp | 9 +++++++++
 1 file changed, 9 insertions(+)

(limited to 'src/main.cpp')

diff --git a/src/main.cpp b/src/main.cpp
index 4e61484..62d2560 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -27,6 +27,15 @@ using std::cout;
 using std::endl;
 using std::cerr;
 
+double 
+aboveWater(const Quaterniond &q)
+{
+    Vector3d tip;
+    tip << 0.65*3.43, 0, -0.60;
+    tip = q._transformVector(tip);
+    return tip[2];
+}
+
 #ifdef  USE_ROS
 
 #else      /* -----  not USE_ROS  ----- */
-- 
cgit v1.1