Added smartdashboard logic for reverse mode
SmartDashboard fixes, reverse and slow mode fixes, printf changes