[fix] Multiple fixes on tworld getters

Tong Furequested to merge
fix/FixForTworld into master
  • Check LogStates before basic tasks
  • Fix GetTworld and InitTworldWithPoseMeasurement functions that was not performing as expected when external sensor info are available
Edited by Julia Sanchez

Merge request reports