from iqdbc.car import get_safety_config, structs
from iqdbc.car.interfaces import CarInterfaceBase
from iqdbc.car.byd.carcontroller import CarController
from iqdbc.car.byd.carstate import CarState
from iqdbc.car.byd.values import BydSafetyFlags


class CarInterface(CarInterfaceBase):
  CarState = CarState
  CarController = CarController

  @staticmethod
  def _get_params(ret: structs.CarParams, candidate, fingerprint, car_fw, alpha_long, is_release, docs) -> structs.CarParams:
    ret.brand = "byd"

    ret.safetyConfigs = [get_safety_config(structs.CarParams.SafetyModel.byd)]

    ret.steerControlType = structs.CarParams.SteerControlType.angle
    ret.steerActuatorDelay = 0.1
    ret.steerLimitTimer = 0.4

    # the Veoneer tracks live on a private CAN-FD pair that the BYD-6 harness jumpers straight
    # through, so the panda never sees them
    ret.radarUnavailable = True

    ret.alphaLongitudinalAvailable = True
    if alpha_long:
      ret.openpilotLongitudinalControl = True
      ret.safetyConfigs[0].safetyParam |= BydSafetyFlags.LONG_CONTROL.value

      ret.longitudinalActuatorDelay = 0.5  # the IPB closes its own loop
      ret.vEgoStarting = 0.3
      ret.stopAccel = -0.5
      ret.startAccel = 1.5
      # without this longcontrol goes stopping -> pid directly and neither the startAccel kick
      # nor the STANDSTILL_RESUME pulse ever fires
      ret.startingState = True

      # ACCEL_CMD is feedforward; high feedback gain on a 0.5s-lag actuator winds up the
      # integrator before the car responds
      ret.longitudinalTuning.kpBP = [0.0, 5.0, 35.0]
      ret.longitudinalTuning.kpV = [0.5, 0.4, 0.3]
      ret.longitudinalTuning.kiBP = [0.0, 35.0]
      ret.longitudinalTuning.kiV = [0.03, 0.02]

    return ret

  @staticmethod
  def _get_params_iq(stock_cp: structs.CarParams, ret: structs.IQCarParams, candidate, fingerprint,
                     car_fw, alpha_long: bool, is_release_iq: bool, docs: bool) -> structs.IQCarParams:
    if stock_cp.openpilotLongitudinalControl:
      ret.longitudinalStoppingSpeedOverride = 0.3

    return ret