Catkinize rvo2

Just add RVO2 source files (v 2.0.1) and make it a catkin package rather
than fighting with cmake.