renaming change_reference_frame_ to less confusing keep_reference_frame_
improved tf handling
Merged last changes from develop, closes #10.