drivers/accel/ivpu/ivpu_hw_40xx.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2020-2023 Intel Corporation
   4  */
   5
   6 #include "ivpu_drv.h"
   7 #include "ivpu_fw.h"
   8 #include "ivpu_hw.h"
   9 #include "ivpu_hw_40xx_reg.h"
  10 #include "ivpu_hw_reg_io.h"
  11 #include "ivpu_ipc.h"
  12 #include "ivpu_mmu.h"
  13 #include "ivpu_pm.h"
  14
  15 #include <linux/dmi.h>
  16
  17 #define TILE_MAX_NUM                 6
  18 #define TILE_MAX_MASK                0x3f
  19
  20 #define LNL_HW_ID                    0x4040
  21
  22 #define SKU_TILE_SHIFT               0u
  23 #define SKU_TILE_MASK                0x0000ffffu
  24 #define SKU_HW_ID_SHIFT              16u
  25 #define SKU_HW_ID_MASK               0xffff0000u
  26
  27 #define PLL_CONFIG_DEFAULT           0x1
  28 #define PLL_CDYN_DEFAULT             0x80
  29 #define PLL_EPP_DEFAULT              0x80
  30 #define PLL_REF_CLK_FREQ             (50 * 1000000)
  31 #define PLL_RATIO_TO_FREQ(x)         ((x) * PLL_REF_CLK_FREQ)
  32
  33 #define PLL_PROFILING_FREQ_DEFAULT   38400000
  34 #define PLL_PROFILING_FREQ_HIGH      400000000
  35
  36 #define TIM_SAFE_ENABLE              0xf1d0dead
  37 #define TIM_WATCHDOG_RESET_VALUE     0xffffffff
  38
  39 #define TIMEOUT_US                   (150 * USEC_PER_MSEC)
  40 #define PWR_ISLAND_STATUS_TIMEOUT_US (5 * USEC_PER_MSEC)
  41 #define PLL_TIMEOUT_US               (1500 * USEC_PER_MSEC)
  42
  43 #define WEIGHTS_DEFAULT              0xf711f711u
  44 #define WEIGHTS_ATS_DEFAULT          0x0000f711u
  45
  46 #define ICB_0_IRQ_MASK ((REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, HOST_IPC_FIFO_INT)) | \
  47                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_0_INT)) | \
  48                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_1_INT)) | \
  49                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_2_INT)) | \
  50                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, NOC_FIREWALL_INT)) | \
  51                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_0_INT)) | \
  52                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_1_INT)))
  53
  54 #define ICB_1_IRQ_MASK ((REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_1, CPU_INT_REDIRECT_2_INT)) | \
  55                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_1, CPU_INT_REDIRECT_3_INT)) | \
  56                         (REG_FLD(VPU_40XX_HOST_SS_ICB_STATUS_1, CPU_INT_REDIRECT_4_INT)))
  57
  58 #define ICB_0_1_IRQ_MASK ((((u64)ICB_1_IRQ_MASK) << 32) | ICB_0_IRQ_MASK)
  59
  60 #define BUTTRESS_IRQ_MASK ((REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, ATS_ERR)) | \
  61                            (REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI0_ERR)) | \
  62                            (REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI1_ERR)) | \
  63                            (REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR0_ERR)) | \
  64                            (REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR1_ERR)) | \
  65                            (REG_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, SURV_ERR)))
  66
  67 #define BUTTRESS_IRQ_ENABLE_MASK ((u32)~BUTTRESS_IRQ_MASK)
  68 #define BUTTRESS_IRQ_DISABLE_MASK ((u32)-1)
  69
  70 #define ITF_FIREWALL_VIOLATION_MASK ((REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, CSS_ROM_CMX)) | \
  71                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, CSS_DBG)) | \
  72                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, CSS_CTRL)) | \
  73                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, DEC400)) | \
  74                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, MSS_NCE)) | \
  75                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, MSS_MBI)) | \
  76                                      (REG_FLD(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, MSS_MBI_CMX)))
  77
  78 static char *ivpu_platform_to_str(u32 platform)
  79 {
  80         switch (platform) {
  81         case IVPU_PLATFORM_SILICON:
  82                 return "IVPU_PLATFORM_SILICON";
  83         case IVPU_PLATFORM_SIMICS:
  84                 return "IVPU_PLATFORM_SIMICS";
  85         case IVPU_PLATFORM_FPGA:
  86                 return "IVPU_PLATFORM_FPGA";
  87         default:
  88                 return "Invalid platform";
  89         }
  90 }
  91
  92 static const struct dmi_system_id ivpu_dmi_platform_simulation[] = {
  93         {
  94                 .ident = "Intel Simics",
  95                 .matches = {
  96                         DMI_MATCH(DMI_BOARD_NAME, "lnlrvp"),
  97                         DMI_MATCH(DMI_BOARD_VERSION, "1.0"),
  98                         DMI_MATCH(DMI_BOARD_SERIAL, "123456789"),
  99                 },
 100         },
 101         {
 102                 .ident = "Intel Simics",
 103                 .matches = {
 104                         DMI_MATCH(DMI_BOARD_NAME, "Simics"),
 105                 },
 106         },
 107         { }
 108 };
 109
 110 static void ivpu_hw_read_platform(struct ivpu_device *vdev)
 111 {
 112         if (dmi_check_system(ivpu_dmi_platform_simulation))
 113                 vdev->platform = IVPU_PLATFORM_SIMICS;
 114         else
 115                 vdev->platform = IVPU_PLATFORM_SILICON;
 116
 117         ivpu_dbg(vdev, MISC, "Platform type: %s (%d)\n",
 118                  ivpu_platform_to_str(vdev->platform), vdev->platform);
 119 }
 120
 121 static void ivpu_hw_wa_init(struct ivpu_device *vdev)
 122 {
 123         vdev->wa.punit_disabled = ivpu_is_fpga(vdev);
 124         vdev->wa.clear_runtime_mem = false;
 125
 126         if (ivpu_hw_gen(vdev) == IVPU_HW_40XX)
 127                 vdev->wa.disable_clock_relinquish = true;
 128 }
 129
 130 static void ivpu_hw_timeouts_init(struct ivpu_device *vdev)
 131 {
 132         if (ivpu_is_fpga(vdev)) {
 133                 vdev->timeout.boot = 100000;
 134                 vdev->timeout.jsm = 50000;
 135                 vdev->timeout.tdr = 2000000;
 136                 vdev->timeout.reschedule_suspend = 1000;
 137         } else if (ivpu_is_simics(vdev)) {
 138                 vdev->timeout.boot = 50;
 139                 vdev->timeout.jsm = 500;
 140                 vdev->timeout.tdr = 10000;
 141                 vdev->timeout.reschedule_suspend = 10;
 142         } else {
 143                 vdev->timeout.boot = 1000;
 144                 vdev->timeout.jsm = 500;
 145                 vdev->timeout.tdr = 2000;
 146                 vdev->timeout.reschedule_suspend = 10;
 147         }
 148 }
 149
 150 static int ivpu_pll_wait_for_cmd_send(struct ivpu_device *vdev)
 151 {
 152         return REGB_POLL_FLD(VPU_40XX_BUTTRESS_WP_REQ_CMD, SEND, 0, PLL_TIMEOUT_US);
 153 }
 154
 155 static int ivpu_pll_cmd_send(struct ivpu_device *vdev, u16 min_ratio, u16 max_ratio,
 156                              u16 target_ratio, u16 epp, u16 config, u16 cdyn)
 157 {
 158         int ret;
 159         u32 val;
 160
 161         ret = ivpu_pll_wait_for_cmd_send(vdev);
 162         if (ret) {
 163                 ivpu_err(vdev, "Failed to sync before WP request: %d\n", ret);
 164                 return ret;
 165         }
 166
 167         val = REGB_RD32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD0);
 168         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD0, MIN_RATIO, min_ratio, val);
 169         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD0, MAX_RATIO, max_ratio, val);
 170         REGB_WR32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD0, val);
 171
 172         val = REGB_RD32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD1);
 173         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD1, TARGET_RATIO, target_ratio, val);
 174         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD1, EPP, epp, val);
 175         REGB_WR32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD1, val);
 176
 177         val = REGB_RD32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD2);
 178         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD2, CONFIG, config, val);
 179         val = REG_SET_FLD_NUM(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD2, CDYN, cdyn, val);
 180         REGB_WR32(VPU_40XX_BUTTRESS_WP_REQ_PAYLOAD2, val);
 181
 182         val = REGB_RD32(VPU_40XX_BUTTRESS_WP_REQ_CMD);
 183         val = REG_SET_FLD(VPU_40XX_BUTTRESS_WP_REQ_CMD, SEND, val);
 184         REGB_WR32(VPU_40XX_BUTTRESS_WP_REQ_CMD, val);
 185
 186         ret = ivpu_pll_wait_for_cmd_send(vdev);
 187         if (ret)
 188                 ivpu_err(vdev, "Failed to sync after WP request: %d\n", ret);
 189
 190         return ret;
 191 }
 192
 193 static int ivpu_pll_wait_for_status_ready(struct ivpu_device *vdev)
 194 {
 195         return REGB_POLL_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, READY, 1, PLL_TIMEOUT_US);
 196 }
 197
 198 static int ivpu_wait_for_clock_own_resource_ack(struct ivpu_device *vdev)
 199 {
 200         if (ivpu_is_simics(vdev))
 201                 return 0;
 202
 203         return REGB_POLL_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, CLOCK_RESOURCE_OWN_ACK, 1, TIMEOUT_US);
 204 }
 205
 206 static void ivpu_pll_init_frequency_ratios(struct ivpu_device *vdev)
 207 {
 208         struct ivpu_hw_info *hw = vdev->hw;
 209         u8 fuse_min_ratio, fuse_pn_ratio, fuse_max_ratio;
 210         u32 fmin_fuse, fmax_fuse;
 211
 212         fmin_fuse = REGB_RD32(VPU_40XX_BUTTRESS_FMIN_FUSE);
 213         fuse_min_ratio = REG_GET_FLD(VPU_40XX_BUTTRESS_FMIN_FUSE, MIN_RATIO, fmin_fuse);
 214         fuse_pn_ratio = REG_GET_FLD(VPU_40XX_BUTTRESS_FMIN_FUSE, PN_RATIO, fmin_fuse);
 215
 216         fmax_fuse = REGB_RD32(VPU_40XX_BUTTRESS_FMAX_FUSE);
 217         fuse_max_ratio = REG_GET_FLD(VPU_40XX_BUTTRESS_FMAX_FUSE, MAX_RATIO, fmax_fuse);
 218
 219         hw->pll.min_ratio = clamp_t(u8, ivpu_pll_min_ratio, fuse_min_ratio, fuse_max_ratio);
 220         hw->pll.max_ratio = clamp_t(u8, ivpu_pll_max_ratio, hw->pll.min_ratio, fuse_max_ratio);
 221         hw->pll.pn_ratio = clamp_t(u8, fuse_pn_ratio, hw->pll.min_ratio, hw->pll.max_ratio);
 222 }
 223
 224 static int ivpu_pll_drive(struct ivpu_device *vdev, bool enable)
 225 {
 226         u16 config = enable ? PLL_CONFIG_DEFAULT : 0;
 227         u16 cdyn = enable ? PLL_CDYN_DEFAULT : 0;
 228         u16 epp = enable ? PLL_EPP_DEFAULT : 0;
 229         struct ivpu_hw_info *hw = vdev->hw;
 230         u16 target_ratio = hw->pll.pn_ratio;
 231         int ret;
 232
 233         ivpu_dbg(vdev, PM, "PLL workpoint request: %u Hz, epp: 0x%x, config: 0x%x, cdyn: 0x%x\n",
 234                  PLL_RATIO_TO_FREQ(target_ratio), epp, config, cdyn);
 235
 236         ret = ivpu_pll_cmd_send(vdev, hw->pll.min_ratio, hw->pll.max_ratio,
 237                                 target_ratio, epp, config, cdyn);
 238         if (ret) {
 239                 ivpu_err(vdev, "Failed to send PLL workpoint request: %d\n", ret);
 240                 return ret;
 241         }
 242
 243         if (enable) {
 244                 ret = ivpu_pll_wait_for_status_ready(vdev);
 245                 if (ret) {
 246                         ivpu_err(vdev, "Timed out waiting for PLL ready status\n");
 247                         return ret;
 248                 }
 249         }
 250
 251         return 0;
 252 }
 253
 254 static int ivpu_pll_enable(struct ivpu_device *vdev)
 255 {
 256         return ivpu_pll_drive(vdev, true);
 257 }
 258
 259 static int ivpu_pll_disable(struct ivpu_device *vdev)
 260 {
 261         return ivpu_pll_drive(vdev, false);
 262 }
 263
 264 static void ivpu_boot_host_ss_rst_drive(struct ivpu_device *vdev, bool enable)
 265 {
 266         u32 val = REGV_RD32(VPU_40XX_HOST_SS_CPR_RST_EN);
 267
 268         if (enable) {
 269                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, TOP_NOC, val);
 270                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, DSS_MAS, val);
 271                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, CSS_MAS, val);
 272         } else {
 273                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, TOP_NOC, val);
 274                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, DSS_MAS, val);
 275                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_RST_EN, CSS_MAS, val);
 276         }
 277
 278         REGV_WR32(VPU_40XX_HOST_SS_CPR_RST_EN, val);
 279 }
 280
 281 static void ivpu_boot_host_ss_clk_drive(struct ivpu_device *vdev, bool enable)
 282 {
 283         u32 val = REGV_RD32(VPU_40XX_HOST_SS_CPR_CLK_EN);
 284
 285         if (enable) {
 286                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, TOP_NOC, val);
 287                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, DSS_MAS, val);
 288                 val = REG_SET_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, CSS_MAS, val);
 289         } else {
 290                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, TOP_NOC, val);
 291                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, DSS_MAS, val);
 292                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_CPR_CLK_EN, CSS_MAS, val);
 293         }
 294
 295         REGV_WR32(VPU_40XX_HOST_SS_CPR_CLK_EN, val);
 296 }
 297
 298 static int ivpu_boot_noc_qreqn_check(struct ivpu_device *vdev, u32 exp_val)
 299 {
 300         u32 val = REGV_RD32(VPU_40XX_HOST_SS_NOC_QREQN);
 301
 302         if (!REG_TEST_FLD_NUM(VPU_40XX_HOST_SS_NOC_QREQN, TOP_SOCMMIO, exp_val, val))
 303                 return -EIO;
 304
 305         return 0;
 306 }
 307
 308 static int ivpu_boot_noc_qacceptn_check(struct ivpu_device *vdev, u32 exp_val)
 309 {
 310         u32 val = REGV_RD32(VPU_40XX_HOST_SS_NOC_QACCEPTN);
 311
 312         if (!REG_TEST_FLD_NUM(VPU_40XX_HOST_SS_NOC_QACCEPTN, TOP_SOCMMIO, exp_val, val))
 313                 return -EIO;
 314
 315         return 0;
 316 }
 317
 318 static int ivpu_boot_noc_qdeny_check(struct ivpu_device *vdev, u32 exp_val)
 319 {
 320         u32 val = REGV_RD32(VPU_40XX_HOST_SS_NOC_QDENY);
 321
 322         if (!REG_TEST_FLD_NUM(VPU_40XX_HOST_SS_NOC_QDENY, TOP_SOCMMIO, exp_val, val))
 323                 return -EIO;
 324
 325         return 0;
 326 }
 327
 328 static int ivpu_boot_top_noc_qrenqn_check(struct ivpu_device *vdev, u32 exp_val)
 329 {
 330         u32 val = REGV_RD32(VPU_40XX_TOP_NOC_QREQN);
 331
 332         if (!REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QREQN, CPU_CTRL, exp_val, val) ||
 333             !REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QREQN, HOSTIF_L2CACHE, exp_val, val))
 334                 return -EIO;
 335
 336         return 0;
 337 }
 338
 339 static int ivpu_boot_top_noc_qacceptn_check(struct ivpu_device *vdev, u32 exp_val)
 340 {
 341         u32 val = REGV_RD32(VPU_40XX_TOP_NOC_QACCEPTN);
 342
 343         if (!REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QACCEPTN, CPU_CTRL, exp_val, val) ||
 344             !REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QACCEPTN, HOSTIF_L2CACHE, exp_val, val))
 345                 return -EIO;
 346
 347         return 0;
 348 }
 349
 350 static int ivpu_boot_top_noc_qdeny_check(struct ivpu_device *vdev, u32 exp_val)
 351 {
 352         u32 val = REGV_RD32(VPU_40XX_TOP_NOC_QDENY);
 353
 354         if (!REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QDENY, CPU_CTRL, exp_val, val) ||
 355             !REG_TEST_FLD_NUM(VPU_40XX_TOP_NOC_QDENY, HOSTIF_L2CACHE, exp_val, val))
 356                 return -EIO;
 357
 358         return 0;
 359 }
 360
 361 static void ivpu_boot_idle_gen_drive(struct ivpu_device *vdev, bool enable)
 362 {
 363         u32 val = REGV_RD32(VPU_40XX_HOST_SS_AON_IDLE_GEN);
 364
 365         if (enable)
 366                 val = REG_SET_FLD(VPU_40XX_HOST_SS_AON_IDLE_GEN, EN, val);
 367         else
 368                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_AON_IDLE_GEN, EN, val);
 369
 370         REGV_WR32(VPU_40XX_HOST_SS_AON_IDLE_GEN, val);
 371 }
 372
 373 static int ivpu_boot_host_ss_check(struct ivpu_device *vdev)
 374 {
 375         int ret;
 376
 377         ret = ivpu_boot_noc_qreqn_check(vdev, 0x0);
 378         if (ret) {
 379                 ivpu_err(vdev, "Failed qreqn check: %d\n", ret);
 380                 return ret;
 381         }
 382
 383         ret = ivpu_boot_noc_qacceptn_check(vdev, 0x0);
 384         if (ret) {
 385                 ivpu_err(vdev, "Failed qacceptn check: %d\n", ret);
 386                 return ret;
 387         }
 388
 389         ret = ivpu_boot_noc_qdeny_check(vdev, 0x0);
 390         if (ret)
 391                 ivpu_err(vdev, "Failed qdeny check %d\n", ret);
 392
 393         return ret;
 394 }
 395
 396 static int ivpu_boot_host_ss_axi_drive(struct ivpu_device *vdev, bool enable)
 397 {
 398         int ret;
 399         u32 val;
 400
 401         val = REGV_RD32(VPU_40XX_HOST_SS_NOC_QREQN);
 402         if (enable)
 403                 val = REG_SET_FLD(VPU_40XX_HOST_SS_NOC_QREQN, TOP_SOCMMIO, val);
 404         else
 405                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_NOC_QREQN, TOP_SOCMMIO, val);
 406         REGV_WR32(VPU_40XX_HOST_SS_NOC_QREQN, val);
 407
 408         ret = ivpu_boot_noc_qacceptn_check(vdev, enable ? 0x1 : 0x0);
 409         if (ret) {
 410                 ivpu_err(vdev, "Failed qacceptn check: %d\n", ret);
 411                 return ret;
 412         }
 413
 414         ret = ivpu_boot_noc_qdeny_check(vdev, 0x0);
 415         if (ret) {
 416                 ivpu_err(vdev, "Failed qdeny check: %d\n", ret);
 417                 return ret;
 418         }
 419
 420         if (enable) {
 421                 REGB_WR32(VPU_40XX_BUTTRESS_PORT_ARBITRATION_WEIGHTS, WEIGHTS_DEFAULT);
 422                 REGB_WR32(VPU_40XX_BUTTRESS_PORT_ARBITRATION_WEIGHTS_ATS, WEIGHTS_ATS_DEFAULT);
 423         }
 424
 425         return ret;
 426 }
 427
 428 static int ivpu_boot_host_ss_axi_enable(struct ivpu_device *vdev)
 429 {
 430         return ivpu_boot_host_ss_axi_drive(vdev, true);
 431 }
 432
 433 static int ivpu_boot_host_ss_top_noc_drive(struct ivpu_device *vdev, bool enable)
 434 {
 435         int ret;
 436         u32 val;
 437
 438         val = REGV_RD32(VPU_40XX_TOP_NOC_QREQN);
 439         if (enable) {
 440                 val = REG_SET_FLD(VPU_40XX_TOP_NOC_QREQN, CPU_CTRL, val);
 441                 val = REG_SET_FLD(VPU_40XX_TOP_NOC_QREQN, HOSTIF_L2CACHE, val);
 442         } else {
 443                 val = REG_CLR_FLD(VPU_40XX_TOP_NOC_QREQN, CPU_CTRL, val);
 444                 val = REG_CLR_FLD(VPU_40XX_TOP_NOC_QREQN, HOSTIF_L2CACHE, val);
 445         }
 446         REGV_WR32(VPU_40XX_TOP_NOC_QREQN, val);
 447
 448         ret = ivpu_boot_top_noc_qacceptn_check(vdev, enable ? 0x1 : 0x0);
 449         if (ret) {
 450                 ivpu_err(vdev, "Failed qacceptn check: %d\n", ret);
 451                 return ret;
 452         }
 453
 454         ret = ivpu_boot_top_noc_qdeny_check(vdev, 0x0);
 455         if (ret)
 456                 ivpu_err(vdev, "Failed qdeny check: %d\n", ret);
 457
 458         return ret;
 459 }
 460
 461 static int ivpu_boot_host_ss_top_noc_enable(struct ivpu_device *vdev)
 462 {
 463         return ivpu_boot_host_ss_top_noc_drive(vdev, true);
 464 }
 465
 466 static void ivpu_boot_pwr_island_trickle_drive(struct ivpu_device *vdev, bool enable)
 467 {
 468         u32 val = REGV_RD32(VPU_40XX_HOST_SS_AON_PWR_ISLAND_TRICKLE_EN0);
 469
 470         if (enable)
 471                 val = REG_SET_FLD(VPU_40XX_HOST_SS_AON_PWR_ISLAND_TRICKLE_EN0, CSS_CPU, val);
 472         else
 473                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_AON_PWR_ISLAND_TRICKLE_EN0, CSS_CPU, val);
 474
 475         REGV_WR32(VPU_40XX_HOST_SS_AON_PWR_ISLAND_TRICKLE_EN0, val);
 476
 477         if (enable)
 478                 ndelay(500);
 479 }
 480
 481 static void ivpu_boot_pwr_island_drive(struct ivpu_device *vdev, bool enable)
 482 {
 483         u32 val = REGV_RD32(VPU_40XX_HOST_SS_AON_PWR_ISLAND_EN0);
 484
 485         if (enable)
 486                 val = REG_SET_FLD(VPU_40XX_HOST_SS_AON_PWR_ISLAND_EN0, CSS_CPU, val);
 487         else
 488                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_AON_PWR_ISLAND_EN0, CSS_CPU, val);
 489
 490         REGV_WR32(VPU_40XX_HOST_SS_AON_PWR_ISLAND_EN0, val);
 491
 492         if (!enable)
 493                 ndelay(500);
 494 }
 495
 496 static int ivpu_boot_wait_for_pwr_island_status(struct ivpu_device *vdev, u32 exp_val)
 497 {
 498         if (ivpu_is_fpga(vdev))
 499                 return 0;
 500
 501         return REGV_POLL_FLD(VPU_40XX_HOST_SS_AON_PWR_ISLAND_STATUS0, CSS_CPU,
 502                              exp_val, PWR_ISLAND_STATUS_TIMEOUT_US);
 503 }
 504
 505 static void ivpu_boot_pwr_island_isolation_drive(struct ivpu_device *vdev, bool enable)
 506 {
 507         u32 val = REGV_RD32(VPU_40XX_HOST_SS_AON_PWR_ISO_EN0);
 508
 509         if (enable)
 510                 val = REG_SET_FLD(VPU_40XX_HOST_SS_AON_PWR_ISO_EN0, CSS_CPU, val);
 511         else
 512                 val = REG_CLR_FLD(VPU_40XX_HOST_SS_AON_PWR_ISO_EN0, CSS_CPU, val);
 513
 514         REGV_WR32(VPU_40XX_HOST_SS_AON_PWR_ISO_EN0, val);
 515 }
 516
 517 static void ivpu_boot_no_snoop_enable(struct ivpu_device *vdev)
 518 {
 519         u32 val = REGV_RD32(VPU_40XX_HOST_IF_TCU_PTW_OVERRIDES);
 520
 521         val = REG_SET_FLD(VPU_40XX_HOST_IF_TCU_PTW_OVERRIDES, SNOOP_OVERRIDE_EN, val);
 522         val = REG_CLR_FLD(VPU_40XX_HOST_IF_TCU_PTW_OVERRIDES, AW_SNOOP_OVERRIDE, val);
 523         val = REG_CLR_FLD(VPU_40XX_HOST_IF_TCU_PTW_OVERRIDES, AR_SNOOP_OVERRIDE, val);
 524
 525         REGV_WR32(VPU_40XX_HOST_IF_TCU_PTW_OVERRIDES, val);
 526 }
 527
 528 static void ivpu_boot_tbu_mmu_enable(struct ivpu_device *vdev)
 529 {
 530         u32 val = REGV_RD32(VPU_40XX_HOST_IF_TBU_MMUSSIDV);
 531
 532         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU0_AWMMUSSIDV, val);
 533         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU0_ARMMUSSIDV, val);
 534         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU1_AWMMUSSIDV, val);
 535         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU1_ARMMUSSIDV, val);
 536         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU2_AWMMUSSIDV, val);
 537         val = REG_SET_FLD(VPU_40XX_HOST_IF_TBU_MMUSSIDV, TBU2_ARMMUSSIDV, val);
 538
 539         REGV_WR32(VPU_40XX_HOST_IF_TBU_MMUSSIDV, val);
 540 }
 541
 542 static int ivpu_boot_cpu_noc_qacceptn_check(struct ivpu_device *vdev, u32 exp_val)
 543 {
 544         u32 val = REGV_RD32(VPU_40XX_CPU_SS_CPR_NOC_QACCEPTN);
 545
 546         if (!REG_TEST_FLD_NUM(VPU_40XX_CPU_SS_CPR_NOC_QACCEPTN, TOP_MMIO, exp_val, val))
 547                 return -EIO;
 548
 549         return 0;
 550 }
 551
 552 static int ivpu_boot_cpu_noc_qdeny_check(struct ivpu_device *vdev, u32 exp_val)
 553 {
 554         u32 val = REGV_RD32(VPU_40XX_CPU_SS_CPR_NOC_QDENY);
 555
 556         if (!REG_TEST_FLD_NUM(VPU_40XX_CPU_SS_CPR_NOC_QDENY, TOP_MMIO, exp_val, val))
 557                 return -EIO;
 558
 559         return 0;
 560 }
 561
 562 static int ivpu_boot_pwr_domain_enable(struct ivpu_device *vdev)
 563 {
 564         int ret;
 565
 566         ret = ivpu_wait_for_clock_own_resource_ack(vdev);
 567         if (ret) {
 568                 ivpu_err(vdev, "Timed out waiting for clock own resource ACK\n");
 569                 return ret;
 570         }
 571
 572         ivpu_boot_pwr_island_trickle_drive(vdev, true);
 573         ivpu_boot_pwr_island_drive(vdev, true);
 574
 575         ret = ivpu_boot_wait_for_pwr_island_status(vdev, 0x1);
 576         if (ret) {
 577                 ivpu_err(vdev, "Timed out waiting for power island status\n");
 578                 return ret;
 579         }
 580
 581         ret = ivpu_boot_top_noc_qrenqn_check(vdev, 0x0);
 582         if (ret) {
 583                 ivpu_err(vdev, "Failed qrenqn check %d\n", ret);
 584                 return ret;
 585         }
 586
 587         ivpu_boot_host_ss_clk_drive(vdev, true);
 588         ivpu_boot_host_ss_rst_drive(vdev, true);
 589         ivpu_boot_pwr_island_isolation_drive(vdev, false);
 590
 591         return ret;
 592 }
 593
 594 static int ivpu_boot_soc_cpu_drive(struct ivpu_device *vdev, bool enable)
 595 {
 596         int ret;
 597         u32 val;
 598
 599         val = REGV_RD32(VPU_40XX_CPU_SS_CPR_NOC_QREQN);
 600         if (enable)
 601                 val = REG_SET_FLD(VPU_40XX_CPU_SS_CPR_NOC_QREQN, TOP_MMIO, val);
 602         else
 603                 val = REG_CLR_FLD(VPU_40XX_CPU_SS_CPR_NOC_QREQN, TOP_MMIO, val);
 604         REGV_WR32(VPU_40XX_CPU_SS_CPR_NOC_QREQN, val);
 605
 606         ret = ivpu_boot_cpu_noc_qacceptn_check(vdev, enable ? 0x1 : 0x0);
 607         if (ret) {
 608                 ivpu_err(vdev, "Failed qacceptn check: %d\n", ret);
 609                 return ret;
 610         }
 611
 612         ret = ivpu_boot_cpu_noc_qdeny_check(vdev, 0x0);
 613         if (ret)
 614                 ivpu_err(vdev, "Failed qdeny check: %d\n", ret);
 615
 616         return ret;
 617 }
 618
 619 static int ivpu_boot_soc_cpu_enable(struct ivpu_device *vdev)
 620 {
 621         return ivpu_boot_soc_cpu_drive(vdev, true);
 622 }
 623
 624 static int ivpu_boot_soc_cpu_boot(struct ivpu_device *vdev)
 625 {
 626         int ret;
 627         u32 val;
 628         u64 val64;
 629
 630         ret = ivpu_boot_soc_cpu_enable(vdev);
 631         if (ret) {
 632                 ivpu_err(vdev, "Failed to enable SOC CPU: %d\n", ret);
 633                 return ret;
 634         }
 635
 636         val64 = vdev->fw->entry_point;
 637         val64 <<= ffs(VPU_40XX_HOST_SS_VERIFICATION_ADDRESS_LO_IMAGE_LOCATION_MASK) - 1;
 638         REGV_WR64(VPU_40XX_HOST_SS_VERIFICATION_ADDRESS_LO, val64);
 639
 640         val = REGV_RD32(VPU_40XX_HOST_SS_VERIFICATION_ADDRESS_LO);
 641         val = REG_SET_FLD(VPU_40XX_HOST_SS_VERIFICATION_ADDRESS_LO, DONE, val);
 642         REGV_WR32(VPU_40XX_HOST_SS_VERIFICATION_ADDRESS_LO, val);
 643
 644         ivpu_dbg(vdev, PM, "Booting firmware, mode: %s\n",
 645                  ivpu_fw_is_cold_boot(vdev) ? "cold boot" : "resume");
 646
 647         return 0;
 648 }
 649
 650 static int ivpu_boot_d0i3_drive(struct ivpu_device *vdev, bool enable)
 651 {
 652         int ret;
 653         u32 val;
 654
 655         ret = REGB_POLL_FLD(VPU_40XX_BUTTRESS_D0I3_CONTROL, INPROGRESS, 0, TIMEOUT_US);
 656         if (ret) {
 657                 ivpu_err(vdev, "Failed to sync before D0i3 transition: %d\n", ret);
 658                 return ret;
 659         }
 660
 661         val = REGB_RD32(VPU_40XX_BUTTRESS_D0I3_CONTROL);
 662         if (enable)
 663                 val = REG_SET_FLD(VPU_40XX_BUTTRESS_D0I3_CONTROL, I3, val);
 664         else
 665                 val = REG_CLR_FLD(VPU_40XX_BUTTRESS_D0I3_CONTROL, I3, val);
 666         REGB_WR32(VPU_40XX_BUTTRESS_D0I3_CONTROL, val);
 667
 668         ret = REGB_POLL_FLD(VPU_40XX_BUTTRESS_D0I3_CONTROL, INPROGRESS, 0, TIMEOUT_US);
 669         if (ret) {
 670                 ivpu_err(vdev, "Failed to sync after D0i3 transition: %d\n", ret);
 671                 return ret;
 672         }
 673
 674         return 0;
 675 }
 676
 677 static bool ivpu_tile_disable_check(u32 config)
 678 {
 679         /* Allowed values: 0 or one bit from range 0-5 (6 tiles) */
 680         if (config == 0)
 681                 return true;
 682
 683         if (config > BIT(TILE_MAX_NUM - 1))
 684                 return false;
 685
 686         if ((config & (config - 1)) == 0)
 687                 return true;
 688
 689         return false;
 690 }
 691
 692 static int ivpu_hw_40xx_info_init(struct ivpu_device *vdev)
 693 {
 694         struct ivpu_hw_info *hw = vdev->hw;
 695         u32 tile_disable;
 696         u32 tile_enable;
 697         u32 fuse;
 698
 699         fuse = REGB_RD32(VPU_40XX_BUTTRESS_TILE_FUSE);
 700         if (!REG_TEST_FLD(VPU_40XX_BUTTRESS_TILE_FUSE, VALID, fuse)) {
 701                 ivpu_err(vdev, "Fuse: invalid (0x%x)\n", fuse);
 702                 return -EIO;
 703         }
 704
 705         tile_disable = REG_GET_FLD(VPU_40XX_BUTTRESS_TILE_FUSE, CONFIG, fuse);
 706         if (!ivpu_tile_disable_check(tile_disable)) {
 707                 ivpu_err(vdev, "Fuse: Invalid tile disable config (0x%x)\n", tile_disable);
 708                 return -EIO;
 709         }
 710
 711         if (tile_disable)
 712                 ivpu_dbg(vdev, MISC, "Fuse: %d tiles enabled. Tile number %d disabled\n",
 713                          TILE_MAX_NUM - 1, ffs(tile_disable) - 1);
 714         else
 715                 ivpu_dbg(vdev, MISC, "Fuse: All %d tiles enabled\n", TILE_MAX_NUM);
 716
 717         tile_enable = (~tile_disable) & TILE_MAX_MASK;
 718
 719         hw->sku = REG_SET_FLD_NUM(SKU, HW_ID, LNL_HW_ID, hw->sku);
 720         hw->sku = REG_SET_FLD_NUM(SKU, TILE, tile_enable, hw->sku);
 721         hw->tile_fuse = tile_disable;
 722         hw->pll.profiling_freq = PLL_PROFILING_FREQ_DEFAULT;
 723
 724         ivpu_pll_init_frequency_ratios(vdev);
 725
 726         ivpu_hw_init_range(&vdev->hw->ranges.global, 0x80000000, SZ_512M);
 727         ivpu_hw_init_range(&vdev->hw->ranges.user,   0x80000000, SZ_256M);
 728         ivpu_hw_init_range(&vdev->hw->ranges.shave,  0x80000000 + SZ_256M, SZ_2G - SZ_256M);
 729         ivpu_hw_init_range(&vdev->hw->ranges.dma,   0x200000000, SZ_8G);
 730
 731         return 0;
 732 }
 733
 734 static int ivpu_hw_40xx_reset(struct ivpu_device *vdev)
 735 {
 736         int ret;
 737         u32 val;
 738
 739         ret = REGB_POLL_FLD(VPU_40XX_BUTTRESS_IP_RESET, TRIGGER, 0, TIMEOUT_US);
 740         if (ret) {
 741                 ivpu_err(vdev, "Wait for *_TRIGGER timed out\n");
 742                 return ret;
 743         }
 744
 745         val = REGB_RD32(VPU_40XX_BUTTRESS_IP_RESET);
 746         val = REG_SET_FLD(VPU_40XX_BUTTRESS_IP_RESET, TRIGGER, val);
 747         REGB_WR32(VPU_40XX_BUTTRESS_IP_RESET, val);
 748
 749         ret = REGB_POLL_FLD(VPU_40XX_BUTTRESS_IP_RESET, TRIGGER, 0, TIMEOUT_US);
 750         if (ret)
 751                 ivpu_err(vdev, "Timed out waiting for RESET completion\n");
 752
 753         return ret;
 754 }
 755
 756 static int ivpu_hw_40xx_d0i3_enable(struct ivpu_device *vdev)
 757 {
 758         int ret;
 759
 760         if (IVPU_WA(punit_disabled))
 761                 return 0;
 762
 763         ret = ivpu_boot_d0i3_drive(vdev, true);
 764         if (ret)
 765                 ivpu_err(vdev, "Failed to enable D0i3: %d\n", ret);
 766
 767         udelay(5); /* VPU requires 5 us to complete the transition */
 768
 769         return ret;
 770 }
 771
 772 static int ivpu_hw_40xx_d0i3_disable(struct ivpu_device *vdev)
 773 {
 774         int ret;
 775
 776         if (IVPU_WA(punit_disabled))
 777                 return 0;
 778
 779         ret = ivpu_boot_d0i3_drive(vdev, false);
 780         if (ret)
 781                 ivpu_err(vdev, "Failed to disable D0i3: %d\n", ret);
 782
 783         return ret;
 784 }
 785
 786 static void ivpu_hw_40xx_profiling_freq_reg_set(struct ivpu_device *vdev)
 787 {
 788         u32 val = REGB_RD32(VPU_40XX_BUTTRESS_VPU_STATUS);
 789
 790         if (vdev->hw->pll.profiling_freq == PLL_PROFILING_FREQ_DEFAULT)
 791                 val = REG_CLR_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, PERF_CLK, val);
 792         else
 793                 val = REG_SET_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, PERF_CLK, val);
 794
 795         REGB_WR32(VPU_40XX_BUTTRESS_VPU_STATUS, val);
 796 }
 797
 798 static void ivpu_hw_40xx_ats_print(struct ivpu_device *vdev)
 799 {
 800         ivpu_dbg(vdev, MISC, "Buttress ATS: %s\n",
 801                  REGB_RD32(VPU_40XX_BUTTRESS_HM_ATS) ? "Enable" : "Disable");
 802 }
 803
 804 static void ivpu_hw_40xx_clock_relinquish_disable(struct ivpu_device *vdev)
 805 {
 806         u32 val = REGB_RD32(VPU_40XX_BUTTRESS_VPU_STATUS);
 807
 808         val = REG_SET_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, DISABLE_CLK_RELINQUISH, val);
 809         REGB_WR32(VPU_40XX_BUTTRESS_VPU_STATUS, val);
 810 }
 811
 812 static int ivpu_hw_40xx_power_up(struct ivpu_device *vdev)
 813 {
 814         int ret;
 815
 816         ret = ivpu_hw_40xx_reset(vdev);
 817         if (ret) {
 818                 ivpu_err(vdev, "Failed to reset HW: %d\n", ret);
 819                 return ret;
 820         }
 821
 822         ivpu_hw_read_platform(vdev);
 823         ivpu_hw_wa_init(vdev);
 824         ivpu_hw_timeouts_init(vdev);
 825
 826         ret = ivpu_hw_40xx_d0i3_disable(vdev);
 827         if (ret)
 828                 ivpu_warn(vdev, "Failed to disable D0I3: %d\n", ret);
 829
 830         ret = ivpu_pll_enable(vdev);
 831         if (ret) {
 832                 ivpu_err(vdev, "Failed to enable PLL: %d\n", ret);
 833                 return ret;
 834         }
 835
 836         if (IVPU_WA(disable_clock_relinquish))
 837                 ivpu_hw_40xx_clock_relinquish_disable(vdev);
 838         ivpu_hw_40xx_profiling_freq_reg_set(vdev);
 839         ivpu_hw_40xx_ats_print(vdev);
 840
 841         ret = ivpu_boot_host_ss_check(vdev);
 842         if (ret) {
 843                 ivpu_err(vdev, "Failed to configure host SS: %d\n", ret);
 844                 return ret;
 845         }
 846
 847         ivpu_boot_idle_gen_drive(vdev, false);
 848
 849         ret = ivpu_boot_pwr_domain_enable(vdev);
 850         if (ret) {
 851                 ivpu_err(vdev, "Failed to enable power domain: %d\n", ret);
 852                 return ret;
 853         }
 854
 855         ret = ivpu_boot_host_ss_axi_enable(vdev);
 856         if (ret) {
 857                 ivpu_err(vdev, "Failed to enable AXI: %d\n", ret);
 858                 return ret;
 859         }
 860
 861         ret = ivpu_boot_host_ss_top_noc_enable(vdev);
 862         if (ret)
 863                 ivpu_err(vdev, "Failed to enable TOP NOC: %d\n", ret);
 864
 865         return ret;
 866 }
 867
 868 static int ivpu_hw_40xx_boot_fw(struct ivpu_device *vdev)
 869 {
 870         int ret;
 871
 872         ivpu_boot_no_snoop_enable(vdev);
 873         ivpu_boot_tbu_mmu_enable(vdev);
 874
 875         ret = ivpu_boot_soc_cpu_boot(vdev);
 876         if (ret)
 877                 ivpu_err(vdev, "Failed to boot SOC CPU: %d\n", ret);
 878
 879         return ret;
 880 }
 881
 882 static bool ivpu_hw_40xx_is_idle(struct ivpu_device *vdev)
 883 {
 884         u32 val;
 885
 886         if (IVPU_WA(punit_disabled))
 887                 return true;
 888
 889         val = REGB_RD32(VPU_40XX_BUTTRESS_VPU_STATUS);
 890         return REG_TEST_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, READY, val) &&
 891                REG_TEST_FLD(VPU_40XX_BUTTRESS_VPU_STATUS, IDLE, val);
 892 }
 893
 894 static int ivpu_hw_40xx_power_down(struct ivpu_device *vdev)
 895 {
 896         int ret = 0;
 897
 898         if (!ivpu_hw_40xx_is_idle(vdev) && ivpu_hw_40xx_reset(vdev))
 899                 ivpu_warn(vdev, "Failed to reset the VPU\n");
 900
 901         if (ivpu_pll_disable(vdev)) {
 902                 ivpu_err(vdev, "Failed to disable PLL\n");
 903                 ret = -EIO;
 904         }
 905
 906         if (ivpu_hw_40xx_d0i3_enable(vdev)) {
 907                 ivpu_err(vdev, "Failed to enter D0I3\n");
 908                 ret = -EIO;
 909         }
 910
 911         return ret;
 912 }
 913
 914 static void ivpu_hw_40xx_wdt_disable(struct ivpu_device *vdev)
 915 {
 916         u32 val;
 917
 918         REGV_WR32(VPU_40XX_CPU_SS_TIM_SAFE, TIM_SAFE_ENABLE);
 919         REGV_WR32(VPU_40XX_CPU_SS_TIM_WATCHDOG, TIM_WATCHDOG_RESET_VALUE);
 920
 921         REGV_WR32(VPU_40XX_CPU_SS_TIM_SAFE, TIM_SAFE_ENABLE);
 922         REGV_WR32(VPU_40XX_CPU_SS_TIM_WDOG_EN, 0);
 923
 924         val = REGV_RD32(VPU_40XX_CPU_SS_TIM_GEN_CONFIG);
 925         val = REG_CLR_FLD(VPU_40XX_CPU_SS_TIM_GEN_CONFIG, WDOG_TO_INT_CLR, val);
 926         REGV_WR32(VPU_40XX_CPU_SS_TIM_GEN_CONFIG, val);
 927 }
 928
 929 /* Register indirect accesses */
 930 static u32 ivpu_hw_40xx_reg_pll_freq_get(struct ivpu_device *vdev)
 931 {
 932         u32 pll_curr_ratio;
 933
 934         pll_curr_ratio = REGB_RD32(VPU_40XX_BUTTRESS_PLL_FREQ);
 935         pll_curr_ratio &= VPU_40XX_BUTTRESS_PLL_FREQ_RATIO_MASK;
 936
 937         return PLL_RATIO_TO_FREQ(pll_curr_ratio);
 938 }
 939
 940 static u32 ivpu_hw_40xx_reg_telemetry_offset_get(struct ivpu_device *vdev)
 941 {
 942         return REGB_RD32(VPU_40XX_BUTTRESS_VPU_TELEMETRY_OFFSET);
 943 }
 944
 945 static u32 ivpu_hw_40xx_reg_telemetry_size_get(struct ivpu_device *vdev)
 946 {
 947         return REGB_RD32(VPU_40XX_BUTTRESS_VPU_TELEMETRY_SIZE);
 948 }
 949
 950 static u32 ivpu_hw_40xx_reg_telemetry_enable_get(struct ivpu_device *vdev)
 951 {
 952         return REGB_RD32(VPU_40XX_BUTTRESS_VPU_TELEMETRY_ENABLE);
 953 }
 954
 955 static void ivpu_hw_40xx_reg_db_set(struct ivpu_device *vdev, u32 db_id)
 956 {
 957         u32 reg_stride = VPU_40XX_CPU_SS_DOORBELL_1 - VPU_40XX_CPU_SS_DOORBELL_0;
 958         u32 val = REG_FLD(VPU_40XX_CPU_SS_DOORBELL_0, SET);
 959
 960         REGV_WR32I(VPU_40XX_CPU_SS_DOORBELL_0, reg_stride, db_id, val);
 961 }
 962
 963 static u32 ivpu_hw_40xx_reg_ipc_rx_addr_get(struct ivpu_device *vdev)
 964 {
 965         return REGV_RD32(VPU_40XX_HOST_SS_TIM_IPC_FIFO_ATM);
 966 }
 967
 968 static u32 ivpu_hw_40xx_reg_ipc_rx_count_get(struct ivpu_device *vdev)
 969 {
 970         u32 count = REGV_RD32_SILENT(VPU_40XX_HOST_SS_TIM_IPC_FIFO_STAT);
 971
 972         return REG_GET_FLD(VPU_40XX_HOST_SS_TIM_IPC_FIFO_STAT, FILL_LEVEL, count);
 973 }
 974
 975 static void ivpu_hw_40xx_reg_ipc_tx_set(struct ivpu_device *vdev, u32 vpu_addr)
 976 {
 977         REGV_WR32(VPU_40XX_CPU_SS_TIM_IPC_FIFO, vpu_addr);
 978 }
 979
 980 static void ivpu_hw_40xx_irq_clear(struct ivpu_device *vdev)
 981 {
 982         REGV_WR64(VPU_40XX_HOST_SS_ICB_CLEAR_0, ICB_0_1_IRQ_MASK);
 983 }
 984
 985 static void ivpu_hw_40xx_irq_enable(struct ivpu_device *vdev)
 986 {
 987         REGV_WR32(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, ITF_FIREWALL_VIOLATION_MASK);
 988         REGV_WR64(VPU_40XX_HOST_SS_ICB_ENABLE_0, ICB_0_1_IRQ_MASK);
 989         REGB_WR32(VPU_40XX_BUTTRESS_LOCAL_INT_MASK, BUTTRESS_IRQ_ENABLE_MASK);
 990         REGB_WR32(VPU_40XX_BUTTRESS_GLOBAL_INT_MASK, 0x0);
 991 }
 992
 993 static void ivpu_hw_40xx_irq_disable(struct ivpu_device *vdev)
 994 {
 995         REGB_WR32(VPU_40XX_BUTTRESS_GLOBAL_INT_MASK, 0x1);
 996         REGB_WR32(VPU_40XX_BUTTRESS_LOCAL_INT_MASK, BUTTRESS_IRQ_DISABLE_MASK);
 997         REGV_WR64(VPU_40XX_HOST_SS_ICB_ENABLE_0, 0x0ull);
 998         REGV_WR32(VPU_40XX_HOST_SS_FW_SOC_IRQ_EN, 0x0ul);
 999 }
