diff options
Diffstat (limited to 'src/main.cpp')
| -rw-r--r-- | src/main.cpp | 9 |
1 files changed, 9 insertions, 0 deletions
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 ----- */ |