Added goal to peds

Added  destination  to peds, 

In this temporary version peds are walking to their destination 

When a ped is in front of his destination he/she step in.