1 /* $NetBSD: sunxi_fb.c,v 1.8 2022/09/25 07:50:23 riastradh Exp $ */
2
3 /*-
4 * Copyright (c) 2015-2019 Jared McNeill <jmcneill@invisible.ca>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 #include "opt_wsdisplay_compat.h"
30
31 #include <sys/cdefs.h>
32 __KERNEL_RCSID(0, "$NetBSD: sunxi_fb.c,v 1.8 2022/09/25 07:50:23 riastradh Exp $");
33
34 #include <sys/param.h>
35 #include <sys/bus.h>
36 #include <sys/device.h>
37
38 #include <dev/fdt/fdtvar.h>
39
40 #include <arm/sunxi/sunxi_drm.h>
41
42 #include <drm/drm_drv.h>
43 #include <drm/drmfb.h>
44
45 static int sunxi_fb_match(device_t, cfdata_t, void *);
46 static void sunxi_fb_attach(device_t, device_t, void *);
47
48 static void sunxi_fb_init(struct sunxi_drm_task *);
49
50 static bool sunxi_fb_shutdown(device_t, int);
51
52 struct sunxi_fb_softc {
53 struct drmfb_softc sc_drmfb;
54 device_t sc_dev;
55 struct sunxi_drm_softc *sc_drm;
56 struct sunxi_drm_framebuffer *sc_fb;
57 struct sunxi_drmfb_attach_args sc_sfa;
58 struct sunxi_drm_task sc_attach_task;
59 };
60
61 static paddr_t sunxi_fb_mmapfb(struct drmfb_softc *, off_t, int);
62 static int sunxi_fb_ioctl(struct drmfb_softc *, u_long, void *, int,
63 lwp_t *);
64
65 static const struct drmfb_params sunxifb_drmfb_params = {
66 .dp_mmapfb = sunxi_fb_mmapfb,
67 .dp_ioctl = sunxi_fb_ioctl,
68
69 };
70
71 CFATTACH_DECL_NEW(sunxi_fb, sizeof(struct sunxi_fb_softc),
72 sunxi_fb_match, sunxi_fb_attach, NULL, NULL);
73
74 static int
sunxi_fb_match(device_t parent,cfdata_t cf,void * aux)75 sunxi_fb_match(device_t parent, cfdata_t cf, void *aux)
76 {
77 return 1;
78 }
79
80 static void
sunxi_fb_attach(device_t parent,device_t self,void * aux)81 sunxi_fb_attach(device_t parent, device_t self, void *aux)
82 {
83 struct sunxi_fb_softc * const sc = device_private(self);
84 struct sunxi_drm_softc * const drmsc = device_private(parent);
85 struct sunxi_drmfb_attach_args * const sfa = aux;
86
87 sc->sc_dev = self;
88 sc->sc_drm = drmsc;
89 sc->sc_sfa = *sfa;
90 sc->sc_fb = to_sunxi_drm_framebuffer(sfa->sfa_fb_helper->fb);
91
92 aprint_naive("\n");
93 aprint_normal("\n");
94
95 sunxi_task_init(&sc->sc_attach_task, &sunxi_fb_init);
96 sunxi_task_schedule(parent, &sc->sc_attach_task);
97 }
98
99 static void
sunxi_fb_init(struct sunxi_drm_task * task)100 sunxi_fb_init(struct sunxi_drm_task *task)
101 {
102 struct sunxi_fb_softc * const sc =
103 container_of(task, struct sunxi_fb_softc, sc_attach_task);
104 device_t dev = sc->sc_dev;
105 struct sunxi_drmfb_attach_args * const sfa = &sc->sc_sfa;
106 int error;
107
108 const struct drmfb_attach_args da = {
109 .da_dev = dev,
110 .da_fb_helper = sfa->sfa_fb_helper,
111 .da_fb_sizes = &sfa->sfa_fb_sizes,
112 .da_fb_vaddr = sc->sc_fb->obj->vaddr,
113 .da_fb_linebytes = sfa->sfa_fb_linebytes,
114 .da_params = &sunxifb_drmfb_params,
115 };
116
117
118 error = drmfb_attach(&sc->sc_drmfb, &da);
119 if (error) {
120 aprint_error_dev(dev, "failed to attach drmfb: %d\n", error);
121 return;
122 }
123
124 pmf_device_register1(dev, NULL, NULL, sunxi_fb_shutdown);
125 }
126
127 static bool
sunxi_fb_shutdown(device_t self,int flags)128 sunxi_fb_shutdown(device_t self, int flags)
129 {
130 struct sunxi_fb_softc * const sc = device_private(self);
131
132 return drmfb_shutdown(&sc->sc_drmfb, flags);
133 }
134
135 static paddr_t
sunxi_fb_mmapfb(struct drmfb_softc * sc,off_t off,int prot)136 sunxi_fb_mmapfb(struct drmfb_softc *sc, off_t off, int prot)
137 {
138 struct sunxi_fb_softc * const tfb_sc = (struct sunxi_fb_softc *)sc;
139 struct drm_gem_cma_object *obj = tfb_sc->sc_fb->obj;
140
141 KASSERT(off >= 0);
142 KASSERT(off < obj->dmasize);
143
144 return bus_dmamem_mmap(obj->dmat, obj->dmasegs, 1, off, prot,
145 BUS_DMA_PREFETCHABLE);
146 }
147
148 static int
sunxi_fb_ioctl(struct drmfb_softc * sc,u_long cmd,void * data,int flag,lwp_t * l)149 sunxi_fb_ioctl(struct drmfb_softc *sc, u_long cmd, void *data, int flag,
150 lwp_t *l)
151 {
152 struct wsdisplayio_bus_id *busid;
153 struct wsdisplayio_fbinfo *fbi;
154 struct rasops_info *ri = &sc->sc_genfb.vd.active->scr_ri;
155 int error;
156
157 switch (cmd) {
158 case WSDISPLAYIO_GET_BUSID:
159 busid = data;
160 busid->bus_type = WSDISPLAYIO_BUS_SOC;
161 return 0;
162 case WSDISPLAYIO_GTYPE:
163 *(u_int *)data = WSDISPLAY_TYPE_GENFB;
164 return 0;
165 case WSDISPLAYIO_GET_FBINFO:
166 fbi = data;
167 error = wsdisplayio_get_fbinfo(ri, fbi);
168 fbi->fbi_flags |= WSFB_VRAM_IS_RAM;
169 return error;
170 default:
171 return EPASSTHROUGH;
172 }
173 }
174