A 6-DOF Artag-based Tracking System