Adding of blocks

re-Adds the block once the first fiducial is seen again.