|
1 | | -export const getImports = () => `import com.thriftyrobotics.nova.hardware.ThriftyNova; |
2 | | -import com.thriftyrobotics.nova.hardware.ThriftyEncoder; |
3 | | -import com.thriftyrobotics.nova.controller.PIDController; |
4 | | -import com.thriftyrobotics.nova.controller.ControlMode; |
5 | | -import com.thriftyrobotics.nova.controller.NeutralMode;` |
| 1 | +export const getImports = () => `import com.thriftybot.devices.ThriftyNova;` |
6 | 2 |
|
7 | | -export const getDeclaration = () => `private final ThriftyNova motor; |
8 | | -private final ThriftyEncoder encoder; |
9 | | -private final PIDController pidController;` |
| 3 | +export const getDeclaration = () => `private final ThriftyNova motor;` |
10 | 4 |
|
11 | 5 | export const getInitialization = () => `motor = new ThriftyNova(canID); |
12 | 6 |
|
13 | 7 | // Configure motor |
14 | | -motor.setNeutralMode(brakeMode ? NeutralMode.BRAKE : NeutralMode.COAST); |
15 | | -
|
16 | | -// Configure encoder |
17 | | -encoder = motor.getEncoder(); |
18 | | -encoder.setPosition(0); |
| 8 | +motor.setBrakeMode(brakeMode); |
19 | 9 |
|
20 | 10 | // Configure PID controller |
21 | 11 | pidController = motor.getPIDController(); |
@@ -46,9 +36,9 @@ export const getPeriodic = () => `` |
46 | 36 | export const getSimulationPeriodic = () => `` |
47 | 37 |
|
48 | 38 | export const getMethods = () => ({ |
49 | | - getPositionMethod: `return encoder.getPosition() / gearRatio;`, |
| 39 | + getPositionMethod: `return encoder.getPositionQuad() / gearRatio;`, |
50 | 40 |
|
51 | | - getVelocityMethod: `return encoder.getVelocity() / gearRatio;`, |
| 41 | + getVelocityMethod: `return encoder.getVelocityQuad() / gearRatio;`, |
52 | 42 |
|
53 | 43 | setPositionMethod: `double adjustedPosition = position * gearRatio; |
54 | 44 | double ffVolts = feedforward.calculate(getVelocity(), acceleration); |
|
0 commit comments