Merged all C code into single directory (pre-LCD test)