C++ code whitespace fix
Pose Estimation with solvePnP... doens't really work that great yet...
Fix distance / orientation measurement