Adds C code

Adds c code, updates pseudocode.