| // 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 <ddk/binding.h> |
| #include <ddk/platform-defs.h> |
| #include <fbl/auto_call.h> |
| #include <lib/zx/pmt.h> |
| #include <zircon/pixelformat.h> |
| #include <hw/reg.h> |
| #include <ddk/protocol/i2c.h> |
| #include <ddk/protocol/i2c-lib.h> |
| #include <ddk/protocol/gpio.h> |
| #include "ddk-interface.h" |
| #include "hi-display.h" |
| |
| extern "C" zx_status_t adv7533_init(display_t* display); |
| extern "C" zx_status_t dsi_init(display_t* display); |
| extern "C" void hdmi_init(display_t* display); |
| |
| namespace hi_display { |
| #define DISP_ERROR(fmt, ...) zxlogf(ERROR, "[%s %d]" fmt, __func__, __LINE__, ##__VA_ARGS__) |
| |
| // List of supported pixel formats |
| zx_pixel_format_t kSupportedPixelFormats[] = {ZX_PIXEL_FORMAT_RGB_x888}; |
| |
| // TODO: Update with hardware specific values |
| constexpr uint32_t kWidth = 1024; |
| constexpr uint32_t kHeight = 600; |
| constexpr uint64_t kDisplayId = 1; |
| constexpr uint32_t kRefreshRateFps = 60; |
| constexpr uint32_t kMaxLayer = 1; |
| |
| void HiDisplay::PopulateAddedDisplayArgs(added_display_args_t* args) { |
| args->display_id = kDisplayId; |
| args->edid_present = true; |
| args->panel.params.height = kHeight; |
| args->panel.params.width = kWidth; |
| args->panel.params.refresh_rate_e2 = 3000; // Just guess that it's 30fps |
| args->pixel_format_list = kSupportedPixelFormats; |
| args->pixel_format_count = countof(kSupportedPixelFormats); |
| args->cursor_info_count = 0; |
| } |
| |
| uint32_t HiDisplay::DisplayControllerImplComputeLinearStride( |
| uint32_t width, zx_pixel_format_t format) { |
| return ROUNDUP(width, 32 / ZX_PIXEL_FORMAT_BYTES(format)); |
| } |
| |
| void HiDisplay::DisplayControllerImplSetDisplayControllerInterface( |
| const display_controller_interface_t* intf) { |
| fbl::AutoLock lock(&display_lock_); |
| dc_intf_ = ddk::DisplayControllerInterfaceClient(intf); |
| added_display_args_t args; |
| PopulateAddedDisplayArgs(&args); |
| dc_intf_.OnDisplaysChanged(&args, 1, NULL, 0, NULL, 0, NULL); |
| } |
| |
| zx_status_t HiDisplay::DisplayControllerImplImportVmoImage(image_t* image, |
| zx::vmo vmo, size_t offset) { |
| zx_status_t status = ZX_OK; |
| |
| if (image->type != IMAGE_TYPE_SIMPLE || image->pixel_format != kSupportedPixelFormats[0]) { |
| status = ZX_ERR_INVALID_ARGS; |
| return status; |
| } |
| |
| void* new_handle = malloc(1); |
| image->handle = reinterpret_cast<uint64_t>(new_handle); |
| |
| return status; |
| } |
| |
| void HiDisplay::DisplayControllerImplReleaseImage(image_t* image) { |
| free(reinterpret_cast<void*>(image->handle)); |
| } |
| |
| uint32_t HiDisplay::DisplayControllerImplCheckConfiguration( |
| const display_config_t** display_configs, size_t display_count, |
| uint32_t** layer_cfg_results, size_t* layer_cfg_result_count) { |
| |
| if (display_count != 1) { |
| ZX_DEBUG_ASSERT(display_count == 0); |
| return CONFIG_DISPLAY_OK; |
| } |
| ZX_DEBUG_ASSERT(display_configs[0]->display_id == PANEL_DISPLAY_ID); |
| |
| fbl::AutoLock lock(&display_lock_); |
| |
| bool success = true; |
| if (display_configs[0]->layer_count > kMaxLayer) { |
| success = false; |
| } else { |
| const primary_layer_t& layer = display_configs[0]->layer_list[0]->cfg.primary; |
| frame_t frame = { |
| .x_pos = 0, .y_pos = 0, .width = kWidth, .height = kHeight, |
| }; |
| success = display_configs[0]->layer_list[0]->type == LAYER_TYPE_PRIMARY |
| && layer.transform_mode == FRAME_TRANSFORM_IDENTITY |
| && layer.image.width == kWidth |
| && layer.image.height == kHeight |
| && memcmp(&layer.dest_frame, &frame, sizeof(frame_t)) == 0 |
| && memcmp(&layer.src_frame, &frame, sizeof(frame_t)) == 0 |
| && display_configs[0]->cc_flags == 0 |
| && layer.alpha_mode == ALPHA_DISABLE; |
| } |
| |
| if (!success) { |
| layer_cfg_results[0][0] = CLIENT_MERGE_BASE; |
| for (unsigned i = 1; i < display_configs[0]->layer_count; i++) { |
| layer_cfg_results[0][i] = CLIENT_MERGE_SRC; |
| } |
| } |
| return CONFIG_DISPLAY_OK; |
| } |
| |
| void HiDisplay::DisplayControllerImplApplyConfiguration( |
| const display_config_t** display_configs, size_t display_count) { |
| |
| ZX_DEBUG_ASSERT(display_configs); |
| |
| fbl::AutoLock lock(&display_lock_); |
| |
| uint64_t addr; |
| if (display_count == 1 && display_configs[0]->layer_count) { |
| // Only support one display. |
| addr = |
| reinterpret_cast<uint64_t>(display_configs[0]->layer_list[0]->cfg.primary.image.handle); |
| current_image_valid_ = true; |
| current_image_ = addr; |
| } else { |
| current_image_valid_ = false; |
| } |
| } |
| |
| zx_status_t HiDisplay::DisplayControllerImplAllocateVmo(uint64_t size, zx::vmo* vmo_out) { |
| return zx::vmo::create_contiguous(bti_, size, 0, vmo_out); |
| } |
| |
| void HiDisplay::DdkUnbind() { |
| DdkRemove(); |
| } |
| |
| void HiDisplay::DdkRelease() { |
| vsync_shutdown_flag_.store(true); |
| thrd_join(vsync_thread_, NULL); |
| delete this; |
| } |
| |
| zx_status_t HiDisplay::SetupDisplayInterface() { |
| fbl::AutoLock lock(&display_lock_); |
| |
| current_image_valid_ = false; |
| |
| if (dc_intf_.is_valid()) { |
| added_display_args_t args; |
| PopulateAddedDisplayArgs(&args); |
| dc_intf_.OnDisplaysChanged(&args, 1, nullptr, 0, nullptr, 0, nullptr); |
| } |
| |
| return ZX_OK; |
| } |
| |
| int HiDisplay::VSyncThread() { |
| while (1) { |
| zx::nanosleep(zx::deadline_after(zx::sec(1) / kRefreshRateFps)); |
| if (vsync_shutdown_flag_.load()) { |
| break; |
| } |
| fbl::AutoLock lock(&display_lock_); |
| uint64_t live[] = {current_image_}; |
| bool current_image_valid = current_image_valid_; |
| if (dc_intf_.is_valid()) { |
| dc_intf_.OnDisplayVsync(kDisplayId, zx_clock_get(ZX_CLOCK_MONOTONIC), |
| live, current_image_valid); |
| } |
| } |
| |
| return 0; |
| } |
| |
| zx_status_t HiDisplay::Bind() { |
| zx_status_t status; |
| |
| // Setup Display Interface |
| status = SetupDisplayInterface(); |
| if (status != ZX_OK) { |
| DISP_ERROR("Hi-display setup failed! %d\n", status); |
| return status; |
| } |
| |
| auto start_thread = [](void* arg) { return static_cast<HiDisplay*>(arg)->VSyncThread(); }; |
| status = thrd_create_with_name(&vsync_thread_, start_thread, this, "vsync_thread"); |
| if (status != ZX_OK) { |
| DISP_ERROR("Could not create vsync_thread\n"); |
| return status; |
| } |
| |
| status = DdkAdd("hi-display"); |
| if (status != ZX_OK) { |
| DISP_ERROR("Could not add device\n"); |
| return status; |
| } |
| |
| return ZX_OK; |
| } |
| |
| } // namespace hi_display |
| |
| static void hdmi_gpio_init(display_t* display) { |
| gpio_protocol_t* gpios = display->hdmi_gpio.gpios; |
| gpio_config_out(&gpios[GPIO_MUX], 0); |
| gpio_config_out(&gpios[GPIO_PD], 0); |
| gpio_config_in(&gpios[GPIO_INT], GPIO_NO_PULL); |
| gpio_write(&gpios[GPIO_MUX], 0); |
| } |
| |
| static zx_status_t hikey_display_bind(void* ctx, zx_device_t* parent) { |
| fbl::AllocChecker ac; |
| auto dev = fbl::make_unique_checked<hi_display::HiDisplay>(&ac, parent); |
| if (!ac.check()) { |
| return ZX_ERR_NO_MEMORY; |
| } |
| |
| auto status = dev->Bind(); |
| if (status == ZX_OK) { |
| // devmgr is now in charge of the memory for dev |
| __UNUSED auto ptr = dev.release(); |
| } |
| |
| display_t* display = (display_t *)calloc(1, sizeof(display_t)); |
| if (!display) { |
| return ZX_ERR_NO_MEMORY; |
| } |
| |
| status = device_get_protocol(parent, ZX_PROTOCOL_PDEV, &display->pdev); |
| if (status != ZX_OK) { |
| goto fail; |
| } |
| display->parent = parent; |
| |
| status = pdev_map_mmio_buffer2(&display->pdev, 0, ZX_CACHE_POLICY_UNCACHED_DEVICE, |
| &display->mmio); |
| if (status != ZX_OK) { |
| zxlogf(ERROR, "display_bind: pdev_map_mmio_buffer failed\n"); |
| goto fail; |
| } |
| |
| /* Obtain the I2C devices */ |
| size_t actual; |
| if ((status = pdev_get_protocol(&display->pdev, ZX_PROTOCOL_I2C, 0, &display->i2c_dev.i2c_main, |
| sizeof(display->i2c_dev.i2c_main), &actual)) != ZX_OK) { |
| zxlogf(ERROR, "%s: Could not obtain I2C Protocol\n", __FUNCTION__); |
| goto fail; |
| } |
| if (pdev_get_protocol(&display->pdev, ZX_PROTOCOL_I2C, 1, &display->i2c_dev.i2c_cec, |
| sizeof(display->i2c_dev.i2c_cec), &actual) != ZX_OK) { |
| zxlogf(ERROR, "%s: Could not obtain I2C Protocol\n", __FUNCTION__); |
| goto fail; |
| } |
| if (pdev_get_protocol(&display->pdev, ZX_PROTOCOL_I2C, 2, &display->i2c_dev.i2c_edid, |
| sizeof(display->i2c_dev.i2c_edid), &actual) != ZX_OK) { |
| zxlogf(ERROR, "%s: Could not obtain I2C Protocol\n", __FUNCTION__); |
| goto fail; |
| } |
| |
| /* Obtain the GPIO devices */ |
| for (uint32_t i = 0; i < countof(display->hdmi_gpio.gpios); i++) { |
| if (pdev_get_protocol(&display->pdev, ZX_PROTOCOL_GPIO, i, &display->hdmi_gpio.gpios[i], |
| sizeof(display->hdmi_gpio.gpios[i]), &actual) != ZX_OK) { |
| zxlogf(ERROR, "%s: Could not obtain GPIO Protocol\n", __FUNCTION__); |
| goto fail; |
| } |
| } |
| |
| hdmi_gpio_init(display); |
| |
| if ( (status = adv7533_init(display)) != ZX_OK) { |
| zxlogf(ERROR, "%s: Error in ADV7533 Initialization %d\n", __FUNCTION__, status); |
| goto fail; |
| } |
| dsi_init(display); |
| fail: |
| return status; |
| } |
| |
| static zx_driver_ops_t hikey_display_ops = { |
| .version = DRIVER_OPS_VERSION, |
| .init = nullptr, |
| .bind = hikey_display_bind, |
| .create = nullptr, |
| .release = nullptr, |
| }; |
| |
| ZIRCON_DRIVER_BEGIN(hikey_display, hikey_display_ops, "zircon", "0.1", 4) |
| BI_ABORT_IF(NE, BIND_PROTOCOL, ZX_PROTOCOL_PDEV), |
| BI_ABORT_IF(NE, BIND_PLATFORM_DEV_VID, PDEV_VID_96BOARDS), |
| BI_ABORT_IF(NE, BIND_PLATFORM_DEV_PID, PDEV_PID_HIKEY960), |
| BI_MATCH_IF(EQ, BIND_PLATFORM_DEV_DID, PDEV_DID_HI_DISPLAY), |
| ZIRCON_DRIVER_END(hikey_display) |