simplefb.c 1.7 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2017 Rob Clark
  4. */
  5. #include <common.h>
  6. #include <dm.h>
  7. #include <fdtdec.h>
  8. #include <fdt_support.h>
  9. #include <log.h>
  10. #include <video.h>
  11. #include <asm/global_data.h>
  12. static int simple_video_probe(struct udevice *dev)
  13. {
  14. struct video_uc_plat *plat = dev_get_uclass_plat(dev);
  15. struct video_priv *uc_priv = dev_get_uclass_priv(dev);
  16. const void *blob = gd->fdt_blob;
  17. const int node = dev_of_offset(dev);
  18. const char *format;
  19. fdt_addr_t base;
  20. fdt_size_t size;
  21. base = fdtdec_get_addr_size_auto_parent(blob, dev_of_offset(dev->parent),
  22. node, "reg", 0, &size, false);
  23. if (base == FDT_ADDR_T_NONE) {
  24. debug("%s: Failed to decode memory region\n", __func__);
  25. return -EINVAL;
  26. }
  27. debug("%s: base=%llx, size=%llu\n", __func__, base, size);
  28. /*
  29. * TODO is there some way to reserve the framebuffer
  30. * region so it isn't clobbered?
  31. */
  32. plat->base = base;
  33. plat->size = size;
  34. video_set_flush_dcache(dev, true);
  35. debug("%s: Query resolution...\n", __func__);
  36. uc_priv->xsize = fdtdec_get_uint(blob, node, "width", 0);
  37. uc_priv->ysize = fdtdec_get_uint(blob, node, "height", 0);
  38. uc_priv->rot = 0;
  39. format = fdt_getprop(blob, node, "format", NULL);
  40. debug("%s: %dx%d@%s\n", __func__, uc_priv->xsize, uc_priv->ysize, format);
  41. if (strcmp(format, "r5g6b5") == 0) {
  42. uc_priv->bpix = VIDEO_BPP16;
  43. } else if (strcmp(format, "a8b8g8r8") == 0) {
  44. uc_priv->bpix = VIDEO_BPP32;
  45. } else {
  46. printf("%s: invalid format: %s\n", __func__, format);
  47. return -EINVAL;
  48. }
  49. return 0;
  50. }
  51. static const struct udevice_id simple_video_ids[] = {
  52. { .compatible = "simple-framebuffer" },
  53. { }
  54. };
  55. U_BOOT_DRIVER(simple_video) = {
  56. .name = "simple_video",
  57. .id = UCLASS_VIDEO,
  58. .of_match = simple_video_ids,
  59. .probe = simple_video_probe,
  60. };