New h and cpp file for Robot cleaning position