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