rigid body position now working with Optitrack.  Commented out marker position parsing.