#include "opt_wsdisplay_compat.h"
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: rk_fb.c,v 1.7 2022/09/25 07:50:15 riastradh Exp $");
#include <sys/param.h>
#include <sys/bus.h>
#include <sys/device.h>
#include <dev/fdt/fdtvar.h>
#include <arm/rockchip/rk_drm.h>
#include <drm/drm_drv.h>
#include <drm/drmfb.h>
static int rk_fb_match(device_t, cfdata_t, void *);
static void rk_fb_attach(device_t, device_t, void *);
static void rk_fb_init(struct rk_drm_task *);
static bool rk_fb_shutdown(device_t, int);
struct rk_fb_softc {
struct drmfb_softc sc_drmfb;
device_t sc_dev;
struct rk_drm_framebuffer *sc_fb;
struct rk_drmfb_attach_args sc_sfa;
struct rk_drm_task sc_attach_task;
};
static paddr_t rk_fb_mmapfb(struct drmfb_softc *, off_t, int);
static int rk_fb_ioctl(struct drmfb_softc *, u_long, void *, int,
lwp_t *);
static const struct drmfb_params rkfb_drmfb_params = {
.dp_mmapfb = rk_fb_mmapfb,
.dp_ioctl = rk_fb_ioctl,
};
CFATTACH_DECL_NEW(rk_fb, sizeof(struct rk_fb_softc),
rk_fb_match, rk_fb_attach, NULL, NULL);
static int
rk_fb_match(device_t parent, cfdata_t cf, void *aux)
{
return 1;
}
static void
rk_fb_attach(device_t parent, device_t self, void *aux)
{
struct rk_fb_softc * const sc = device_private(self);
struct rk_drmfb_attach_args * const sfa = aux;
sc->sc_dev = self;
sc->sc_sfa = *sfa;
sc->sc_fb = to_rk_drm_framebuffer(sfa->sfa_fb_helper->fb);
aprint_naive("\n");
aprint_normal("\n");
rk_task_init(&sc->sc_attach_task, &rk_fb_init);
rk_task_schedule(parent, &sc->sc_attach_task);
}
static void
rk_fb_turnoffandbackonagain(device_t self)
{
struct rk_fb_softc *sc = device_private(self);
struct rk_drmfb_attach_args * const sfa = &sc->sc_sfa;
mutex_lock(&sfa->sfa_fb_helper->lock);
drm_client_modeset_dpms(&sfa->sfa_fb_helper->client, DRM_MODE_DPMS_OFF);
drm_client_modeset_dpms(&sfa->sfa_fb_helper->client, DRM_MODE_DPMS_ON);
mutex_unlock(&sfa->sfa_fb_helper->lock);
}
static void
rk_fb_init(struct rk_drm_task *task)
{
struct rk_fb_softc * const sc =
container_of(task, struct rk_fb_softc, sc_attach_task);
device_t self = sc->sc_dev;
struct rk_drmfb_attach_args * const sfa = &sc->sc_sfa;
int error;
const struct drmfb_attach_args da = {
.da_dev = self,
.da_fb_helper = sfa->sfa_fb_helper,
.da_fb_sizes = &sfa->sfa_fb_sizes,
.da_fb_vaddr = sc->sc_fb->obj->vaddr,
.da_fb_linebytes = sfa->sfa_fb_linebytes,
.da_params = &rkfb_drmfb_params,
};
error = drmfb_attach(&sc->sc_drmfb, &da);
if (error) {
aprint_error_dev(self, "failed to attach drmfb: %d\n", error);
return;
}
pmf_device_register1(self, NULL, NULL, rk_fb_shutdown);
config_interrupts(self, rk_fb_turnoffandbackonagain);
}
static bool
rk_fb_shutdown(device_t self, int flags)
{
struct rk_fb_softc * const sc = device_private(self);
return drmfb_shutdown(&sc->sc_drmfb, flags);
}
static paddr_t
rk_fb_mmapfb(struct drmfb_softc *sc, off_t off, int prot)
{
struct rk_fb_softc * const tfb_sc = (struct rk_fb_softc *)sc;
struct drm_gem_cma_object *obj = tfb_sc->sc_fb->obj;
KASSERT(off >= 0);
KASSERT(off < obj->dmasize);
return bus_dmamem_mmap(obj->dmat, obj->dmasegs, 1, off, prot,
BUS_DMA_PREFETCHABLE);
}
static int
rk_fb_ioctl(struct drmfb_softc *sc, u_long cmd, void *data, int flag,
lwp_t *l)
{
struct wsdisplayio_bus_id *busid;
struct wsdisplayio_fbinfo *fbi;
struct rasops_info *ri = &sc->sc_genfb.vd.active->scr_ri;
int error;
switch (cmd) {
case WSDISPLAYIO_GET_BUSID:
busid = data;
busid->bus_type = WSDISPLAYIO_BUS_SOC;
return 0;
case WSDISPLAYIO_GTYPE:
*(u_int *)data = WSDISPLAY_TYPE_GENFB;
return 0;
case WSDISPLAYIO_GET_FBINFO:
fbi = data;
error = wsdisplayio_get_fbinfo(ri, fbi);
fbi->fbi_flags |= WSFB_VRAM_IS_RAM;
return error;
default:
return EPASSTHROUGH;
}
}