added some new libraries and changed main robot control