Applying fixes and style changes based on feedback by Adolfo

switching to camel-case interface, making RobotSim destructor virtual

fixing new api use, removing unneeded headers