public VectorPID(double kP, double kI, double kD, double integralDecayRatio, double timeStep)
{
X = new PID(kP, kI, kD, integralDecayRatio, timeStep);
Y = new PID(kP, kI, kD, integralDecayRatio, timeStep);
Z = new PID(kP, kI, kD, integralDecayRatio, timeStep);
}
public VectorPID(double kP, double kI, double kD, double lowerBound, double upperBound, double timeStep)
{
X = new PID(kP, kI, kD, lowerBound, upperBound, timeStep);
Y = new PID(kP, kI, kD, lowerBound, upperBound, timeStep);
Z = new PID(kP, kI, kD, lowerBound, upperBound, timeStep);
}