replace assertion by check...

... to enable checking also when compiled in Release mode.
Yes this is wrong. You should never put method invocations into asserts.
```
bool init_success = init_vicon();
ROS_ASSERT(init_success);
```