changed printf to ros info/debug
added option to enable height checking - turned off by default