fixed to work with xtion properly