Cleaned up the code, got the boost voltage monitor/feedback loop working