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