Head Shoulder detection using depth camera with my own algorithm