Fiducial Based Pose Tracking of a rigid body