Added an SSE 4.1 optimized version