fix color conversion error
move tf publishing in separate thread