Started Catkin-ization.
Switched to find_package() when possible.