| // Copyright 2019 The Fuchsia Authors. All rights reserved. |
| // Use of this source code is governed by a BSD-style license that can be |
| // found in the LICENSE file. |
| |
| #include "ccorr.h" |
| |
| #include <fbl/alloc_checker.h> |
| |
| namespace mt8167s_display { |
| |
| zx_status_t Ccorr::Init(ddk::PDev& pdev) { |
| if (initialized_) { |
| return ZX_OK; |
| } |
| |
| // Map Ccorr MMIO |
| zx_status_t status = pdev.MapMmio(MMIO_DISP_CCORR, &ccorr_mmio_); |
| if (status != ZX_OK) { |
| DISP_ERROR("Could not map CCORR mmio\n"); |
| return status; |
| } |
| |
| // CCORR is ready to be used |
| initialized_ = true; |
| return ZX_OK; |
| } |
| |
| zx_status_t Ccorr::Config() { |
| ZX_DEBUG_ASSERT(initialized_); |
| // Set to bypass mode |
| CcorrEnReg::Get().ReadFrom(&(*ccorr_mmio_)).set_enable(1).WriteTo(&(*ccorr_mmio_)); |
| CcorrSizeReg::Get() |
| .ReadFrom(&(*ccorr_mmio_)) |
| .set_vsize(height_) |
| .set_hsize(width_) |
| .WriteTo(&(*ccorr_mmio_)); |
| CcorrCfgReg::Get().ReadFrom(&(*ccorr_mmio_)).set_relay(1).WriteTo(&(*ccorr_mmio_)); |
| return ZX_OK; |
| } |
| |
| void Ccorr::PrintRegisters() { |
| ZX_DEBUG_ASSERT(initialized_); |
| zxlogf(INFO, "Dumping Ccorr Registers"); |
| zxlogf(INFO, "######################\n"); |
| zxlogf(INFO, "CCORR_EN = 0x%x", ccorr_mmio_->Read32(CCORR_EN)); |
| zxlogf(INFO, "CCORR_CFG = 0x%x", ccorr_mmio_->Read32(CCORR_CFG)); |
| zxlogf(INFO, "CCORR_SIZE = 0x%x", ccorr_mmio_->Read32(CCORR_SIZE)); |
| zxlogf(INFO, "######################\n"); |
| } |
| |
| } // namespace mt8167s_display |
