SAD algorithm and functional unit