refactored launch sequence, fixed Joint Names
templated Eigen isometry conversions