// SPDX-License-Identifier: GPL-2.0+ /* * (C) Copyright 2017 Rob Clark */ #include #include #include #include #include #include #include static int simple_video_probe(struct udevice *dev) { struct video_uc_plat *plat = dev_get_uclass_plat(dev); struct video_priv *uc_priv = dev_get_uclass_priv(dev); const void *blob = gd->fdt_blob; const int node = dev_of_offset(dev); const char *format; fdt_addr_t base; fdt_size_t size; base = fdtdec_get_addr_size_auto_parent(blob, dev_of_offset(dev->parent), node, "reg", 0, &size, false); if (base == FDT_ADDR_T_NONE) { debug("%s: Failed to decode memory region\n", __func__); return -EINVAL; } debug("%s: base=%llx, size=%llu\n", __func__, base, size); /* * TODO is there some way to reserve the framebuffer * region so it isn't clobbered? */ plat->base = base; plat->size = size; video_set_flush_dcache(dev, true); debug("%s: Query resolution...\n", __func__); uc_priv->xsize = fdtdec_get_uint(blob, node, "width", 0); uc_priv->ysize = fdtdec_get_uint(blob, node, "height", 0); uc_priv->rot = fdtdec_get_uint(blob, node, "rot", 0); if (uc_priv->rot > 3) { log_debug("%s: invalid rot\n", __func__); return log_msg_ret("rot", -EINVAL); } format = fdt_getprop(blob, node, "format", NULL); debug("%s: %dx%d@%s\n", __func__, uc_priv->xsize, uc_priv->ysize, format); if (strcmp(format, "r5g6b5") == 0) { uc_priv->bpix = VIDEO_BPP16; } else if (strcmp(format, "a8b8g8r8") == 0 || strcmp(format, "x8b8g8r8") == 0) { uc_priv->bpix = VIDEO_BPP32; uc_priv->format = VIDEO_X8B8G8R8; } else if (strcmp(format, "a8r8g8b8") == 0 || strcmp(format, "x8r8g8b8") == 0) { uc_priv->bpix = VIDEO_BPP32; uc_priv->format = VIDEO_X8R8G8B8; } else if (strcmp(format, "a2r10g10b10") == 0 || strcmp(format, "x2r10g10b10") == 0) { uc_priv->bpix = VIDEO_BPP32; uc_priv->format = VIDEO_X2R10G10B10; } else { printf("%s: invalid format: %s\n", __func__, format); return -EINVAL; } return 0; } static const struct udevice_id simple_video_ids[] = { { .compatible = "simple-framebuffer" }, { } }; U_BOOT_DRIVER(simple_video) = { .name = "simple_video", .id = UCLASS_VIDEO, .of_match = simple_video_ids, .probe = simple_video_probe, };