Cleanup; remove dead code
Add aruco marker-creation utility
Apply translation compensation for yaw/pitch