Updated C code (WIP)
Updated IP

Updated the IP. It now is <5ns! Still WIP.