Adjusted some errors with register names, added in a function call for delay, and called timer interrupt for 5ms delay