Add last two auton methods on SmartDashboard and correct auton3