rviz camera + gazebo are now not turned 90 degrees anymore. Implemented topo navigation next node passing extension to also check for direct navigability (such that it cannot pick a node that is within threshold, but at other side of wall), although it worked OK, I commented it out again and just decreased the threshold to 1m, which solves it too.