Stageprofi patch

Completes https://github.com/ipa320/cob_driver/pull/172 , that was merged too soon.