fixed hot goal

hot goal waits, then goes once it sees two vision targets, or emergancy
shoots at 6 seconds
fixed prints for smartdashboard and LEDs for shooter lights