Robot can execute simple commands + added scaling + made some refactoring