PostScrimmageBot/Commands/Autonomous/TiltToAngle.cpp
void TiltToAngle::Execute() {

	if(turhop->GetTiltAngle() > desiredAngle)
			{turhop->AltitudeControl(-0.85);}
		else if(turhop->GetTiltAngle() < desiredAngle)
			{turhop->AltitudeControl(0.85);}
	
	SmartDashboard::PutNumber("Tilt Angle", turhop->GetTiltAngle());
	SmartDashboard::PutNumber("Potentiometer", turhop->GetPotAngle());
}
// Called repeatedly when this Command is scheduled to run
Called repeatedly when this Command is scheduled to run
Called repeatedly when this Command is scheduled to run
void TiltToAngle::Execute() {
	if(turhop->GetTiltAngle() > desiredAngle)
			{turhop->AltitudeControl(-0.85);}
		else if(turhop->GetTiltAngle() < desiredAngle)
			{turhop->AltitudeControl(0.85);}
	SmartDashboard::PutNumber("Tilt Angle", turhop->GetTiltAngle());
	SmartDashboard::PutNumber("Potentiometer", turhop->GetPotAngle());
}
void TiltToAngle :: Execute ( ) { if ( turhop -> GetTiltAngle ( ) > desiredAngle ) { turhop -> AltitudeControl ( -0.85 ) ; } else if ( turhop -> GetTiltAngle ( ) < desiredAngle ) { turhop -> AltitudeControl ( 0.85 ) ; } SmartDashboard :: PutNumber ( " " , turhop -> GetTiltAngle ( ) ) ; SmartDashboard :: PutNumber ( " " , turhop -> GetPotAngle ( ) ) ; }
Called repeatedly when this Command is scheduled to run
Called repeatedly when this Command is scheduled to run