Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2012 Stephen Warren |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 4 | */ |
| 5 | |
| 6 | #include <common.h> |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 7 | #include <dm.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 8 | #include <log.h> |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 9 | #include <video.h> |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 10 | #include <asm/arch/mbox.h> |
Simon Glass | 31efc38 | 2017-04-05 16:23:40 -0600 | [diff] [blame] | 11 | #include <asm/arch/msg.h> |
Simon Glass | 274e0b0 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 12 | #include <asm/cache.h> |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 13 | |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 14 | static int bcm2835_video_probe(struct udevice *dev) |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 15 | { |
Simon Glass | b75b15b | 2020-12-03 16:55:23 -0700 | [diff] [blame] | 16 | struct video_uc_plat *plat = dev_get_uclass_plat(dev); |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 17 | struct video_priv *uc_priv = dev_get_uclass_priv(dev); |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 18 | int ret; |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 19 | int w, h, pitch; |
Simon Glass | 929df01 | 2017-04-05 16:23:41 -0600 | [diff] [blame] | 20 | ulong fb_base, fb_size, fb_start, fb_end; |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 21 | |
| 22 | debug("bcm2835: Query resolution...\n"); |
Simon Glass | 31efc38 | 2017-04-05 16:23:40 -0600 | [diff] [blame] | 23 | ret = bcm2835_get_video_size(&w, &h); |
Fabian Vogt | 26d33e5 | 2019-07-11 16:56:24 +0200 | [diff] [blame] | 24 | if (ret || w == 0 || h == 0) |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 25 | return -EIO; |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 26 | |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 27 | debug("bcm2835: Setting up display for %d x %d\n", w, h); |
Simon Glass | 929df01 | 2017-04-05 16:23:41 -0600 | [diff] [blame] | 28 | ret = bcm2835_set_video_params(&w, &h, 32, BCM2835_MBOX_PIXEL_ORDER_RGB, |
| 29 | BCM2835_MBOX_ALPHA_MODE_IGNORED, |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 30 | &fb_base, &fb_size, &pitch); |
Fabian Vogt | 26d33e5 | 2019-07-11 16:56:24 +0200 | [diff] [blame] | 31 | if (ret) |
| 32 | return -EIO; |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 33 | |
| 34 | debug("bcm2835: Final resolution is %d x %d\n", w, h); |
| 35 | |
Alexander Graf | 2e1075c | 2016-03-24 10:31:11 +0100 | [diff] [blame] | 36 | /* Enable dcache for the frame buffer */ |
Simon Glass | 929df01 | 2017-04-05 16:23:41 -0600 | [diff] [blame] | 37 | fb_start = fb_base & ~(MMU_SECTION_SIZE - 1); |
| 38 | fb_end = fb_base + fb_size; |
Alexander Graf | 2e1075c | 2016-03-24 10:31:11 +0100 | [diff] [blame] | 39 | fb_end = ALIGN(fb_end, 1 << MMU_SECTION_SHIFT); |
| 40 | mmu_set_region_dcache_behaviour(fb_start, fb_end - fb_start, |
Simon Glass | 929df01 | 2017-04-05 16:23:41 -0600 | [diff] [blame] | 41 | DCACHE_WRITEBACK); |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 42 | video_set_flush_dcache(dev, true); |
Stephen Warren | 4ecd498 | 2013-01-29 16:37:40 +0000 | [diff] [blame] | 43 | |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 44 | uc_priv->xsize = w; |
| 45 | uc_priv->ysize = h; |
| 46 | uc_priv->bpix = VIDEO_BPP32; |
| 47 | plat->base = fb_base; |
| 48 | plat->size = fb_size; |
| 49 | |
| 50 | return 0; |
Andre Heider | 191211c | 2013-11-09 11:07:53 +0100 | [diff] [blame] | 51 | } |
| 52 | |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 53 | static const struct udevice_id bcm2835_video_ids[] = { |
| 54 | { .compatible = "brcm,bcm2835-hdmi" }, |
Emmanuel Vadot | e270519 | 2018-07-02 14:33:14 +0200 | [diff] [blame] | 55 | { .compatible = "brcm,bcm2708-fb" }, |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 56 | { } |
| 57 | }; |
Simon Glass | 929df01 | 2017-04-05 16:23:41 -0600 | [diff] [blame] | 58 | |
Simon Glass | 39254d0 | 2017-04-05 16:23:44 -0600 | [diff] [blame] | 59 | U_BOOT_DRIVER(bcm2835_video) = { |
| 60 | .name = "bcm2835_video", |
| 61 | .id = UCLASS_VIDEO, |
| 62 | .of_match = bcm2835_video_ids, |
| 63 | .probe = bcm2835_video_probe, |
| 64 | }; |