This code uses semtex.c[1] as a reference.

[1] http://packetstormsecurity.com/files/121616/semtex.c