5
5
6
6
/** Feedback controller config. */
7
7
public record FeedbackControllerConfig (
8
- double kP ,
9
- double kI ,
10
- double kD ,
11
- boolean continuous ,
12
- double positionTolerance ,
13
- double velocityTolerance ) {
8
+ double kP , double kI , double kD , boolean continuous , double tolerance , double rateTolerance ) {
14
9
15
10
public FeedbackControllerConfig {
16
11
Objects .requireNonNull (kP );
17
12
Objects .requireNonNull (kI );
18
13
Objects .requireNonNull (kD );
19
14
Objects .requireNonNull (continuous );
20
- Objects .requireNonNull (positionTolerance );
21
- Objects .requireNonNull (velocityTolerance );
15
+ Objects .requireNonNull (tolerance );
16
+ Objects .requireNonNull (rateTolerance );
22
17
}
23
18
24
19
public static final class FeedbackControllerConfigBuilder {
@@ -30,9 +25,9 @@ public static final class FeedbackControllerConfigBuilder {
30
25
31
26
private boolean continuous ;
32
27
33
- private double positionTolerance ;
28
+ private double tolerance ;
34
29
35
- private double velocityTolerance ;
30
+ private double rateTolerance ;
36
31
37
32
public static FeedbackControllerConfigBuilder defaults () {
38
33
return new FeedbackControllerConfigBuilder (0.0 , 0.0 , 0.0 , false , 0.0 , 0.0 );
@@ -45,23 +40,23 @@ public static FeedbackControllerConfigBuilder from(
45
40
feedbackControllerConfig .kI ,
46
41
feedbackControllerConfig .kD ,
47
42
feedbackControllerConfig .continuous ,
48
- feedbackControllerConfig .positionTolerance ,
49
- feedbackControllerConfig .velocityTolerance );
43
+ feedbackControllerConfig .tolerance ,
44
+ feedbackControllerConfig .rateTolerance );
50
45
}
51
46
52
47
private FeedbackControllerConfigBuilder (
53
48
double kP ,
54
49
double kI ,
55
50
double kD ,
56
51
boolean continuous ,
57
- double positionTolerance ,
58
- double velocityTolerance ) {
52
+ double tolerance ,
53
+ double rateTolerance ) {
59
54
this .kP = kP ;
60
55
this .kI = kI ;
61
56
this .kD = kD ;
62
57
this .continuous = continuous ;
63
- this .positionTolerance = positionTolerance ;
64
- this .velocityTolerance = velocityTolerance ;
58
+ this .tolerance = tolerance ;
59
+ this .rateTolerance = rateTolerance ;
65
60
}
66
61
67
62
public FeedbackControllerConfigBuilder kP (double kP ) {
@@ -84,19 +79,18 @@ public FeedbackControllerConfigBuilder continuous(boolean continuous) {
84
79
return this ;
85
80
}
86
81
87
- public FeedbackControllerConfigBuilder positionTolerance (double positionTolerance ) {
88
- this .positionTolerance = positionTolerance ;
82
+ public FeedbackControllerConfigBuilder tolerance (double tolerance ) {
83
+ this .tolerance = tolerance ;
89
84
return this ;
90
85
}
91
86
92
- public FeedbackControllerConfigBuilder velocityTolerance (double velocityTolerance ) {
93
- this .velocityTolerance = velocityTolerance ;
87
+ public FeedbackControllerConfigBuilder rateTolerance (double rateTolerance ) {
88
+ this .rateTolerance = rateTolerance ;
94
89
return this ;
95
90
}
96
91
97
92
public FeedbackControllerConfig build () {
98
- return new FeedbackControllerConfig (
99
- kP , kI , kD , continuous , positionTolerance , velocityTolerance );
93
+ return new FeedbackControllerConfig (kP , kI , kD , continuous , tolerance , rateTolerance );
100
94
}
101
95
}
102
96
@@ -108,7 +102,7 @@ public FeedbackControllerConfig build() {
108
102
public PIDController createPIDController () {
109
103
final PIDController pidController = new PIDController (kP , kI , kD );
110
104
111
- pidController .setTolerance (positionTolerance , velocityTolerance );
105
+ pidController .setTolerance (tolerance , rateTolerance );
112
106
113
107
if (continuous ) {
114
108
pidController .enableContinuousInput (-0.5 , 0.5 );
0 commit comments