diff --git a/lib/systems/include/CASESystem.tpp b/lib/systems/include/CASESystem.tpp index 38f914700..53eef4232 100644 --- a/lib/systems/include/CASESystem.tpp +++ b/lib/systems/include/CASESystem.tpp @@ -62,6 +62,8 @@ DrivetrainCommand_s CASESystem::evaluate( in.usePIDPowerLimit = config_.usePIDPowerLimit; in.useLaunch = config_.useLaunch; + in.TCSVelThreshold = config_.tcsVelThreshold; + in.Vy_B = vn_data.velocity_y; in.YawPIDConfig[0] = config_.yaw_pid_p;