SSE2 optimization added, bug corrected
SSE2 optimization added, bug corrected