Towards fast fiducial marker with full 6 DOF pose estimation