Added Animation to Pusher robot
Moved some stuff into folders