~4x faster than the C version.

Patch attached.