AGV

Fixed the AGV speed
Fixed the AGV movement