Skip to content

Commit

Permalink
put field under smartdashboard
Browse files Browse the repository at this point in the history
  • Loading branch information
jpothen8 committed Jan 20, 2025
1 parent da2bf9e commit 526cbd8
Showing 1 changed file with 3 additions and 5 deletions.
8 changes: 3 additions & 5 deletions src/main/kotlin/frc/team449/RobotLoop.kt
Original file line number Diff line number Diff line change
Expand Up @@ -3,7 +3,6 @@ package frc.team449
import com.ctre.phoenix6.SignalLogger
import dev.doglog.DogLog
import dev.doglog.DogLogOptions
import edu.wpi.first.epilogue.Logged
import edu.wpi.first.hal.FRCNetComm
import edu.wpi.first.hal.HAL
import edu.wpi.first.math.util.Units
Expand All @@ -29,14 +28,12 @@ import kotlin.jvm.optionals.getOrNull

/** The main class of the robot, constructs all the subsystems
* and initializes default commands . */
@Logged(name = "Robot2025")
class RobotLoop : TimedRobot() {

private val robot = Robot()

private val routineChooser: RoutineChooser = RoutineChooser(robot)

private val field = robot.field
private var autoCommand: Command? = null
private var routineMap = hashMapOf<String, Command>()
private val controllerBinder = ControllerBindings(robot.driveController, robot.mechController, robot)
Expand Down Expand Up @@ -85,6 +82,9 @@ class RobotLoop : TimedRobot() {

DogLog.setPdh(robot.powerDistribution)

SmartDashboard.putData("Field", robot.field)
SmartDashboard.putData("Elevator + Pivot Visual", robot.elevator.mech)

URCL.start()
}

Expand All @@ -107,8 +107,6 @@ class RobotLoop : TimedRobot() {
robot.elevator.desiredElevatorLigament.angle = Units.radiansToDegrees(robot.pivot.targetSupplier.get())

robot.elevator.wristLigament.angle = Units.radiansToDegrees(robot.wrist.positionSupplier.get())

SmartDashboard.putData("Elevator + Pivot Visual", robot.elevator.mech)
}

override fun autonomousInit() {
Expand Down

0 comments on commit 526cbd8

Please sign in to comment.