Committed working version of most of the code
Updated readme's and C files