Add a function that draws frame axes. Useful for debugging purpose and to check the correctness of the output of a pose estimation method.