added debug informations
reimplemented visualization marker callback