Latest code; more tweaking hardcoded values

Also updated InterruptTest to toggle LEDs for checking on oscilloscope.