Skip to content

Commit 607da1e

Browse files
The ending of somethign beautiful
1 parent d7fd4db commit 607da1e

3 files changed

Lines changed: 12 additions & 3 deletions

File tree

src/main/kotlin/com/team4099/robot2026/commands/drivetrain/TeleopDriveCommand.kt

Lines changed: 8 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -37,9 +37,14 @@ class TeleopDriveCommand(
3737
CustomLogger.recordOutput("ActiveCommands/speedYinMPS", speed.second.inMetersPerSecond)
3838
CustomLogger.recordOutput("ActiveCommands/rotationInDPS", rotation.inDegreesPerSecond)
3939

40-
drivetrain.runSpeeds(
41-
ChassisSpeeds.fromFieldRelativeSpeeds(
42-
speed.first, speed.second, rotation, drivetrain.pose.rotation))
40+
if (driver.fieldRelativeControls){
41+
drivetrain.runSpeeds(
42+
ChassisSpeeds.fromFieldRelativeSpeeds(
43+
speed.first, speed.second, rotation, drivetrain.pose.rotation))
44+
} else{
45+
drivetrain.runSpeeds(
46+
speed.first, speed.second, rotation)
47+
}
4348

4449
CustomLogger.recordDebugOutput("ActiveCommands/TeleopDriveCommand", true)
4550
}

src/main/kotlin/com/team4099/robot2026/util/driver/DriverProfile.kt

Lines changed: 1 addition & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -15,6 +15,7 @@ abstract class DriverProfile(
1515
private val sensitivityRotationPowerConstant: Int,
1616
private val driveSlowModeClamp: Double = 0.75,
1717
private val turnSlowModeClamp: Double = 0.75
18+
private val fieldRelativeControls: Boolean = true
1819
) {
1920
private val invertDriveMultiplier = if (invertDrive) -1 else 1
2021
private val invertRotationMultiplier = if (invertRotation) -1 else 1
Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,3 @@
1+
package com.team4099.robot2026.util.driver
2+
3+
class Omkar : DriverProfile(false, true, 2, 2, false)

0 commit comments

Comments
 (0)