replace assertion by check...

... to enable checking also when compiled in Release mode.
Included second ros_assert..

thanks @MarkusAchtelik
Merge pull request #5 from ethz-asl/fix/replace_assertion

replace assertion by check...