Registering of init functions now use the new mechanism

Also, don't subscribe to topics we don't need (i.e. `/collision_objects`).