Finish Pose Evaluation in cpp
Pose Estimation Code is moved to C++ TODO: Handle different Markers and use tf2 channel implement quaternion averaging
Pose Estimation Code is moved to C++ TODO: Handle different Markers and use tf2 channel implement quaternion averaging