Pipe feedforward into drive view factory
This commit is contained in:
@ -2,6 +2,7 @@ package org.firstinspires.ftc.teamcode.tuning;
|
|||||||
|
|
||||||
import com.acmerobotics.dashboard.FtcDashboard;
|
import com.acmerobotics.dashboard.FtcDashboard;
|
||||||
import com.acmerobotics.dashboard.config.reflection.ReflectionConfig;
|
import com.acmerobotics.dashboard.config.reflection.ReflectionConfig;
|
||||||
|
import com.acmerobotics.roadrunner.MotorFeedforward;
|
||||||
import com.acmerobotics.roadrunner.Pose2d;
|
import com.acmerobotics.roadrunner.Pose2d;
|
||||||
import com.acmerobotics.roadrunner.ftc.AngularRampLogger;
|
import com.acmerobotics.roadrunner.ftc.AngularRampLogger;
|
||||||
import com.acmerobotics.roadrunner.ftc.DriveType;
|
import com.acmerobotics.roadrunner.ftc.DriveType;
|
||||||
@ -96,7 +97,9 @@ public final class TuningOpModes {
|
|||||||
perpEncs,
|
perpEncs,
|
||||||
md.imu,
|
md.imu,
|
||||||
md.voltageSensor,
|
md.voltageSensor,
|
||||||
md.feedforward
|
new MotorFeedforward(MecanumDrive.PARAMS.kS,
|
||||||
|
MecanumDrive.PARAMS.kV / MecanumDrive.PARAMS.inPerTick,
|
||||||
|
MecanumDrive.PARAMS.kA / MecanumDrive.PARAMS.inPerTick)
|
||||||
);
|
);
|
||||||
};
|
};
|
||||||
} else if (DRIVE_CLASS.equals(TankDrive.class)) {
|
} else if (DRIVE_CLASS.equals(TankDrive.class)) {
|
||||||
@ -137,7 +140,9 @@ public final class TuningOpModes {
|
|||||||
perpEncs,
|
perpEncs,
|
||||||
td.imu,
|
td.imu,
|
||||||
td.voltageSensor,
|
td.voltageSensor,
|
||||||
td.feedforward
|
new MotorFeedforward(TankDrive.PARAMS.kS,
|
||||||
|
TankDrive.PARAMS.kV / TankDrive.PARAMS.inPerTick,
|
||||||
|
TankDrive.PARAMS.kA / TankDrive.PARAMS.inPerTick)
|
||||||
);
|
);
|
||||||
};
|
};
|
||||||
} else {
|
} else {
|
||||||
|
Reference in New Issue
Block a user