Improved the initialize_haptic_device script
Changed the omni_state node to work with a more intuitive XYZ frame.