More logs, changed parameters in order to record data, all reversible
Merge branch 'master' of ssh://github.com/ipab-rad/Youbot-RVO
Many more logs, treasure them
Fixed method with which to calculate magnitude difference between vectors, added moving average of goal inference sum for faster reaquisition of goal belief, added moving average for observed velocities to select preferred and maximum velocities, increased default acceleration which helps goal disambiguation, added CLEAR macro to clear the console, changed simulation defaults to normal rather than people values