moveit working with hector small arm, but joints not matching right now