Stageprofi patch

Fixes errors from https://github.com/ipa320/cob_driver/pull/172