ISR and main code now working. ISR period slowed to 2000