Fixed and working

Fixed code, got it working, optimised to SSE2 and some other VC++
optimisations. Updated readme files.