Added README
Rewrote from C++ to C
Added Makefile