changed topic names,  removed some ROS_INFO prints, magnetometer left in
mGauss (normalized afterwards in Filter)