TimeCrafters/FTC_2022
1
0
Fork 0
mirror of https://github.com/TimeCrafters/FTC_2022 synced 2025-12-15 16:42:35 +00:00
Code Issues Packages Projects Releases Wiki Activity

Minor corrections

Browse Source
This commit is contained in:
Cyberarm
2023-01-21 21:14:13 -06:00
parent 977a90eb48
commit d70f1e87a1
3 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/chiron/Robot.java
View File

@@ -62,7 +62,7 @@ public class Robot {
this.fieldLocalizer.standardSetup();
radius = tuningConfig("field_localizer_robot_radius").value();
diameter = ((double)tuningConfig("field_localizer_robot_radius").value()) * 2;
diameter = radius * 2;
imuAngleOffset = hardwareConfig("imu_angle_offset").value();

12
TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/chiron/tasks/FieldLocalizer.java
View File

@@ -22,7 +22,7 @@ public class FieldLocalizer extends CyberarmState {
private final double twoSqrtTwo = 2.0 / Math.sqrt(2.0);
private double wheelDisplacementPerEncoderTick = 1; // FIXME
private double wheelDisplacementPerEncoderTickInInches = 1; // FIXME
// Use this constructor to preserve displacement between opmodes
public FieldLocalizer() {
@@ -63,7 +63,7 @@ public class FieldLocalizer extends CyberarmState {
deltaXRotation = 0;
deltaYRotation = 0;
// Preserve field position, of argument-less construction is used
// Preserve field position, if argument-less constructor is used
lastX = FieldLocalizer.posX;
lastY = FieldLocalizer.posY;
@@ -106,10 +106,10 @@ public class FieldLocalizer extends CyberarmState {
deltaBackLeft = robot.backLeftDrive.getCurrentPosition() - lastBackLeft;
deltaBackRight = robot.backRightDrive.getCurrentPosition() - lastBackRight;
displacementFrontLeft = deltaFrontLeft * wheelDisplacementPerEncoderTick;
displacementFrontRight = deltaFrontRight * wheelDisplacementPerEncoderTick;
displacementBackLeft = deltaBackLeft * wheelDisplacementPerEncoderTick;
displacementBackRight = deltaBackRight * wheelDisplacementPerEncoderTick;
displacementFrontLeft = deltaFrontLeft * wheelDisplacementPerEncoderTickInInches;
displacementFrontRight = deltaFrontRight * wheelDisplacementPerEncoderTickInInches;
displacementBackLeft = deltaBackLeft * wheelDisplacementPerEncoderTickInInches;
displacementBackRight = deltaBackRight * wheelDisplacementPerEncoderTickInInches;
displacementAverage = (displacementFrontLeft + displacementFrontRight +
displacementBackLeft + displacementBackRight) / 4.0; // motor count

2
TeamCode/src/main/java/org/timecrafters/minibots/cyberarm/chiron/tasks/field_localizer/Field.java
View File

@@ -15,7 +15,7 @@ public class Field {
}
private void populateField() {
// ORIGIN is field CENTER point with RED alliance on the RIGHT
// ORIGIN is field CENTER point with RED alliance on the RIGHT (i.e. Audience overhead perspective)
// Ground Junctions
double posX = -48;