Collision Count and Replan Time added to Logging
Merge branch 'master' of https://github.com/amelim/RIP-2013-Final