In the middle of added a debug option on the SmartDashboard