commit before starting to implement local transform + topop frame. Note: currently there seems to be an issue when sending topoNavGoals: the goal is not always reached and transform not found errors are thrown...