Set visibility to true in KB only once
Do not future date.

This causes extrapolation errors with TF
Split detect.cpp into a 'lib' and a main

For future implementation of a nodelet version
Added support for nodelets