zircon/system/dev/display/mt8167s-display/aal.cpp

// 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 "aal.h"
#include <fbl/alloc_checker.h>

namespace mt8167s_display {

zx_status_t Aal::Init(zx_device_t* parent) {
    if (initialized_) {
        return ZX_OK;
    }

    zx_status_t status = device_get_protocol(parent, ZX_PROTOCOL_PDEV, &pdev_);
    if (status != ZX_OK) {
        return status;
    }

    // Map Aal MMIO
    mmio_buffer_t mmio;
    status = pdev_map_mmio_buffer(&pdev_, MMIO_DISP_AAL, ZX_CACHE_POLICY_UNCACHED_DEVICE,
                                  &mmio);
    if (status != ZX_OK) {
        DISP_ERROR("Could not map AAL mmio\n");
        return status;
    }
    fbl::AllocChecker ac;
    aal_mmio_ = fbl::make_unique_checked<ddk::MmioBuffer>(&ac, mmio);
    if (!ac.check()) {
        DISP_ERROR("Could not map AAL mmio\n");
        return ZX_ERR_NO_MEMORY;
    }

    // AAL is ready to be used
    initialized_ = true;
    return ZX_OK;
}

zx_status_t Aal::Config() {
    // Set to bypass mode
    ZX_DEBUG_ASSERT(initialized_);
    AalEnReg::Get()
        .ReadFrom(&(*aal_mmio_))
        .set_enable(1)
        .WriteTo(&(*aal_mmio_));
    AalSizeReg::Get()
        .ReadFrom(&(*aal_mmio_))
        .set_vsize(height_)
        .set_hsize(width_)
        .WriteTo(&(*aal_mmio_));
    AalCfgReg::Get()
        .ReadFrom(&(*aal_mmio_))
        .set_relay(1)
        .WriteTo(&(*aal_mmio_));
    return ZX_OK;
}

void Aal::PrintRegisters() {
    ZX_DEBUG_ASSERT(initialized_);
    zxlogf(INFO, "Dumping Aal Registers\n");
    zxlogf(INFO, "######################\n\n");
    zxlogf(INFO, "AAL_EN = 0x%x\n", aal_mmio_->Read32(AAL_EN));
    zxlogf(INFO, "AAL_CFG = 0x%x\n", aal_mmio_->Read32(AAL_CFG));
    zxlogf(INFO, "AAL_SIZE = 0x%x\n", aal_mmio_->Read32(AAL_SIZE));
    zxlogf(INFO, "######################\n\n");
}

} // namespace mt8167s_display