u-boot/drivers/video/mcde_simple.c
Tom Rini d678a59d2d Revert "Merge patch series "arm: dts: am62-beagleplay: Fix Beagleplay Ethernet""
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay
Ethernet"' I failed to notice that b4 noticed it was based on next and
so took that as the base commit and merged that part of next to master.

This reverts commit c8ffd1356d, reversing
changes made to 2ee6f3a5f7.

Reported-by: Jonas Karlman <jonas@kwiboo.se>
Signed-off-by: Tom Rini <trini@konsulko.com>
2024-05-19 08:16:36 -06:00

142 lines
3.7 KiB
C

// SPDX-License-Identifier: GPL-2.0+
/* Copyright (C) 2019 Stephan Gerhold */
#include <common.h>
#include <dm.h>
#include <log.h>
#include <video.h>
#include <asm/io.h>
#include <linux/bitfield.h>
#include <linux/iopoll.h>
#define MCDE_EXTSRC0A0 0x200
#define MCDE_EXTSRC0CONF 0x20C
#define MCDE_EXTSRC0CONF_BPP GENMASK(11, 8)
#define MCDE_OVL0CONF 0x404
#define MCDE_OVL0CONF_PPL GENMASK(10, 0)
#define MCDE_OVL0CONF_LPF GENMASK(26, 16)
#define MCDE_CHNL0SYNCHMOD 0x608
#define MCDE_CHNL0SYNCHMOD_SRC_SYNCH GENMASK(1, 0)
#define MCDE_CHNL0SYNCHSW 0x60C
#define MCDE_CHNL0SYNCHSW_SW_TRIG BIT(0)
#define MCDE_CRA0 0x800
#define MCDE_CRA0_FLOEN BIT(0)
#define MCDE_FLOW_COMPLETION_TIMEOUT 200000 /* us */
enum mcde_bpp {
MCDE_EXTSRC0CONF_BPP_1BPP_PAL,
MCDE_EXTSRC0CONF_BPP_2BPP_PAL,
MCDE_EXTSRC0CONF_BPP_4BPP_PAL,
MCDE_EXTSRC0CONF_BPP_8BPP_PAL,
MCDE_EXTSRC0CONF_BPP_RGB444,
MCDE_EXTSRC0CONF_BPP_ARGB4444,
MCDE_EXTSRC0CONF_BPP_IRGB1555,
MCDE_EXTSRC0CONF_BPP_RGB565,
MCDE_EXTSRC0CONF_BPP_RGB888,
MCDE_EXTSRC0CONF_BPP_XRGB8888,
MCDE_EXTSRC0CONF_BPP_ARGB8888,
MCDE_EXTSRC0CONF_BPP_YCBCR422,
};
enum mcde_src_synch {
MCDE_CHNL0SYNCHMOD_SRC_SYNCH_HARDWARE,
MCDE_CHNL0SYNCHMOD_SRC_SYNCH_NO_SYNCH,
MCDE_CHNL0SYNCHMOD_SRC_SYNCH_SOFTWARE,
};
struct mcde_simple_priv {
fdt_addr_t base;
enum mcde_src_synch src_synch;
};
static int mcde_simple_probe(struct udevice *dev)
{
struct mcde_simple_priv *priv = dev_get_priv(dev);
struct video_uc_plat *plat = dev_get_uclass_plat(dev);
struct video_priv *uc_priv = dev_get_uclass_priv(dev);
u32 val;
priv->base = dev_read_addr(dev);
if (priv->base == FDT_ADDR_T_NONE)
return -EINVAL;
plat->base = readl(priv->base + MCDE_EXTSRC0A0);
if (!plat->base)
return -ENODEV;
val = readl(priv->base + MCDE_OVL0CONF);
uc_priv->xsize = FIELD_GET(MCDE_OVL0CONF_PPL, val);
uc_priv->ysize = FIELD_GET(MCDE_OVL0CONF_LPF, val);
uc_priv->rot = 0;
val = readl(priv->base + MCDE_EXTSRC0CONF);
switch (FIELD_GET(MCDE_EXTSRC0CONF_BPP, val)) {
case MCDE_EXTSRC0CONF_BPP_RGB565:
uc_priv->bpix = VIDEO_BPP16;
break;
case MCDE_EXTSRC0CONF_BPP_XRGB8888:
case MCDE_EXTSRC0CONF_BPP_ARGB8888:
uc_priv->bpix = VIDEO_BPP32;
break;
default:
printf("unsupported format: %#x\n", val);
return -EINVAL;
}
val = readl(priv->base + MCDE_CHNL0SYNCHMOD);
priv->src_synch = FIELD_GET(MCDE_CHNL0SYNCHMOD_SRC_SYNCH, val);
plat->size = uc_priv->xsize * uc_priv->ysize * VNBYTES(uc_priv->bpix);
debug("MCDE base: %#lx, xsize: %d, ysize: %d, bpp: %d\n",
plat->base, uc_priv->xsize, uc_priv->ysize, VNBITS(uc_priv->bpix));
video_set_flush_dcache(dev, true);
return 0;
}
static int mcde_simple_video_sync(struct udevice *dev)
{
struct mcde_simple_priv *priv = dev_get_priv(dev);
unsigned int val;
if (priv->src_synch != MCDE_CHNL0SYNCHMOD_SRC_SYNCH_SOFTWARE)
return 0;
/* Enable flow */
val = readl(priv->base + MCDE_CRA0);
val |= MCDE_CRA0_FLOEN;
writel(val, priv->base + MCDE_CRA0);
/* Trigger a software sync */
writel(MCDE_CHNL0SYNCHSW_SW_TRIG, priv->base + MCDE_CHNL0SYNCHSW);
/* Disable flow */
val = readl(priv->base + MCDE_CRA0);
val &= ~MCDE_CRA0_FLOEN;
writel(val, priv->base + MCDE_CRA0);
/* Wait for completion */
return readl_poll_timeout(priv->base + MCDE_CRA0, val,
!(val & MCDE_CRA0_FLOEN),
MCDE_FLOW_COMPLETION_TIMEOUT);
}
static struct video_ops mcde_simple_ops = {
.video_sync = mcde_simple_video_sync,
};
static const struct udevice_id mcde_simple_ids[] = {
{ .compatible = "ste,mcde" },
{ }
};
U_BOOT_DRIVER(mcde_simple) = {
.name = "mcde_simple",
.id = UCLASS_VIDEO,
.ops = &mcde_simple_ops,
.of_match = mcde_simple_ids,
.probe = mcde_simple_probe,
.priv_auto = sizeof(struct mcde_simple_priv),
};