This code (while usable) is in need of some improvements 
(malloc instead of fixed memory size , etc)
There are several quick improvements that can be made; if you implement any,
please let me know, I'll happilly pull changes