Got code to the point where it recognizes fiducial id.