bit of clean up
Added Cheesy/Tank toggle

Runs in smartdashboard. only checks when robot is entering enabled.