1 files changed, 72 insertions, 0 deletions

diff --git a/drivers/gpu/nvgpu/gv100/gsp_gv100.c b/drivers/gpu/nvgpu/gv100/gsp_gv100.c
index 6ea7ab71..d6d01b7f 100644
--- a/drivers/gpu/nvgpu/gv100/gsp_gv100.c
+++ b/drivers/gpu/nvgpu/gv100/gsp_gv100.c
@@ -39,3 +39,75 @@ int gv100_gsp_reset(struct gk20a *g)
 
         return 0;
 }
+
+static int gsp_flcn_bl_bootstrap(struct gk20a *g,
+        struct nvgpu_falcon_bl_info *bl_info)
+{
+        struct mm_gk20a *mm = &g->mm;
+        u32 data = 0;
+        u32 status = 0;
+
+        gk20a_writel(g, pgsp_falcon_itfen_r(),
+                gk20a_readl(g, pgsp_falcon_itfen_r()) |
+                pgsp_falcon_itfen_ctxen_enable_f());
+
+        gk20a_writel(g, pgsp_falcon_nxtctx_r(),
+                pgsp_falcon_nxtctx_ctxptr_f(
+                nvgpu_inst_block_addr(g, &mm->pmu.inst_block) >> 12U) |
+                pgsp_falcon_nxtctx_ctxvalid_f(1) |
+                nvgpu_aperture_mask(g, &mm->pmu.inst_block,
+                        pgsp_falcon_nxtctx_ctxtgt_sys_ncoh_f(),
+                        pgsp_falcon_nxtctx_ctxtgt_sys_coh_f(),
+                        pgsp_falcon_nxtctx_ctxtgt_fb_f()));
+
+        data = gk20a_readl(g, pgsp_falcon_debug1_r());
+        data |= pgsp_falcon_debug1_ctxsw_mode_m();
+        gk20a_writel(g, pgsp_falcon_debug1_r(), data);
+
+        data = gk20a_readl(g, pgsp_falcon_engctl_r());
+        data |= pgsp_falcon_engctl_switch_context_true_f();
+        gk20a_writel(g, pgsp_falcon_engctl_r(), data);
+
+        status = nvgpu_flcn_bl_bootstrap(&g->gsp_flcn, bl_info);
+
+        return status;
+}
+
+int gv100_gsp_setup_hw_and_bl_bootstrap(struct gk20a *g,
+        struct hs_acr *acr_desc,
+        struct nvgpu_falcon_bl_info *bl_info)
+{
+        u32 data = 0;
+        int err = 0;
+
+        err = nvgpu_flcn_reset(&g->gsp_flcn);
+        if (err != 0) {
+                goto exit;
+        }
+
+        data = gk20a_readl(g, pgsp_fbif_ctl_r());
+        data |= pgsp_fbif_ctl_allow_phys_no_ctx_allow_f();
+        gk20a_writel(g, pgsp_fbif_ctl_r(), data);
+
+        /* setup apertures - virtual */
+        gk20a_writel(g, pgsp_fbif_transcfg_r(GK20A_PMU_DMAIDX_UCODE),
+                        pgsp_fbif_transcfg_mem_type_physical_f() |
+                        pgsp_fbif_transcfg_target_local_fb_f());
+        gk20a_writel(g, pgsp_fbif_transcfg_r(GK20A_PMU_DMAIDX_VIRT),
+                        pgsp_fbif_transcfg_mem_type_virtual_f());
+        /* setup apertures - physical */
+        gk20a_writel(g, pgsp_fbif_transcfg_r(GK20A_PMU_DMAIDX_PHYS_VID),
+                        pgsp_fbif_transcfg_mem_type_physical_f() |
+                        pgsp_fbif_transcfg_target_local_fb_f());
+        gk20a_writel(g, pgsp_fbif_transcfg_r(GK20A_PMU_DMAIDX_PHYS_SYS_COH),
+                        pgsp_fbif_transcfg_mem_type_physical_f() |
+                        pgsp_fbif_transcfg_target_coherent_sysmem_f());
+        gk20a_writel(g, pgsp_fbif_transcfg_r(GK20A_PMU_DMAIDX_PHYS_SYS_NCOH),
+                        pgsp_fbif_transcfg_mem_type_physical_f() |
+                        pgsp_fbif_transcfg_target_noncoherent_sysmem_f());
+
+        err = gsp_flcn_bl_bootstrap(g, bl_info);
+
+exit:
+        return err;
+}