general commit
toggling code simplified
Adding in PID Shooter and TestBot code