Code ready to be compiled and tested on the fpga. Waveforms look good