Refactored visualization_tools, added better support for baxter left arm