Cleaning up unused code
Need less NOPs since MCU is slower