cone mid alomst done

This commit is contained in:
Aarav
2023-03-23 18:18:58 -06:00
parent 357adf860b
commit 4e922e5f35
3 changed files with 30 additions and 25 deletions
@@ -8,6 +8,7 @@ import com.ctre.phoenix.sensors.CANCoder;
import com.ctre.phoenix.sensors.CANCoderConfiguration;
import frc4388.robot.Constants.ArmConstants;
import frc4388.utility.DeferredBlock;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Arm extends SubsystemBase {
@@ -146,6 +147,9 @@ public class Arm extends SubsystemBase {
tele_reset = true;
}
SmartDashboard.putNumber("Pivot CANCoder", getArmRotation());
SmartDashboard.putNumber("Tele Encoder", getArmLength());
// double x = Math.cos(Math.toRadians(degrees));
}