Client: Moved more AGV code

-Cleaned code
-Removed temporary code
-Moved AGV code to AGV
-Moved Path code to AGV