bugfix: Made MultiLevelLaserRangeFinder work with optimization enabled

The error was that a functions with side effects was
called inside of an assert