Nearly B functionality (Button 1 does not reset, odd), but everything else works
B Functionality Achieved. Fixed problem with control var being set in ISR