Added world, robot parameters, robot power functions