Change constant manager to only save if constants have changed

- Remove some unnecesary imports
- Change auto modes to use different commands for moving the shooter
Add DEBUG_MODE flag and send the Scheduler to SmartDashboard if in DEBUG_MODE