void Print_All()
{
StringBuilder _ms = new StringBuilder();
_ms.Clear();
_ms.Append(" Target Angle=");
_ms.Append(angleSetpoint);
_ms.Append(" Current Angle=");
_ms.Append(scaledUnitsToDegrees(_turret.GetEncPosition()));
_ms.Append(" Target RPM=");
_ms.Append(rpmSetpoint);
_ms.Append(" Current RPM=");
_ms.Append(_shooter.GetSpeed());
Debug.Print(_ms.ToString());
}
void Print_Speed()
{
StringBuilder _ms = new StringBuilder();
_ms.Clear();
_ms.Append(" rpmSetpoint=");
_ms.Append(rpmSetpoint);
_ms.Append("_s.GetSpeed()=");
_ms.Append(_shooter.GetSpeed());
_ms.Append(" _s.GetEncPosition()=");
_ms.Append(_shooter.GetEncPosition());
_ms.Append(" _s.GetEncVel()=");
_ms.Append(_shooter.GetEncVel());
Debug.Print(_ms.ToString());
}