RVO (on working)

A try to implement the "Recipropal Velocity Obstacle"

TODO
Adjust the velocity of the agent to proper value

source: http://gamma.cs.unc.edu/RVO/icra2008.pdf