// Called just before this Command runs the first time
protected void initialize() {
HardwareAdapter.GyroPID.setPID(Constants.kGyroKp, Constants.kGyroKi, Constants.kGyroKd);
if (m_angle > 0) {
HardwareAdapter.LeftDriveEncoderPID.setSetpoint(m_clicks + HardwareAdapter.getLeftDriveEnc());
} else {
HardwareAdapter.RightDriveEncoderPID.setSetpoint(
m_clicks + HardwareAdapter.getRightDriveEnc());
}
HardwareAdapter.GyroPID.setSetpoint(HardwareAdapter.kSpartanGyro.getAngle() + m_angle);
}
