bcm2835.c 1.5 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2012 Stephen Warren
  4. */
  5. #include <common.h>
  6. #include <dm.h>
  7. #include <video.h>
  8. #include <asm/arch/mbox.h>
  9. #include <asm/arch/msg.h>
  10. static int bcm2835_video_probe(struct udevice *dev)
  11. {
  12. struct video_uc_platdata *plat = dev_get_uclass_platdata(dev);
  13. struct video_priv *uc_priv = dev_get_uclass_priv(dev);
  14. int ret;
  15. int w, h, pitch;
  16. ulong fb_base, fb_size, fb_start, fb_end;
  17. debug("bcm2835: Query resolution...\n");
  18. ret = bcm2835_get_video_size(&w, &h);
  19. if (ret || w == 0 || h == 0)
  20. return -EIO;
  21. debug("bcm2835: Setting up display for %d x %d\n", w, h);
  22. ret = bcm2835_set_video_params(&w, &h, 32, BCM2835_MBOX_PIXEL_ORDER_RGB,
  23. BCM2835_MBOX_ALPHA_MODE_IGNORED,
  24. &fb_base, &fb_size, &pitch);
  25. if (ret)
  26. return -EIO;
  27. debug("bcm2835: Final resolution is %d x %d\n", w, h);
  28. /* Enable dcache for the frame buffer */
  29. fb_start = fb_base & ~(MMU_SECTION_SIZE - 1);
  30. fb_end = fb_base + fb_size;
  31. fb_end = ALIGN(fb_end, 1 << MMU_SECTION_SHIFT);
  32. mmu_set_region_dcache_behaviour(fb_start, fb_end - fb_start,
  33. DCACHE_WRITEBACK);
  34. video_set_flush_dcache(dev, true);
  35. uc_priv->xsize = w;
  36. uc_priv->ysize = h;
  37. uc_priv->bpix = VIDEO_BPP32;
  38. plat->base = fb_base;
  39. plat->size = fb_size;
  40. return 0;
  41. }
  42. static const struct udevice_id bcm2835_video_ids[] = {
  43. { .compatible = "brcm,bcm2835-hdmi" },
  44. { .compatible = "brcm,bcm2708-fb" },
  45. { }
  46. };
  47. U_BOOT_DRIVER(bcm2835_video) = {
  48. .name = "bcm2835_video",
  49. .id = UCLASS_VIDEO,
  50. .of_match = bcm2835_video_ids,
  51. .probe = bcm2835_video_probe,
  52. };