src/types.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29

/*
 * =====================================================================================
 *
 *       Filename:  types.cpp
 *
 *    Description:  
 *
 *        Version:  1.0
 *        Created:  03/27/2017 03:26:51 PM
 *       Revision:  none
 *       Compiler:  gcc
 *
 *         Author:  Martin Miller (MHM), miller7@illinois.edu
 *   Organization:  Aerospace Robotics and Controls Lab (ARC)
 *
 * =====================================================================================
 */


#include "types.h"

double 
aboveWater(const Quaterniond &q)
{
    Vector3d tip;
    tip << 0.65*3.43, 0, -0.60;
    tip = q._transformVector(tip);
    return tip[2];
}