1000
1001 static void ivpu_hw_40xx_irq_wdt_nce_handler(struct ivpu_device *vdev)
1002 {
1003         /* TODO: For LNN hang consider engine reset instead of full recovery */
1004         ivpu_pm_schedule_recovery(vdev);
1005 }
1006
1007 static void ivpu_hw_40xx_irq_wdt_mss_handler(struct ivpu_device *vdev)
1008 {
1009         ivpu_hw_wdt_disable(vdev);
1010         ivpu_pm_schedule_recovery(vdev);
1011 }
1012
1013 static void ivpu_hw_40xx_irq_noc_firewall_handler(struct ivpu_device *vdev)
1014 {
1015         ivpu_pm_schedule_recovery(vdev);
1016 }
1017
1018 /* Handler for IRQs from VPU core (irqV) */
1019 static irqreturn_t ivpu_hw_40xx_irqv_handler(struct ivpu_device *vdev, int irq)
1020 {
1021         u32 status = REGV_RD32(VPU_40XX_HOST_SS_ICB_STATUS_0) & ICB_0_IRQ_MASK;
1022         irqreturn_t ret = IRQ_NONE;
1023
1024         if (!status)
1025                 return IRQ_NONE;
1026
1027         REGV_WR32(VPU_40XX_HOST_SS_ICB_CLEAR_0, status);
1028
1029         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_0_INT, status))
1030                 ivpu_mmu_irq_evtq_handler(vdev);
1031
1032         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, HOST_IPC_FIFO_INT, status))
1033                 ret |= ivpu_ipc_irq_handler(vdev);
1034
1035         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_1_INT, status))
1036                 ivpu_dbg(vdev, IRQ, "MMU sync complete\n");
1037
1038         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, MMU_IRQ_2_INT, status))
1039                 ivpu_mmu_irq_gerr_handler(vdev);
1040
1041         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_0_INT, status))
1042                 ivpu_hw_40xx_irq_wdt_mss_handler(vdev);
1043
1044         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_1_INT, status))
1045                 ivpu_hw_40xx_irq_wdt_nce_handler(vdev);
1046
1047         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, NOC_FIREWALL_INT, status))
1048                 ivpu_hw_40xx_irq_noc_firewall_handler(vdev);
1049
1050         return ret;
1051 }
1052
1053 /* Handler for IRQs from Buttress core (irqB) */
1054 static irqreturn_t ivpu_hw_40xx_irqb_handler(struct ivpu_device *vdev, int irq)
1055 {
1056         bool schedule_recovery = false;
1057         u32 status = REGB_RD32(VPU_40XX_BUTTRESS_INTERRUPT_STAT) & BUTTRESS_IRQ_MASK;
1058
1059         if (status == 0)
1060                 return IRQ_NONE;
1061
1062         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, FREQ_CHANGE, status))
1063                 ivpu_dbg(vdev, IRQ, "FREQ_CHANGE");
1064
1065         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, ATS_ERR, status)) {
1066                 ivpu_err(vdev, "ATS_ERR LOG1 0x%08x ATS_ERR_LOG2 0x%08x\n",
1067                          REGB_RD32(VPU_40XX_BUTTRESS_ATS_ERR_LOG1),
1068                          REGB_RD32(VPU_40XX_BUTTRESS_ATS_ERR_LOG2));
1069                 REGB_WR32(VPU_40XX_BUTTRESS_ATS_ERR_CLEAR, 0x1);
1070                 schedule_recovery = true;
1071         }
1072
1073         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI0_ERR, status)) {
1074                 ivpu_err(vdev, "CFI0_ERR 0x%08x", REGB_RD32(VPU_40XX_BUTTRESS_CFI0_ERR_LOG));
1075                 REGB_WR32(VPU_40XX_BUTTRESS_CFI0_ERR_CLEAR, 0x1);
1076                 schedule_recovery = true;
1077         }
1078
1079         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI1_ERR, status)) {
1080                 ivpu_err(vdev, "CFI1_ERR 0x%08x", REGB_RD32(VPU_40XX_BUTTRESS_CFI1_ERR_LOG));
1081                 REGB_WR32(VPU_40XX_BUTTRESS_CFI1_ERR_CLEAR, 0x1);
1082                 schedule_recovery = true;
1083         }
1084
1085         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR0_ERR, status)) {
1086                 ivpu_err(vdev, "IMR_ERR_CFI0 LOW: 0x%08x HIGH: 0x%08x",
1087                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI0_LOW),
1088                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI0_HIGH));
1089                 REGB_WR32(VPU_40XX_BUTTRESS_IMR_ERR_CFI0_CLEAR, 0x1);
1090                 schedule_recovery = true;
1091         }
1092
1093         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR1_ERR, status)) {
1094                 ivpu_err(vdev, "IMR_ERR_CFI1 LOW: 0x%08x HIGH: 0x%08x",
1095                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI1_LOW),
1096                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI1_HIGH));
1097                 REGB_WR32(VPU_40XX_BUTTRESS_IMR_ERR_CFI1_CLEAR, 0x1);
1098                 schedule_recovery = true;
1099         }
1100
1101         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, SURV_ERR, status)) {
1102                 ivpu_err(vdev, "Survivability error detected\n");
1103                 schedule_recovery = true;
1104         }
1105
1106         /* This must be done after interrupts are cleared at the source. */
1107         REGB_WR32(VPU_40XX_BUTTRESS_INTERRUPT_STAT, status);
1108
1109         if (schedule_recovery)
1110                 ivpu_pm_schedule_recovery(vdev);
1111
1112         return IRQ_HANDLED;
1113 }
1114
1115 static irqreturn_t ivpu_hw_40xx_irq_handler(int irq, void *ptr)
1116 {
1117         struct ivpu_device *vdev = ptr;
1118         irqreturn_t ret = IRQ_NONE;
1119
1120         REGB_WR32(VPU_40XX_BUTTRESS_GLOBAL_INT_MASK, 0x1);
1121
1122         ret |= ivpu_hw_40xx_irqv_handler(vdev, irq);
1123         ret |= ivpu_hw_40xx_irqb_handler(vdev, irq);
1124
1125         /* Re-enable global interrupts to re-trigger MSI for pending interrupts */
1126         REGB_WR32(VPU_40XX_BUTTRESS_GLOBAL_INT_MASK, 0x0);
1127
1128         if (ret & IRQ_WAKE_THREAD)
1129                 return IRQ_WAKE_THREAD;
1130
1131         return ret;
1132 }
1133
1134 static void ivpu_hw_40xx_diagnose_failure(struct ivpu_device *vdev)
1135 {
1136         u32 irqv = REGV_RD32(VPU_40XX_HOST_SS_ICB_STATUS_0) & ICB_0_IRQ_MASK;
1137         u32 irqb = REGB_RD32(VPU_40XX_BUTTRESS_INTERRUPT_STAT) & BUTTRESS_IRQ_MASK;
1138
1139         if (ivpu_hw_40xx_reg_ipc_rx_count_get(vdev))
1140                 ivpu_err(vdev, "IPC FIFO queue not empty, missed IPC IRQ");
1141
1142         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_0_INT, irqv))
1143                 ivpu_err(vdev, "WDT MSS timeout detected\n");
1144
1145         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, CPU_INT_REDIRECT_1_INT, irqv))
1146                 ivpu_err(vdev, "WDT NCE timeout detected\n");
1147
1148         if (REG_TEST_FLD(VPU_40XX_HOST_SS_ICB_STATUS_0, NOC_FIREWALL_INT, irqv))
1149                 ivpu_err(vdev, "NOC Firewall irq detected\n");
1150
1151         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, ATS_ERR, irqb)) {
1152                 ivpu_err(vdev, "ATS_ERR_LOG1 0x%08x ATS_ERR_LOG2 0x%08x\n",
1153                          REGB_RD32(VPU_40XX_BUTTRESS_ATS_ERR_LOG1),
1154                          REGB_RD32(VPU_40XX_BUTTRESS_ATS_ERR_LOG2));
1155         }
1156
1157         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI0_ERR, irqb))
1158                 ivpu_err(vdev, "CFI0_ERR_LOG 0x%08x\n", REGB_RD32(VPU_40XX_BUTTRESS_CFI0_ERR_LOG));
1159
1160         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, CFI1_ERR, irqb))
1161                 ivpu_err(vdev, "CFI1_ERR_LOG 0x%08x\n", REGB_RD32(VPU_40XX_BUTTRESS_CFI1_ERR_LOG));
1162
1163         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR0_ERR, irqb))
1164                 ivpu_err(vdev, "IMR_ERR_CFI0 LOW: 0x%08x HIGH: 0x%08x\n",
1165                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI0_LOW),
1166                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI0_HIGH));
1167
1168         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, IMR1_ERR, irqb))
1169                 ivpu_err(vdev, "IMR_ERR_CFI1 LOW: 0x%08x HIGH: 0x%08x\n",
1170                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI1_LOW),
1171                          REGB_RD32(VPU_40XX_BUTTRESS_IMR_ERR_CFI1_HIGH));
1172
1173         if (REG_TEST_FLD(VPU_40XX_BUTTRESS_INTERRUPT_STAT, SURV_ERR, irqb))
1174                 ivpu_err(vdev, "Survivability error detected\n");
1175 }
1176
1177 const struct ivpu_hw_ops ivpu_hw_40xx_ops = {
1178         .info_init = ivpu_hw_40xx_info_init,
1179         .power_up = ivpu_hw_40xx_power_up,
1180         .is_idle = ivpu_hw_40xx_is_idle,
1181         .power_down = ivpu_hw_40xx_power_down,
1182         .reset = ivpu_hw_40xx_reset,
1183         .boot_fw = ivpu_hw_40xx_boot_fw,
1184         .wdt_disable = ivpu_hw_40xx_wdt_disable,
1185         .diagnose_failure = ivpu_hw_40xx_diagnose_failure,
1186         .reg_pll_freq_get = ivpu_hw_40xx_reg_pll_freq_get,
1187         .reg_telemetry_offset_get = ivpu_hw_40xx_reg_telemetry_offset_get,
1188         .reg_telemetry_size_get = ivpu_hw_40xx_reg_telemetry_size_get,
1189         .reg_telemetry_enable_get = ivpu_hw_40xx_reg_telemetry_enable_get,
1190         .reg_db_set = ivpu_hw_40xx_reg_db_set,
1191         .reg_ipc_rx_addr_get = ivpu_hw_40xx_reg_ipc_rx_addr_get,
1192         .reg_ipc_rx_count_get = ivpu_hw_40xx_reg_ipc_rx_count_get,
1193         .reg_ipc_tx_set = ivpu_hw_40xx_reg_ipc_tx_set,
1194         .irq_clear = ivpu_hw_40xx_irq_clear,
1195         .irq_enable = ivpu_hw_40xx_irq_enable,
1196         .irq_disable = ivpu_hw_40xx_irq_disable,
1197         .irq_handler = ivpu_hw_40xx_irq_handler,
1198 };