diff options
| author | Martin Miller | 2017-03-28 10:06:47 -0500 |
|---|---|---|
| committer | Martin Miller | 2017-03-28 10:06:47 -0500 |
| commit | fb4b8328bfa5a8930b87ec8b7465b8032f4873c5 (patch) | |
| tree | f1998951d3b9b10d2feec8423ebec1b85a184a48 /src/main.cpp | |
| parent | 9533fbcda07254b65a53a9109555662d9a09086c (diff) | |
| download | refslam-fb4b8328bfa5a8930b87ec8b7465b8032f4873c5.zip refslam-fb4b8328bfa5a8930b87ec8b7465b8032f4873c5.tar.gz | |
move aboveWater
() back to main
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 ----- */ |