Skip to content

Commit

Permalink
Update Shooter.kt
Browse files Browse the repository at this point in the history
  • Loading branch information
NeonCoal committed Jan 17, 2024
1 parent d29adaf commit 525a6cd
Showing 1 changed file with 5 additions and 5 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -18,11 +18,11 @@ import org.team4099.lib.units.perSecond
class Shooter (val io: ShooterIO){
val inputs = ShooterIO.ShooterIOInputs()
//TODO do feedforward
<<<<<<< HEAD

private var wristFeedforward: SimpleMotorFeedforward<Meter, Volt>
=======

private var WristFeedforward: SimpleMotorFeedforward<Meter, Volt>(kS,kV,kA)
>>>>>>> 829a07586e50bf71782342ae9623c560237b502b
// >>>>>>> 829a07586e50bf71782342ae9623c560237b502b

/*
private val wristflywheelkP =
Expand Down Expand Up @@ -67,7 +67,7 @@ class Shooter (val io: ShooterIO){
)
private var wristProfile =
TrapezoidProfile(
wristConstraints,
TrapezoidProfile.Constraints,
TrapezoidProfile.State(-1337.radians, -1337.radians.perSecond),
TrapezoidProfile.State(-1337.radians, -1337.radians.perSecond)
)
Expand Down Expand Up @@ -103,7 +103,7 @@ fun periodic(){
if (wristPositionTarget!=lastWristPositionTarget){
val preProfileGenerate = Clock.fpgaTime
wristProfile = TrapezoidProfile(
wristConstraints,
TrapezoidProfile.Constraints,
TrapezoidProfile.State(wristPositionTarget, 0.0.radians.perSecond),
TrapezoidProfile.State(inputs.wristPostion, inputs.wristVelocity)
)
Expand Down

0 comments on commit 525a6cd

Please sign in to comment.