platinumfb.c revision 1.2.2.2
1 1.2.2.2 skrll /* 2 1.2.2.2 skrll * Redistribution and use in source and binary forms, with or without 3 1.2.2.2 skrll * modification, are permitted provided that the following conditions 4 1.2.2.2 skrll * are met: 5 1.2.2.2 skrll * 1. Redistributions of source code must retain the above copyright 6 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer. 7 1.2.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 8 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer in the 9 1.2.2.2 skrll * documentation and/or other materials provided with the distribution. 10 1.2.2.2 skrll * 11 1.2.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 12 1.2.2.2 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 13 1.2.2.2 skrll * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 14 1.2.2.2 skrll * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 15 1.2.2.2 skrll * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 16 1.2.2.2 skrll * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 17 1.2.2.2 skrll * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 18 1.2.2.2 skrll * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 19 1.2.2.2 skrll * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 20 1.2.2.2 skrll * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 21 1.2.2.2 skrll */ 22 1.2.2.2 skrll 23 1.2.2.2 skrll /* A console driver for Apple's Platinum onboard video controller, 24 1.2.2.2 skrll * found in (all?) Catalyst logic boards including the Powermac 7200. 25 1.2.2.2 skrll * 26 1.2.2.2 skrll * Used valkyriefb.c from NetBSD, and platinumfb.c/platinumfb.h from 27 1.2.2.2 skrll * Linux sources as templates. 28 1.2.2.2 skrll * 29 1.2.2.2 skrll * Platinum is broken regarding openfirmware video variables. In OF, 30 1.2.2.2 skrll * for a powermac 7200, doing "dev /platinum .properties" results in: 31 1.2.2.2 skrll * 32 1.2.2.2 skrll * name platinum 33 1.2.2.2 skrll * device_type display 34 1.2.2.2 skrll * model AAPL,343S1184 35 1.2.2.2 skrll * AAPL,connector monitor 36 1.2.2.2 skrll * reg F8000000 00000800 37 1.2.2.2 skrll * F1000000 01000000 38 1.2.2.2 skrll * AAPL,interrupts 0000001E 39 1.2.2.2 skrll * 40 1.2.2.2 skrll * The first reg is the register set, and the second is for the 41 1.2.2.2 skrll * framebuffer. There is also a set of colormap registers hardcoded 42 1.2.2.2 skrll * in platinumfbreg.h that (I think) aren't in openfirmware. 43 1.2.2.2 skrll * 44 1.2.2.2 skrll * powermac 7200 VRAM min and max limits are 1 and 4 Mb respectively. 45 1.2.2.2 skrll * OF claims 16M so we don't use that value. If other machines can 46 1.2.2.2 skrll * can have more or less VRAM this code will need to be modified 47 1.2.2.2 skrll */ 48 1.2.2.2 skrll 49 1.2.2.2 skrll #include <sys/cdefs.h> 50 1.2.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: platinumfb.c,v 1.2.2.2 2016/07/09 20:24:53 skrll Exp $"); 51 1.2.2.2 skrll 52 1.2.2.2 skrll #include <sys/param.h> 53 1.2.2.2 skrll #include <sys/systm.h> 54 1.2.2.2 skrll #include <sys/kernel.h> 55 1.2.2.2 skrll #include <sys/device.h> 56 1.2.2.2 skrll 57 1.2.2.2 skrll #include <uvm/uvm_param.h> 58 1.2.2.2 skrll 59 1.2.2.2 skrll #include <dev/ofw/openfirm.h> 60 1.2.2.2 skrll 61 1.2.2.2 skrll #include <machine/autoconf.h> 62 1.2.2.2 skrll #include <machine/pio.h> 63 1.2.2.2 skrll 64 1.2.2.2 skrll #include <dev/wscons/wsdisplayvar.h> 65 1.2.2.2 skrll #include <dev/wscons/wsconsio.h> 66 1.2.2.2 skrll #include <dev/wsfont/wsfont.h> 67 1.2.2.2 skrll #include <dev/rasops/rasops.h> 68 1.2.2.2 skrll #include <dev/wscons/wsdisplay_vconsvar.h> 69 1.2.2.2 skrll 70 1.2.2.2 skrll #include <dev/videomode/videomode.h> 71 1.2.2.2 skrll 72 1.2.2.2 skrll #include <arch/macppc/dev/platinumfbreg.h> 73 1.2.2.2 skrll 74 1.2.2.2 skrll #include <sys/sysctl.h> 75 1.2.2.2 skrll 76 1.2.2.2 skrll #include "opt_wsemul.h" 77 1.2.2.2 skrll 78 1.2.2.2 skrll /* 79 1.2.2.2 skrll * here is a link of supported modes and resolutions: 80 1.2.2.2 skrll * https://support.apple.com/kb/SP343?locale=en_US 81 1.2.2.2 skrll * 82 1.2.2.2 skrll * default console and X bpp/depth for built-in X config file, 83 1.2.2.2 skrll * select 8 or 16 or 32. 84 1.2.2.2 skrll * 85 1.2.2.2 skrll */ 86 1.2.2.2 skrll #define PLATINUM_CONSOLE_DEPTH 8 87 1.2.2.2 skrll #define PLATINUM_FB_DEPTH 16 88 1.2.2.2 skrll 89 1.2.2.2 skrll /* 90 1.2.2.2 skrll * resolution, from one of platinumfb_setting vmode_name's. 91 1.2.2.2 skrll */ 92 1.2.2.2 skrll #define PLATINUM_FB_VMODE "1024x768x60" 93 1.2.2.2 skrll 94 1.2.2.2 skrll struct platinumfb_setting { 95 1.2.2.2 skrll char vmode_name[24]; 96 1.2.2.2 skrll int32_t width; 97 1.2.2.2 skrll int32_t height; 98 1.2.2.2 skrll uint8_t freq; 99 1.2.2.2 skrll uint8_t macmode; 100 1.2.2.2 skrll 101 1.2.2.2 skrll int32_t pitch[3]; 102 1.2.2.2 skrll uint32_t regs[26]; 103 1.2.2.2 skrll uint8_t offset[3]; 104 1.2.2.2 skrll uint8_t mode[3]; 105 1.2.2.2 skrll uint8_t dacula_ctrl[3]; 106 1.2.2.2 skrll uint8_t clock_params[2][2]; 107 1.2.2.2 skrll }; 108 1.2.2.2 skrll 109 1.2.2.2 skrll struct platinumfb_softc { 110 1.2.2.2 skrll device_t sc_dev; 111 1.2.2.2 skrll int sc_node; 112 1.2.2.2 skrll 113 1.2.2.2 skrll uint8_t *sc_reg; 114 1.2.2.2 skrll uint32_t sc_reg_size; 115 1.2.2.2 skrll 116 1.2.2.2 skrll uint8_t *sc_cmap; 117 1.2.2.2 skrll uint32_t sc_cmap_size; 118 1.2.2.2 skrll 119 1.2.2.2 skrll uint8_t *sc_fb; 120 1.2.2.2 skrll uint32_t sc_fb_size; 121 1.2.2.2 skrll 122 1.2.2.2 skrll int sc_depth; 123 1.2.2.2 skrll int sc_width, sc_height, sc_linebytes; 124 1.2.2.2 skrll const struct videomode *sc_videomode; 125 1.2.2.2 skrll uint8_t sc_modereg; 126 1.2.2.2 skrll 127 1.2.2.2 skrll int sc_mode; 128 1.2.2.2 skrll 129 1.2.2.2 skrll u_char sc_cmap_red[256]; 130 1.2.2.2 skrll u_char sc_cmap_green[256]; 131 1.2.2.2 skrll u_char sc_cmap_blue[256]; 132 1.2.2.2 skrll 133 1.2.2.2 skrll struct vcons_data vd; 134 1.2.2.2 skrll 135 1.2.2.2 skrll uint8_t sc_cmode; 136 1.2.2.2 skrll uint8_t sc_dac_type; 137 1.2.2.2 skrll uint32_t sc_vram; 138 1.2.2.2 skrll int sc_on; 139 1.2.2.2 skrll struct platinumfb_setting *sc_pfs; 140 1.2.2.2 skrll }; 141 1.2.2.2 skrll 142 1.2.2.2 skrll #define DIV2 0x20 143 1.2.2.2 skrll #define DIV4 0x40 144 1.2.2.2 skrll #define DIV8 0x60 145 1.2.2.2 skrll #define DIV16 0x80 146 1.2.2.2 skrll 147 1.2.2.2 skrll static struct platinumfb_setting platinum_5 = { 148 1.2.2.2 skrll "640x480x60", 149 1.2.2.2 skrll 640, 480, 60, 5, 150 1.2.2.2 skrll { 672, 1312, 2592 }, 151 1.2.2.2 skrll { 0xff0, 4, 0, 0, 0, 0, 0x320, 0, 152 1.2.2.2 skrll 0, 0x15e, 0xc8, 0x18, 0x18f, 0x2f, 0x35, 0x3e, 153 1.2.2.2 skrll 0x42, 0x182, 0x18e, 0x41a, 0x418, 2, 7, 0x44, 154 1.2.2.2 skrll 0x404, 0x408 }, { 0x34, 0x3c, 0x41 }, 155 1.2.2.2 skrll { 2, 0, 0xff }, { 0x11, 0x15, 0x19 }, 156 1.2.2.2 skrll {{ 26, 0 + DIV8 }, { 14, 2 + DIV4 }} 157 1.2.2.2 skrll }; 158 1.2.2.2 skrll 159 1.2.2.2 skrll static struct platinumfb_setting platinum_12 = { 160 1.2.2.2 skrll "800x600x75", 161 1.2.2.2 skrll 800, 600, 75, 12, 162 1.2.2.2 skrll { 832, 1632, 3232 }, 163 1.2.2.2 skrll { 0xff0, 4, 0, 0, 0, 0, 0x320, 0, 164 1.2.2.2 skrll 0, 0x1ce, 0x108, 0x14, 0x20f, 0x27, 0x30, 0x39, 165 1.2.2.2 skrll 0x72, 0x202, 0x20e, 0x4e2, 0x4e0, 4, 9, 0x2e, 166 1.2.2.2 skrll 0x4de, 0x4df }, { 0x64, 0x6c, 0x71 }, 167 1.2.2.2 skrll { 2, 0, 0xff }, { 0x11, 0x15, 0x19 }, 168 1.2.2.2 skrll {{ 122, 7 + DIV4 }, { 62, 9 + DIV2 }} 169 1.2.2.2 skrll }; 170 1.2.2.2 skrll 171 1.2.2.2 skrll static struct platinumfb_setting platinum_14 = { 172 1.2.2.2 skrll "1024x768x60", 173 1.2.2.2 skrll 1024, 768, 60, 14, 174 1.2.2.2 skrll { 1056, 2080, 4128 }, 175 1.2.2.2 skrll { 0xff0, 4, 0, 0, 0, 0, 0x320, 0, 176 1.2.2.2 skrll 0, 0x25a, 0x14f, 0x22, 0x29f, 0x43, 0x49, 0x5b, 177 1.2.2.2 skrll 0x8e, 0x28e, 0x29e, 0x64c, 0x64a, 0xa, 0xf, 0x44, 178 1.2.2.2 skrll 0x644, 0x646 }, { 0x80, 0x88, 0x8d }, 179 1.2.2.2 skrll { 2, 0, 0xff }, { 0x11, 0x15, 0x19 }, 180 1.2.2.2 skrll {{ 71, 6 + DIV2 }, { 118, 13 + DIV2 }} 181 1.2.2.2 skrll }; 182 1.2.2.2 skrll 183 1.2.2.2 skrll static struct platinumfb_setting platinum_20 = { 184 1.2.2.2 skrll "1280x1024x75", 185 1.2.2.2 skrll 1280, 1024, 75, 20, 186 1.2.2.2 skrll { 1312, 2592, 2592 }, 187 1.2.2.2 skrll { 0xffc, 4, 0, 0, 0, 0, 0x428, 0, 188 1.2.2.2 skrll 0, 0xb3, 0xd3, 0x12, 0x1a5, 0x23, 0x28, 0x2d, 189 1.2.2.2 skrll 0x5e, 0x19e, 0x1a4, 0x854, 0x852, 4, 9, 0x50, 190 1.2.2.2 skrll 0x850, 0x851 }, { 0x58, 0x5d, 0x5d }, 191 1.2.2.2 skrll { 0, 0xff, 0xff }, { 0x51, 0x55, 0x55 }, 192 1.2.2.2 skrll {{ 45, 3 }, { 66, 7 }} 193 1.2.2.2 skrll }; 194 1.2.2.2 skrll 195 1.2.2.2 skrll static struct platinumfb_setting *pfb_setting[] = { 196 1.2.2.2 skrll &platinum_5, 197 1.2.2.2 skrll &platinum_12, 198 1.2.2.2 skrll &platinum_14, 199 1.2.2.2 skrll &platinum_20 200 1.2.2.2 skrll }; 201 1.2.2.2 skrll 202 1.2.2.2 skrll static struct vcons_screen platinumfb_console_screen; 203 1.2.2.2 skrll 204 1.2.2.2 skrll static int platinumfb_match(device_t, cfdata_t, void *); 205 1.2.2.2 skrll static void platinumfb_attach(device_t, device_t, void *); 206 1.2.2.2 skrll 207 1.2.2.2 skrll CFATTACH_DECL_NEW(platinumfb, sizeof(struct platinumfb_softc), 208 1.2.2.2 skrll platinumfb_match, platinumfb_attach, NULL, NULL); 209 1.2.2.2 skrll 210 1.2.2.2 skrll static int platinumfb_init(device_t); 211 1.2.2.2 skrll static int platinumfb_set_mode(struct platinumfb_softc *, 212 1.2.2.2 skrll const struct videomode *, int); 213 1.2.2.2 skrll static void platinumfb_set_rasops(struct platinumfb_softc *, 214 1.2.2.2 skrll struct rasops_info *, int); 215 1.2.2.2 skrll static int platinumfb_ioctl(void *, void *, u_long, void *, int, 216 1.2.2.2 skrll struct lwp *); 217 1.2.2.2 skrll static paddr_t platinumfb_mmap(void *, void *, off_t, int); 218 1.2.2.2 skrll static void platinumfb_init_screen(void *, struct vcons_screen *, int, 219 1.2.2.2 skrll long *); 220 1.2.2.2 skrll static int platinumfb_putcmap(struct platinumfb_softc *, 221 1.2.2.2 skrll struct wsdisplay_cmap *); 222 1.2.2.2 skrll static int platinumfb_getcmap(struct platinumfb_softc *, 223 1.2.2.2 skrll struct wsdisplay_cmap *); 224 1.2.2.2 skrll static void platinumfb_init_cmap(struct platinumfb_softc *); 225 1.2.2.2 skrll static void platinumfb_restore_palette(struct platinumfb_softc *); 226 1.2.2.2 skrll static void platinumfb_putpalreg(struct platinumfb_softc *, 227 1.2.2.2 skrll uint8_t, uint8_t, uint8_t, uint8_t); 228 1.2.2.2 skrll static uint32_t platinumfb_line_tweak(struct platinumfb_softc *); 229 1.2.2.2 skrll static paddr_t platinumfb_page_align_up(struct platinumfb_softc *); 230 1.2.2.2 skrll static void platinumfb_set_clock(struct platinumfb_softc *); 231 1.2.2.2 skrll static void platinumfb_dac_type(struct platinumfb_softc *); 232 1.2.2.2 skrll static void platinumfb_memory_size(struct platinumfb_softc *); 233 1.2.2.2 skrll static void platinumfb_set_hardware(struct platinumfb_softc *); 234 1.2.2.2 skrll 235 1.2.2.2 skrll static inline void platinumfb_write_reg(struct platinumfb_softc *, 236 1.2.2.2 skrll int, uint32_t); 237 1.2.2.2 skrll 238 1.2.2.2 skrll #ifdef notyet 239 1.2.2.2 skrll static inline uint32_t platinumfb_read_reg(struct platinumfb_softc *, int); 240 1.2.2.2 skrll #endif 241 1.2.2.2 skrll static inline void platinumfb_write_cmap_reg(struct platinumfb_softc *, 242 1.2.2.2 skrll int, uint8_t); 243 1.2.2.2 skrll static inline uint8_t platinumfb_read_cmap_reg(struct platinumfb_softc *, int); 244 1.2.2.2 skrll static inline void platinumfb_store_d2(struct platinumfb_softc *, 245 1.2.2.2 skrll uint8_t, uint8_t); 246 1.2.2.2 skrll 247 1.2.2.2 skrll struct wsscreen_descr platinumfb_defaultscreen = { 248 1.2.2.2 skrll "default", 249 1.2.2.2 skrll 0, 0, 250 1.2.2.2 skrll NULL, 251 1.2.2.2 skrll 8, 16, 252 1.2.2.2 skrll WSSCREEN_WSCOLORS | WSSCREEN_HILIT, 253 1.2.2.2 skrll NULL, 254 1.2.2.2 skrll }; 255 1.2.2.2 skrll 256 1.2.2.2 skrll const struct wsscreen_descr *_platinumfb_scrlist[] = { 257 1.2.2.2 skrll &platinumfb_defaultscreen, 258 1.2.2.2 skrll /* XXX other formats, graphics screen? */ 259 1.2.2.2 skrll }; 260 1.2.2.2 skrll 261 1.2.2.2 skrll struct wsscreen_list platinumfb_screenlist = { 262 1.2.2.2 skrll sizeof(_platinumfb_scrlist) / sizeof(struct wsscreen_descr *), 263 1.2.2.2 skrll _platinumfb_scrlist 264 1.2.2.2 skrll }; 265 1.2.2.2 skrll 266 1.2.2.2 skrll struct wsdisplay_accessops platinumfb_accessops = { 267 1.2.2.2 skrll platinumfb_ioctl, 268 1.2.2.2 skrll platinumfb_mmap, 269 1.2.2.2 skrll NULL, 270 1.2.2.2 skrll NULL, 271 1.2.2.2 skrll NULL, 272 1.2.2.2 skrll NULL, /* load_font */ 273 1.2.2.2 skrll NULL, /* polls */ 274 1.2.2.2 skrll NULL, /* scroll */ 275 1.2.2.2 skrll }; 276 1.2.2.2 skrll 277 1.2.2.2 skrll static inline void 278 1.2.2.2 skrll platinumfb_write_reg(struct platinumfb_softc *sc, int reg, uint32_t val) 279 1.2.2.2 skrll { 280 1.2.2.2 skrll out32(sc->sc_reg + PLATINUM_REG_OFFSET_ADDR(reg), val); 281 1.2.2.2 skrll } 282 1.2.2.2 skrll 283 1.2.2.2 skrll #ifdef notyet 284 1.2.2.2 skrll static inline uint32_t 285 1.2.2.2 skrll platinumfb_read_reg(struct platinumfb_softc *sc, int reg) 286 1.2.2.2 skrll { 287 1.2.2.2 skrll return in32(sc->sc_reg + PLATINUM_REG_OFFSET_ADDR(reg)); 288 1.2.2.2 skrll } 289 1.2.2.2 skrll #endif 290 1.2.2.2 skrll 291 1.2.2.2 skrll static inline void 292 1.2.2.2 skrll platinumfb_write_cmap_reg(struct platinumfb_softc *sc, 293 1.2.2.2 skrll int reg_offset, uint8_t val) 294 1.2.2.2 skrll { 295 1.2.2.2 skrll out8(sc->sc_cmap + reg_offset, val); 296 1.2.2.2 skrll } 297 1.2.2.2 skrll 298 1.2.2.2 skrll static inline uint8_t 299 1.2.2.2 skrll platinumfb_read_cmap_reg(struct platinumfb_softc *sc, int reg_offset) 300 1.2.2.2 skrll { 301 1.2.2.2 skrll return in8(sc->sc_cmap + reg_offset); 302 1.2.2.2 skrll } 303 1.2.2.2 skrll 304 1.2.2.2 skrll static inline void 305 1.2.2.2 skrll platinumfb_store_d2(struct platinumfb_softc *sc, 306 1.2.2.2 skrll uint8_t a, uint8_t d) 307 1.2.2.2 skrll { 308 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_ADDR_OFFSET, a + 32); 309 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_D2_OFFSET, d); 310 1.2.2.2 skrll } 311 1.2.2.2 skrll 312 1.2.2.2 skrll static void 313 1.2.2.2 skrll platinumfb_putpalreg(struct platinumfb_softc *sc, 314 1.2.2.2 skrll uint8_t reg, uint8_t r, uint8_t g, uint8_t b) 315 1.2.2.2 skrll { 316 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_ADDR_OFFSET, reg); 317 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_LUT_OFFSET, r); 318 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_LUT_OFFSET, g); 319 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_LUT_OFFSET, b); 320 1.2.2.2 skrll } 321 1.2.2.2 skrll 322 1.2.2.2 skrll static uint32_t 323 1.2.2.2 skrll platinumfb_line_tweak(struct platinumfb_softc *sc) 324 1.2.2.2 skrll { 325 1.2.2.2 skrll /* bytes per line adjustment depending on resolution and depth */ 326 1.2.2.2 skrll if (sc->sc_cmode > PLATINUM_CMODE_8 && 327 1.2.2.2 skrll strcmp(sc->sc_pfs->vmode_name, "832x624x75") == 0) 328 1.2.2.2 skrll return 0x10; 329 1.2.2.2 skrll else 330 1.2.2.2 skrll return 0x20; 331 1.2.2.2 skrll } 332 1.2.2.2 skrll 333 1.2.2.2 skrll static paddr_t 334 1.2.2.2 skrll platinumfb_page_align_up(struct platinumfb_softc *sc) 335 1.2.2.2 skrll { 336 1.2.2.2 skrll /* round up framebuffer address to the next highest page */ 337 1.2.2.2 skrll paddr_t addr = (paddr_t)sc->sc_fb; 338 1.2.2.2 skrll paddr_t ret = round_page(addr); 339 1.2.2.2 skrll 340 1.2.2.2 skrll if (ret == addr) 341 1.2.2.2 skrll ret = round_page(addr + 1); 342 1.2.2.2 skrll 343 1.2.2.2 skrll return ret; 344 1.2.2.2 skrll } 345 1.2.2.2 skrll 346 1.2.2.2 skrll /* 2 versions of platinum clock, older one uses clock[1] and 347 1.2.2.2 skrll * freq = 14.3Mhz * c0 / (c1 & 0x1f) / (1 << (c1 >> 5)) 348 1.2.2.2 skrll * newer one uses clock[0] and 349 1.2.2.2 skrll * freq = 15Mhz * c0 / ((c1 & 0x1f) + 2) / (1 << (c1 >> 5)) 350 1.2.2.2 skrll */ 351 1.2.2.2 skrll static void 352 1.2.2.2 skrll platinumfb_set_clock(struct platinumfb_softc *sc) 353 1.2.2.2 skrll { 354 1.2.2.2 skrll uint8_t clk_idx = sc->sc_dac_type == PLATINUM_DAC_1 ? 1 : 0; 355 1.2.2.2 skrll uint8_t d2; 356 1.2.2.2 skrll 357 1.2.2.2 skrll platinumfb_store_d2(sc, 6, 0xc6); 358 1.2.2.2 skrll 359 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_ADDR_OFFSET, 3+32); 360 1.2.2.2 skrll d2 = platinumfb_read_cmap_reg(sc, PLATINUM_CMAP_D2_OFFSET); 361 1.2.2.2 skrll 362 1.2.2.2 skrll if (d2 == 2) { 363 1.2.2.2 skrll platinumfb_store_d2(sc, 7, sc->sc_pfs->clock_params[clk_idx][0]); 364 1.2.2.2 skrll platinumfb_store_d2(sc, 8, sc->sc_pfs->clock_params[clk_idx][1]); 365 1.2.2.2 skrll platinumfb_store_d2(sc, 3, 3); 366 1.2.2.2 skrll } else { 367 1.2.2.2 skrll platinumfb_store_d2(sc, 4, sc->sc_pfs->clock_params[clk_idx][0]); 368 1.2.2.2 skrll platinumfb_store_d2(sc, 5, sc->sc_pfs->clock_params[clk_idx][1]); 369 1.2.2.2 skrll platinumfb_store_d2(sc, 3, 2); 370 1.2.2.2 skrll } 371 1.2.2.2 skrll 372 1.2.2.2 skrll delay(5000); 373 1.2.2.2 skrll platinumfb_store_d2(sc, 9, 0xa6); 374 1.2.2.2 skrll } 375 1.2.2.2 skrll 376 1.2.2.2 skrll static void 377 1.2.2.2 skrll platinumfb_dac_type(struct platinumfb_softc *sc) 378 1.2.2.2 skrll { 379 1.2.2.2 skrll uint8_t dtype = 0; 380 1.2.2.2 skrll 381 1.2.2.2 skrll platinumfb_write_cmap_reg(sc, PLATINUM_CMAP_ADDR_OFFSET, 0x40); 382 1.2.2.2 skrll dtype = platinumfb_read_cmap_reg(sc, PLATINUM_CMAP_D2_OFFSET); 383 1.2.2.2 skrll 384 1.2.2.2 skrll switch (dtype) { 385 1.2.2.2 skrll case PLATINUM_DAC_0: 386 1.2.2.2 skrll case PLATINUM_DAC_1: 387 1.2.2.2 skrll /* do nothing */ 388 1.2.2.2 skrll break; 389 1.2.2.2 skrll default: 390 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, "unknown dac 0x%x, using 0x%x\n", 391 1.2.2.2 skrll dtype, PLATINUM_DAC_0); 392 1.2.2.2 skrll dtype = PLATINUM_DAC_0; 393 1.2.2.2 skrll break; 394 1.2.2.2 skrll } 395 1.2.2.2 skrll 396 1.2.2.2 skrll /* save type */ 397 1.2.2.2 skrll sc->sc_dac_type = dtype; 398 1.2.2.2 skrll } 399 1.2.2.2 skrll 400 1.2.2.2 skrll static void 401 1.2.2.2 skrll platinumfb_memory_size(struct platinumfb_softc *sc) 402 1.2.2.2 skrll { 403 1.2.2.2 skrll int i; 404 1.2.2.2 skrll off_t offset = PLATINUM_FB_BANK_SIZE; 405 1.2.2.2 skrll paddr_t total_vram = PLATINUM_FB_MIN_SIZE; 406 1.2.2.2 skrll 407 1.2.2.2 skrll uint8_t test_val[] = {0x34, 0x56, 0x78}; 408 1.2.2.2 skrll uint8_t bank[] = {0, 0, 0}; 409 1.2.2.2 skrll uint8_t num_elems = sizeof(test_val)/sizeof(test_val[0]); 410 1.2.2.2 skrll 411 1.2.2.2 skrll volatile uint8_t *fbuffer = mapiodev((paddr_t)sc->sc_fb, sc->sc_fb_size, false); 412 1.2.2.2 skrll 413 1.2.2.2 skrll if (fbuffer == NULL) 414 1.2.2.2 skrll panic("platinumfb could not mapiodev"); 415 1.2.2.2 skrll 416 1.2.2.2 skrll /* turn on all banks of RAM */ 417 1.2.2.2 skrll platinumfb_write_reg(sc, 16, (paddr_t)sc->sc_fb); 418 1.2.2.2 skrll platinumfb_write_reg(sc, 20, 0x1011); 419 1.2.2.2 skrll platinumfb_write_reg(sc, 24, 0); 420 1.2.2.2 skrll 421 1.2.2.2 skrll /* 422 1.2.2.2 skrll * write "unique" value to each bank of memory and read value 423 1.2.2.2 skrll * back. if match assumes VRAM bank exists. On the powermac 7200, 424 1.2.2.2 skrll * bank0 is always there and soldered to motherboard, don't know 425 1.2.2.2 skrll * if that is the case for others 426 1.2.2.2 skrll */ 427 1.2.2.2 skrll for (i = 0 ; i < num_elems; i++) { 428 1.2.2.2 skrll out8(fbuffer + offset, test_val[i]); 429 1.2.2.2 skrll out8(fbuffer + offset + 0x8, 0x0); 430 1.2.2.2 skrll 431 1.2.2.2 skrll __asm volatile ("eieio; dcbf 0,%0"::"r"(&fbuffer[offset]):"memory"); 432 1.2.2.2 skrll 433 1.2.2.2 skrll bank[i] = fbuffer[offset] == test_val[i]; 434 1.2.2.2 skrll total_vram += bank[i] * PLATINUM_FB_BANK_SIZE; 435 1.2.2.2 skrll offset += PLATINUM_FB_BANK_SIZE; 436 1.2.2.2 skrll } 437 1.2.2.2 skrll 438 1.2.2.2 skrll /* save total vram or minimum */ 439 1.2.2.2 skrll if (total_vram >= PLATINUM_FB_MIN_SIZE && total_vram <= PLATINUM_FB_MAX_SIZE) { 440 1.2.2.2 skrll sc->sc_vram = total_vram; 441 1.2.2.2 skrll } else { 442 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, 443 1.2.2.2 skrll "invalid VRAM size 0x%lx, using min 0x%x\n", 444 1.2.2.2 skrll total_vram, PLATINUM_FB_MIN_SIZE); 445 1.2.2.2 skrll sc->sc_vram = PLATINUM_FB_MIN_SIZE; 446 1.2.2.2 skrll } 447 1.2.2.2 skrll 448 1.2.2.2 skrll unmapiodev((paddr_t)fbuffer, sc->sc_fb_size); 449 1.2.2.2 skrll } 450 1.2.2.2 skrll 451 1.2.2.2 skrll static int 452 1.2.2.2 skrll platinumfb_match(device_t parent, cfdata_t cf, void *aux) 453 1.2.2.2 skrll { 454 1.2.2.2 skrll struct confargs *ca = aux; 455 1.2.2.2 skrll 456 1.2.2.2 skrll return (strcmp(ca->ca_name, "platinum") == 0); 457 1.2.2.2 skrll } 458 1.2.2.2 skrll 459 1.2.2.2 skrll static void 460 1.2.2.2 skrll platinumfb_attach(device_t parent, device_t self, void *aux) 461 1.2.2.2 skrll { 462 1.2.2.2 skrll struct platinumfb_softc *sc = device_private(self); 463 1.2.2.2 skrll struct confargs *ca = aux; 464 1.2.2.2 skrll u_int *reg = ca->ca_reg; 465 1.2.2.2 skrll 466 1.2.2.2 skrll sc->sc_dev = self; 467 1.2.2.2 skrll sc->sc_node = ca->ca_node; 468 1.2.2.2 skrll 469 1.2.2.2 skrll sc->sc_reg = (uint8_t *)reg[0]; 470 1.2.2.2 skrll sc->sc_reg_size = reg[1]; 471 1.2.2.2 skrll 472 1.2.2.2 skrll sc->sc_fb = (uint8_t *)reg[2]; 473 1.2.2.2 skrll sc->sc_fb_size = PLATINUM_FB_MAX_SIZE; 474 1.2.2.2 skrll 475 1.2.2.2 skrll sc->sc_cmap = (uint8_t *)PLATINUM_CMAP_BASE_ADDR; 476 1.2.2.2 skrll sc->sc_cmap_size = PLATINUM_CMAP_SIZE; 477 1.2.2.2 skrll 478 1.2.2.2 skrll aprint_normal(" reg-addr 0x%08lx fb-addr 0x%08lx cmap-addr 0x%08lx\n", 479 1.2.2.2 skrll (paddr_t)sc->sc_reg, 480 1.2.2.2 skrll (paddr_t)sc->sc_fb, 481 1.2.2.2 skrll (paddr_t)sc->sc_cmap); 482 1.2.2.2 skrll 483 1.2.2.2 skrll config_finalize_register(sc->sc_dev, platinumfb_init); 484 1.2.2.2 skrll } 485 1.2.2.2 skrll 486 1.2.2.2 skrll static void 487 1.2.2.2 skrll platinumfb_init_cmap(struct platinumfb_softc *sc) 488 1.2.2.2 skrll { 489 1.2.2.2 skrll int i; 490 1.2.2.2 skrll uint8_t tmp; 491 1.2.2.2 skrll 492 1.2.2.2 skrll switch (sc->sc_cmode) { 493 1.2.2.2 skrll case PLATINUM_CMODE_8: 494 1.2.2.2 skrll default: 495 1.2.2.2 skrll /* R3G3B2 colormap */ 496 1.2.2.2 skrll for (i = 0; i < 256; i++) { 497 1.2.2.2 skrll tmp = i & 0xe0; 498 1.2.2.2 skrll /* 499 1.2.2.2 skrll * replicate bits so 0xe0 maps to a red value of 0xff 500 1.2.2.2 skrll * in order to make white look actually white 501 1.2.2.2 skrll */ 502 1.2.2.2 skrll tmp |= (tmp >> 3) | (tmp >> 6); 503 1.2.2.2 skrll sc->sc_cmap_red[i] = tmp; 504 1.2.2.2 skrll 505 1.2.2.2 skrll tmp = (i & 0x1c) << 3; 506 1.2.2.2 skrll tmp |= (tmp >> 3) | (tmp >> 6); 507 1.2.2.2 skrll sc->sc_cmap_green[i] = tmp; 508 1.2.2.2 skrll 509 1.2.2.2 skrll tmp = (i & 0x03) << 6; 510 1.2.2.2 skrll tmp |= tmp >> 2; 511 1.2.2.2 skrll tmp |= tmp >> 4; 512 1.2.2.2 skrll sc->sc_cmap_blue[i] = tmp; 513 1.2.2.2 skrll } 514 1.2.2.2 skrll break; 515 1.2.2.2 skrll 516 1.2.2.2 skrll case PLATINUM_CMODE_16: 517 1.2.2.2 skrll for (i = 0; i < 32; i++) { 518 1.2.2.2 skrll tmp = 255 * i / 32; 519 1.2.2.2 skrll sc->sc_cmap_red[i] = tmp; 520 1.2.2.2 skrll sc->sc_cmap_green[i] = tmp; 521 1.2.2.2 skrll sc->sc_cmap_blue[i] = tmp; 522 1.2.2.2 skrll } 523 1.2.2.2 skrll for (i = 32; i < 256; i++) { 524 1.2.2.2 skrll sc->sc_cmap_red[i] = 0; 525 1.2.2.2 skrll sc->sc_cmap_blue[i] = 0; 526 1.2.2.2 skrll sc->sc_cmap_green[i] = 0; 527 1.2.2.2 skrll } 528 1.2.2.2 skrll break; 529 1.2.2.2 skrll 530 1.2.2.2 skrll case PLATINUM_CMODE_32: 531 1.2.2.2 skrll for (i = 0; i < 256; i++) { 532 1.2.2.2 skrll sc->sc_cmap_red[i] = i; 533 1.2.2.2 skrll sc->sc_cmap_green[i] = i; 534 1.2.2.2 skrll sc->sc_cmap_blue[i] = i; 535 1.2.2.2 skrll } 536 1.2.2.2 skrll break; 537 1.2.2.2 skrll } 538 1.2.2.2 skrll } 539 1.2.2.2 skrll 540 1.2.2.2 skrll static void 541 1.2.2.2 skrll platinumfb_restore_palette(struct platinumfb_softc *sc) 542 1.2.2.2 skrll { 543 1.2.2.2 skrll int i; 544 1.2.2.2 skrll 545 1.2.2.2 skrll for (i = 0; i < 256; i++) { 546 1.2.2.2 skrll platinumfb_putpalreg(sc, i, sc->sc_cmap_red[i], 547 1.2.2.2 skrll sc->sc_cmap_green[i], sc->sc_cmap_blue[i]); 548 1.2.2.2 skrll } 549 1.2.2.2 skrll } 550 1.2.2.2 skrll 551 1.2.2.2 skrll static int 552 1.2.2.2 skrll platinumfb_init(device_t self) 553 1.2.2.2 skrll { 554 1.2.2.2 skrll struct platinumfb_softc *sc = device_private(self); 555 1.2.2.2 skrll const struct videomode *mode = NULL; 556 1.2.2.2 skrll struct rasops_info *ri; 557 1.2.2.2 skrll 558 1.2.2.2 skrll struct wsemuldisplaydev_attach_args aa; 559 1.2.2.2 skrll bool is_console = FALSE; 560 1.2.2.2 skrll long defattr; 561 1.2.2.2 skrll 562 1.2.2.2 skrll int i; 563 1.2.2.2 skrll 564 1.2.2.2 skrll /* 565 1.2.2.2 skrll * become console if OF variable "output-device" is "screen" or 566 1.2.2.2 skrll * contains "platinum", since normal OF video variables are unavailable 567 1.2.2.2 skrll */ 568 1.2.2.2 skrll int options; 569 1.2.2.2 skrll char output_device[128]; 570 1.2.2.2 skrll options = OF_finddevice("/options"); 571 1.2.2.2 skrll if (options == 0 || 572 1.2.2.2 skrll options == -1 || 573 1.2.2.2 skrll OF_getprop(options, "output-device", output_device, 574 1.2.2.2 skrll sizeof(output_device)) == 0 ) { 575 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, 576 1.2.2.2 skrll "could not get output-device prop, assuming not console\n"); 577 1.2.2.2 skrll } else { 578 1.2.2.2 skrll if (strstr(output_device,"platinum") || 579 1.2.2.2 skrll strcmp(output_device,"screen") == 0 ) { 580 1.2.2.2 skrll is_console = TRUE; 581 1.2.2.2 skrll } 582 1.2.2.2 skrll } 583 1.2.2.2 skrll 584 1.2.2.2 skrll sc->sc_pfs = NULL; 585 1.2.2.2 skrll sc->sc_mode = WSDISPLAYIO_MODE_EMUL; 586 1.2.2.2 skrll sc->sc_on = WSDISPLAYIO_VIDEO_ON; 587 1.2.2.2 skrll 588 1.2.2.2 skrll /* determine vram memory and dac clock type */ 589 1.2.2.2 skrll platinumfb_memory_size(sc); 590 1.2.2.2 skrll platinumfb_dac_type(sc); 591 1.2.2.2 skrll 592 1.2.2.2 skrll aprint_normal_dev(sc->sc_dev,"is_console %d dac 0x%x vram 0x%x\n", 593 1.2.2.2 skrll is_console, sc->sc_dac_type, sc->sc_vram); 594 1.2.2.2 skrll 595 1.2.2.2 skrll for (i=0; i < sizeof(pfb_setting)/sizeof(pfb_setting[0]); i++) { 596 1.2.2.2 skrll if (strcmp(PLATINUM_FB_VMODE, pfb_setting[i]->vmode_name)==0) { 597 1.2.2.2 skrll mode = pick_mode_by_ref(pfb_setting[i]->width, 598 1.2.2.2 skrll pfb_setting[i]->height, 599 1.2.2.2 skrll pfb_setting[i]->freq); 600 1.2.2.2 skrll break; 601 1.2.2.2 skrll } 602 1.2.2.2 skrll } 603 1.2.2.2 skrll 604 1.2.2.2 skrll if (!mode) { 605 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, 606 1.2.2.2 skrll "pick_mode_by_ref failed, using default\n"); 607 1.2.2.2 skrll mode = pick_mode_by_ref(800, 600, 75); 608 1.2.2.2 skrll } 609 1.2.2.2 skrll 610 1.2.2.2 skrll if (platinumfb_set_mode(sc, mode, PLATINUM_CONSOLE_DEPTH) != 0) { 611 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, "platinumfb_set_mode failed\n"); 612 1.2.2.2 skrll return 0; 613 1.2.2.2 skrll } 614 1.2.2.2 skrll 615 1.2.2.2 skrll vcons_init(&sc->vd, sc, &platinumfb_defaultscreen, 616 1.2.2.2 skrll &platinumfb_accessops); 617 1.2.2.2 skrll sc->vd.init_screen = platinumfb_init_screen; 618 1.2.2.2 skrll 619 1.2.2.2 skrll ri = &platinumfb_console_screen.scr_ri; 620 1.2.2.2 skrll vcons_init_screen(&sc->vd, &platinumfb_console_screen, 1, &defattr); 621 1.2.2.2 skrll 622 1.2.2.2 skrll platinumfb_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC; 623 1.2.2.2 skrll 624 1.2.2.2 skrll platinumfb_defaultscreen.textops = &ri->ri_ops; 625 1.2.2.2 skrll platinumfb_defaultscreen.capabilities = ri->ri_caps; 626 1.2.2.2 skrll platinumfb_defaultscreen.nrows = ri->ri_rows; 627 1.2.2.2 skrll platinumfb_defaultscreen.ncols = ri->ri_cols; 628 1.2.2.2 skrll 629 1.2.2.2 skrll if (is_console) { 630 1.2.2.2 skrll wsdisplay_cnattach(&platinumfb_defaultscreen, ri, 0, 0, 631 1.2.2.2 skrll defattr); 632 1.2.2.2 skrll vcons_replay_msgbuf(&platinumfb_console_screen); 633 1.2.2.2 skrll } 634 1.2.2.2 skrll 635 1.2.2.2 skrll aa.console = is_console; 636 1.2.2.2 skrll aa.scrdata = &platinumfb_screenlist; 637 1.2.2.2 skrll aa.accessops = &platinumfb_accessops; 638 1.2.2.2 skrll aa.accesscookie = &sc->vd; 639 1.2.2.2 skrll 640 1.2.2.2 skrll config_found(self, &aa, wsemuldisplaydevprint); 641 1.2.2.2 skrll 642 1.2.2.2 skrll return 0; 643 1.2.2.2 skrll } 644 1.2.2.2 skrll 645 1.2.2.2 skrll static void 646 1.2.2.2 skrll platinumfb_set_hardware(struct platinumfb_softc *sc) 647 1.2.2.2 skrll { 648 1.2.2.2 skrll int i; 649 1.2.2.2 skrll bool one_bank = sc->sc_vram == PLATINUM_FB_BANK_SIZE; 650 1.2.2.2 skrll 651 1.2.2.2 skrll /* now start programming the chip */ 652 1.2.2.2 skrll platinumfb_write_reg(sc, 24, 7); /* turn off display */ 653 1.2.2.2 skrll 654 1.2.2.2 skrll for (i = 0; i < 26; ++i) 655 1.2.2.2 skrll platinumfb_write_reg(sc, i+32, sc->sc_pfs->regs[i]); 656 1.2.2.2 skrll 657 1.2.2.2 skrll platinumfb_write_reg(sc, 26+32, one_bank ? 658 1.2.2.2 skrll sc->sc_pfs->offset[sc->sc_cmode] + 4 - sc->sc_cmode : 659 1.2.2.2 skrll sc->sc_pfs->offset[sc->sc_cmode]); 660 1.2.2.2 skrll 661 1.2.2.2 skrll /* 662 1.2.2.2 skrll * reg 16 apparently needs an address 0x10 less the where frame 663 1.2.2.2 skrll * buffer/ri_bits start for console text to be aligned. In 664 1.2.2.2 skrll * addition, X memory maps (mmap) the frame buffer starting on 665 1.2.2.2 skrll * page boundaries. So to get both X and console text aligned we 666 1.2.2.2 skrll * start at the first page up from sc_fb[0]. Starting at sc_fb[0] 667 1.2.2.2 skrll * did work on my machine but not sure if this negative offset 668 1.2.2.2 skrll * would be problematic elsewhere. 669 1.2.2.2 skrll * 670 1.2.2.2 skrll * Not sure why linux used different fb offsets for each mode, as 671 1.2.2.2 skrll * any addresses seemed to work as long as relative difference was 672 1.2.2.2 skrll * 0x10. 673 1.2.2.2 skrll */ 674 1.2.2.2 skrll platinumfb_write_reg(sc, 16, platinumfb_page_align_up(sc) - 0x10); 675 1.2.2.2 skrll 676 1.2.2.2 skrll platinumfb_write_reg(sc, 18, sc->sc_pfs->pitch[sc->sc_cmode]); 677 1.2.2.2 skrll 678 1.2.2.2 skrll /* 679 1.2.2.2 skrll * XXX register 19 setting looks wrong for 1 bank & 32 bpp. 680 1.2.2.2 skrll * 512x384 is only resolution that would use such a setting, but 681 1.2.2.2 skrll * that is not currently in videomodes.c 682 1.2.2.2 skrll */ 683 1.2.2.2 skrll if (sc->sc_cmode == PLATINUM_CMODE_32 && 684 1.2.2.2 skrll (sc->sc_pfs->macmode == 1 || sc->sc_pfs->macmode == 2)) 685 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, 686 1.2.2.2 skrll "platinumfb reg19 array out-of-bounds"); 687 1.2.2.2 skrll 688 1.2.2.2 skrll platinumfb_write_reg(sc, 19, one_bank ? 689 1.2.2.2 skrll sc->sc_pfs->mode[sc->sc_cmode+1] : /* XXX fix this for 32 bpp */ 690 1.2.2.2 skrll sc->sc_pfs->mode[sc->sc_cmode]); 691 1.2.2.2 skrll 692 1.2.2.2 skrll platinumfb_write_reg(sc, 20, one_bank ? 0x11 : 0x1011); 693 1.2.2.2 skrll platinumfb_write_reg(sc, 21, 0x100); 694 1.2.2.2 skrll platinumfb_write_reg(sc, 22, 1); 695 1.2.2.2 skrll platinumfb_write_reg(sc, 23, 1); 696 1.2.2.2 skrll platinumfb_write_reg(sc, 26, 0xc00); 697 1.2.2.2 skrll platinumfb_write_reg(sc, 27, 0x235); 698 1.2.2.2 skrll /* platinumfb_write_reg(sc, 27, 0x2aa); */ 699 1.2.2.2 skrll 700 1.2.2.2 skrll platinumfb_store_d2(sc, 0, 701 1.2.2.2 skrll one_bank ? sc->sc_pfs->dacula_ctrl[sc->sc_cmode] & 0xf : 702 1.2.2.2 skrll sc->sc_pfs->dacula_ctrl[sc->sc_cmode]); 703 1.2.2.2 skrll platinumfb_store_d2(sc, 1, 4); 704 1.2.2.2 skrll platinumfb_store_d2(sc, 2, 0); 705 1.2.2.2 skrll 706 1.2.2.2 skrll platinumfb_set_clock(sc); 707 1.2.2.2 skrll 708 1.2.2.2 skrll platinumfb_write_reg(sc, 24, 0); /* turn display on */ 709 1.2.2.2 skrll } 710 1.2.2.2 skrll 711 1.2.2.2 skrll static int 712 1.2.2.2 skrll platinumfb_set_mode(struct platinumfb_softc *sc, 713 1.2.2.2 skrll const struct videomode *mode, int depth) 714 1.2.2.2 skrll { 715 1.2.2.2 skrll int i; 716 1.2.2.2 skrll 717 1.2.2.2 skrll /* first find the parameter for the mode register */ 718 1.2.2.2 skrll i = 0; 719 1.2.2.2 skrll while((i < __arraycount(pfb_setting)) && 720 1.2.2.2 skrll (strcmp(mode->name, pfb_setting[i]->vmode_name) != 0)) 721 1.2.2.2 skrll i++; 722 1.2.2.2 skrll 723 1.2.2.2 skrll if (i >= __arraycount(pfb_setting)) { 724 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, 725 1.2.2.2 skrll "Can't find a mode register value for %s\n", 726 1.2.2.2 skrll mode->name); 727 1.2.2.2 skrll return EINVAL; 728 1.2.2.2 skrll } 729 1.2.2.2 skrll 730 1.2.2.2 skrll /* found a mode */ 731 1.2.2.2 skrll sc->sc_pfs = pfb_setting[i]; 732 1.2.2.2 skrll 733 1.2.2.2 skrll /* determine depth settings */ 734 1.2.2.2 skrll switch (depth) { 735 1.2.2.2 skrll case 8: 736 1.2.2.2 skrll default: 737 1.2.2.2 skrll sc->sc_depth = 8; 738 1.2.2.2 skrll sc->sc_cmode = PLATINUM_CMODE_8; 739 1.2.2.2 skrll break; 740 1.2.2.2 skrll case 15: 741 1.2.2.2 skrll case 16: 742 1.2.2.2 skrll /* 15 bpp but use 16 so X/wsfb works */ 743 1.2.2.2 skrll sc->sc_depth = 16; 744 1.2.2.2 skrll sc->sc_cmode = PLATINUM_CMODE_16; 745 1.2.2.2 skrll break; 746 1.2.2.2 skrll case 24: 747 1.2.2.2 skrll case 32: 748 1.2.2.2 skrll /* 24 bpp but use 32 so X/wsfb works */ 749 1.2.2.2 skrll sc->sc_depth = 32; 750 1.2.2.2 skrll sc->sc_cmode = PLATINUM_CMODE_32; 751 1.2.2.2 skrll break; 752 1.2.2.2 skrll } 753 1.2.2.2 skrll 754 1.2.2.2 skrll sc->sc_modereg = sc->sc_pfs->macmode; 755 1.2.2.2 skrll sc->sc_videomode = mode; 756 1.2.2.2 skrll sc->sc_height = mode->vdisplay; 757 1.2.2.2 skrll sc->sc_width = mode->hdisplay; 758 1.2.2.2 skrll sc->sc_linebytes = sc->sc_width * (1 << sc->sc_cmode) + platinumfb_line_tweak(sc); 759 1.2.2.2 skrll 760 1.2.2.2 skrll /* check if we have enough video memory */ 761 1.2.2.2 skrll if (sc->sc_height * sc->sc_linebytes > sc->sc_vram - PAGE_SIZE) { 762 1.2.2.2 skrll aprint_error_dev(sc->sc_dev, "Not enough video RAM for %s\n", 763 1.2.2.2 skrll mode->name); 764 1.2.2.2 skrll return EINVAL; 765 1.2.2.2 skrll } 766 1.2.2.2 skrll 767 1.2.2.2 skrll /* set up and write colormap */ 768 1.2.2.2 skrll platinumfb_init_cmap(sc); 769 1.2.2.2 skrll platinumfb_restore_palette(sc); 770 1.2.2.2 skrll 771 1.2.2.2 skrll /* set hardware registers */ 772 1.2.2.2 skrll platinumfb_set_hardware(sc); 773 1.2.2.2 skrll 774 1.2.2.2 skrll aprint_normal_dev(sc->sc_dev, "switched to %s in %d bit color\n", 775 1.2.2.2 skrll sc->sc_pfs->vmode_name, sc->sc_depth); 776 1.2.2.2 skrll return 0; 777 1.2.2.2 skrll } 778 1.2.2.2 skrll 779 1.2.2.2 skrll static int 780 1.2.2.2 skrll platinumfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, 781 1.2.2.2 skrll struct lwp *l) 782 1.2.2.2 skrll { 783 1.2.2.2 skrll struct vcons_data *vd = v; 784 1.2.2.2 skrll struct platinumfb_softc *sc = vd->cookie; 785 1.2.2.2 skrll struct wsdisplay_fbinfo *wdf; 786 1.2.2.2 skrll struct vcons_screen *ms = vd->active; 787 1.2.2.2 skrll int i; 788 1.2.2.2 skrll 789 1.2.2.2 skrll switch (cmd) { 790 1.2.2.2 skrll case WSDISPLAYIO_GTYPE: 791 1.2.2.2 skrll *(u_int *)data = WSDISPLAY_TYPE_PLATINUM; 792 1.2.2.2 skrll return 0; 793 1.2.2.2 skrll 794 1.2.2.2 skrll case WSDISPLAYIO_GINFO: 795 1.2.2.2 skrll wdf = (void *)data; 796 1.2.2.2 skrll wdf->height = ms->scr_ri.ri_height; 797 1.2.2.2 skrll wdf->width = ms->scr_ri.ri_width; 798 1.2.2.2 skrll wdf->depth = ms->scr_ri.ri_depth; 799 1.2.2.2 skrll wdf->cmsize = 256; 800 1.2.2.2 skrll return 0; 801 1.2.2.2 skrll 802 1.2.2.2 skrll case WSDISPLAYIO_GVIDEO: 803 1.2.2.2 skrll *(int *)data = sc->sc_on; 804 1.2.2.2 skrll return 0; 805 1.2.2.2 skrll 806 1.2.2.2 skrll case WSDISPLAYIO_SVIDEO: 807 1.2.2.2 skrll /* 808 1.2.2.2 skrll * poor man's screen blanking, just write zeros to colormap 809 1.2.2.2 skrll * registers but don't save in softc. 810 1.2.2.2 skrll */ 811 1.2.2.2 skrll if (*(int *)data != sc->sc_on) { 812 1.2.2.2 skrll sc->sc_on = (sc->sc_on == WSDISPLAYIO_VIDEO_ON ? 813 1.2.2.2 skrll WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON); 814 1.2.2.2 skrll 815 1.2.2.2 skrll /* XXX need to lock colormap? */ 816 1.2.2.2 skrll if (sc->sc_on == WSDISPLAYIO_VIDEO_OFF) { 817 1.2.2.2 skrll for (i=0; i < 256; i++) 818 1.2.2.2 skrll platinumfb_putpalreg(sc, i, 0, 0, 0); 819 1.2.2.2 skrll } else { 820 1.2.2.2 skrll platinumfb_restore_palette(sc); 821 1.2.2.2 skrll } 822 1.2.2.2 skrll } 823 1.2.2.2 skrll return 0; 824 1.2.2.2 skrll 825 1.2.2.2 skrll case WSDISPLAYIO_GETCMAP: 826 1.2.2.2 skrll if (sc->sc_cmode == PLATINUM_CMODE_8) { 827 1.2.2.2 skrll return platinumfb_getcmap(sc, 828 1.2.2.2 skrll (struct wsdisplay_cmap *)data); 829 1.2.2.2 skrll } else 830 1.2.2.2 skrll return 0; 831 1.2.2.2 skrll 832 1.2.2.2 skrll case WSDISPLAYIO_PUTCMAP: 833 1.2.2.2 skrll if (sc->sc_cmode == PLATINUM_CMODE_8) { 834 1.2.2.2 skrll return platinumfb_putcmap(sc, 835 1.2.2.2 skrll (struct wsdisplay_cmap *)data); 836 1.2.2.2 skrll } else 837 1.2.2.2 skrll return 0; 838 1.2.2.2 skrll 839 1.2.2.2 skrll case WSDISPLAYIO_SMODE: { 840 1.2.2.2 skrll int new_mode = *(int*)data; 841 1.2.2.2 skrll 842 1.2.2.2 skrll if (new_mode != sc->sc_mode) { 843 1.2.2.2 skrll int new_depth = new_mode == WSDISPLAYIO_MODE_EMUL ? 844 1.2.2.2 skrll PLATINUM_CONSOLE_DEPTH : PLATINUM_FB_DEPTH; 845 1.2.2.2 skrll 846 1.2.2.2 skrll switch(new_mode) { 847 1.2.2.2 skrll /* 848 1.2.2.2 skrll * XXX - not sure how this is supposed to work for 849 1.2.2.2 skrll * switching bpp between console and X, but cases with 850 1.2.2.2 skrll * (EMUL MAPPED) or (EMUL MAPPED DUMBFB) work, but 851 1.2.2.2 skrll * (EMUL DUMBFB) garbles screen for some reason. 852 1.2.2.2 skrll */ 853 1.2.2.2 skrll case WSDISPLAYIO_MODE_EMUL: 854 1.2.2.2 skrll case WSDISPLAYIO_MODE_MAPPED: 855 1.2.2.2 skrll /* case WSDISPLAYIO_MODE_DUMBFB: XXX */ 856 1.2.2.2 skrll 857 1.2.2.2 skrll /* in case screen is "blanked" */ 858 1.2.2.2 skrll platinumfb_restore_palette(sc); 859 1.2.2.2 skrll 860 1.2.2.2 skrll sc->sc_mode = new_mode; 861 1.2.2.2 skrll 862 1.2.2.2 skrll platinumfb_set_mode(sc, sc->sc_videomode, new_depth); 863 1.2.2.2 skrll platinumfb_set_rasops(sc, &ms->scr_ri, true); 864 1.2.2.2 skrll 865 1.2.2.2 skrll if (new_mode == WSDISPLAYIO_MODE_EMUL) 866 1.2.2.2 skrll vcons_redraw_screen(ms); 867 1.2.2.2 skrll } 868 1.2.2.2 skrll } 869 1.2.2.2 skrll 870 1.2.2.2 skrll return 0; 871 1.2.2.2 skrll } 872 1.2.2.2 skrll 873 1.2.2.2 skrll case WSDISPLAYIO_LINEBYTES: 874 1.2.2.2 skrll *(u_int *)data = sc->sc_linebytes; 875 1.2.2.2 skrll return 0; 876 1.2.2.2 skrll 877 1.2.2.2 skrll case WSDISPLAYIO_GET_FBINFO: { 878 1.2.2.2 skrll struct wsdisplayio_fbinfo *fbi = data; 879 1.2.2.2 skrll return wsdisplayio_get_fbinfo(&ms->scr_ri, fbi); 880 1.2.2.2 skrll } 881 1.2.2.2 skrll 882 1.2.2.2 skrll } 883 1.2.2.2 skrll return EPASSTHROUGH; 884 1.2.2.2 skrll } 885 1.2.2.2 skrll 886 1.2.2.2 skrll static paddr_t 887 1.2.2.2 skrll platinumfb_mmap(void *v, void *vs, off_t offset, int prot) 888 1.2.2.2 skrll { 889 1.2.2.2 skrll struct vcons_data *vd = v; 890 1.2.2.2 skrll struct platinumfb_softc *sc = vd->cookie; 891 1.2.2.2 skrll paddr_t pa = -1; 892 1.2.2.2 skrll paddr_t fb_aligned = platinumfb_page_align_up(sc); 893 1.2.2.2 skrll paddr_t fb_vram = sc->sc_vram - (fb_aligned - (paddr_t)sc->sc_fb); 894 1.2.2.2 skrll 895 1.2.2.2 skrll /* XXX need to worry about superuser or mapping other registers? */ 896 1.2.2.2 skrll 897 1.2.2.2 skrll if (offset >= 0 && offset < fb_vram) 898 1.2.2.2 skrll pa = fb_aligned + offset; 899 1.2.2.2 skrll 900 1.2.2.2 skrll return pa; 901 1.2.2.2 skrll } 902 1.2.2.2 skrll 903 1.2.2.2 skrll static void platinumfb_set_rasops(struct platinumfb_softc *sc, 904 1.2.2.2 skrll struct rasops_info *ri, 905 1.2.2.2 skrll int existing) 906 1.2.2.2 skrll { 907 1.2.2.2 skrll memset(ri, 0, sizeof(struct rasops_info)); 908 1.2.2.2 skrll 909 1.2.2.2 skrll ri->ri_depth = sc->sc_depth; 910 1.2.2.2 skrll ri->ri_width = sc->sc_width; 911 1.2.2.2 skrll ri->ri_height = sc->sc_height; 912 1.2.2.2 skrll ri->ri_stride = sc->sc_linebytes; 913 1.2.2.2 skrll ri->ri_bits = (u_char*)platinumfb_page_align_up(sc); 914 1.2.2.2 skrll ri->ri_flg = RI_FULLCLEAR; 915 1.2.2.2 skrll 916 1.2.2.2 skrll if (existing) 917 1.2.2.2 skrll ri->ri_flg |= RI_CLEAR; 918 1.2.2.2 skrll 919 1.2.2.2 skrll switch (sc->sc_cmode) { 920 1.2.2.2 skrll case PLATINUM_CMODE_8: 921 1.2.2.2 skrll default: 922 1.2.2.2 skrll ri->ri_flg |= RI_ENABLE_ALPHA | RI_8BIT_IS_RGB; 923 1.2.2.2 skrll 924 1.2.2.2 skrll break; 925 1.2.2.2 skrll case PLATINUM_CMODE_16: 926 1.2.2.2 skrll if (strcmp(sc->sc_pfs->vmode_name, "640x480x60") == 0 || 927 1.2.2.2 skrll strcmp(sc->sc_pfs->vmode_name, "800x600x75") == 0 ) 928 1.2.2.2 skrll ri->ri_flg |= RI_ENABLE_ALPHA; 929 1.2.2.2 skrll 930 1.2.2.2 skrll ri->ri_rnum = 5; 931 1.2.2.2 skrll ri->ri_rpos = 10; 932 1.2.2.2 skrll ri->ri_gnum = 5; 933 1.2.2.2 skrll ri->ri_gpos = 5; 934 1.2.2.2 skrll ri->ri_bnum = 5; 935 1.2.2.2 skrll ri->ri_bpos = 0; 936 1.2.2.2 skrll 937 1.2.2.2 skrll break; 938 1.2.2.2 skrll case PLATINUM_CMODE_32: 939 1.2.2.2 skrll if (strcmp(sc->sc_pfs->vmode_name, "640x480x60") == 0 || 940 1.2.2.2 skrll strcmp(sc->sc_pfs->vmode_name, "800x600x75") == 0 ) 941 1.2.2.2 skrll ri->ri_flg |= RI_ENABLE_ALPHA; 942 1.2.2.2 skrll 943 1.2.2.2 skrll ri->ri_rnum = 8; 944 1.2.2.2 skrll ri->ri_rpos = 16; 945 1.2.2.2 skrll ri->ri_gnum = 8; 946 1.2.2.2 skrll ri->ri_gpos = 8; 947 1.2.2.2 skrll ri->ri_bnum = 8; 948 1.2.2.2 skrll ri->ri_bpos = 0; 949 1.2.2.2 skrll 950 1.2.2.2 skrll break; 951 1.2.2.2 skrll } 952 1.2.2.2 skrll 953 1.2.2.2 skrll rasops_init(ri, 0, 0); 954 1.2.2.2 skrll ri->ri_caps = WSSCREEN_WSCOLORS; 955 1.2.2.2 skrll 956 1.2.2.2 skrll rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight, 957 1.2.2.2 skrll sc->sc_width / ri->ri_font->fontwidth); 958 1.2.2.2 skrll 959 1.2.2.2 skrll } 960 1.2.2.2 skrll 961 1.2.2.2 skrll static void 962 1.2.2.2 skrll platinumfb_init_screen(void *cookie, struct vcons_screen *scr, 963 1.2.2.2 skrll int existing, long *defattr) 964 1.2.2.2 skrll { 965 1.2.2.2 skrll struct platinumfb_softc *sc = cookie; 966 1.2.2.2 skrll struct rasops_info *ri = &scr->scr_ri; 967 1.2.2.2 skrll 968 1.2.2.2 skrll scr->scr_flags |= VCONS_DONT_READ; 969 1.2.2.2 skrll 970 1.2.2.2 skrll platinumfb_set_rasops(sc, ri, existing); 971 1.2.2.2 skrll 972 1.2.2.2 skrll ri->ri_hw = scr; 973 1.2.2.2 skrll } 974 1.2.2.2 skrll 975 1.2.2.2 skrll static int 976 1.2.2.2 skrll platinumfb_putcmap(struct platinumfb_softc *sc, struct wsdisplay_cmap *cm) 977 1.2.2.2 skrll { 978 1.2.2.2 skrll u_char *r, *g, *b; 979 1.2.2.2 skrll u_int index = cm->index; 980 1.2.2.2 skrll u_int count = cm->count; 981 1.2.2.2 skrll int i, error; 982 1.2.2.2 skrll u_char rbuf[256], gbuf[256], bbuf[256]; 983 1.2.2.2 skrll 984 1.2.2.2 skrll if (cm->index >= 256 || cm->count > 256 || 985 1.2.2.2 skrll (cm->index + cm->count) > 256) 986 1.2.2.2 skrll return EINVAL; 987 1.2.2.2 skrll error = copyin(cm->red, &rbuf[index], count); 988 1.2.2.2 skrll if (error) 989 1.2.2.2 skrll return error; 990 1.2.2.2 skrll error = copyin(cm->green, &gbuf[index], count); 991 1.2.2.2 skrll if (error) 992 1.2.2.2 skrll return error; 993 1.2.2.2 skrll error = copyin(cm->blue, &bbuf[index], count); 994 1.2.2.2 skrll if (error) 995 1.2.2.2 skrll return error; 996 1.2.2.2 skrll 997 1.2.2.2 skrll memcpy(&sc->sc_cmap_red[index], &rbuf[index], count); 998 1.2.2.2 skrll memcpy(&sc->sc_cmap_green[index], &gbuf[index], count); 999 1.2.2.2 skrll memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count); 1000 1.2.2.2 skrll 1001 1.2.2.2 skrll /* write colormap registers if not currently blanked */ 1002 1.2.2.2 skrll if (sc->sc_on == WSDISPLAYIO_VIDEO_ON) { 1003 1.2.2.2 skrll r = &sc->sc_cmap_red[index]; 1004 1.2.2.2 skrll g = &sc->sc_cmap_green[index]; 1005 1.2.2.2 skrll b = &sc->sc_cmap_blue[index]; 1006 1.2.2.2 skrll 1007 1.2.2.2 skrll for (i = 0; i < count; i++) { 1008 1.2.2.2 skrll platinumfb_putpalreg(sc, index, *r, *g, *b); 1009 1.2.2.2 skrll index++; 1010 1.2.2.2 skrll r++, g++, b++; 1011 1.2.2.2 skrll } 1012 1.2.2.2 skrll } 1013 1.2.2.2 skrll 1014 1.2.2.2 skrll return 0; 1015 1.2.2.2 skrll } 1016 1.2.2.2 skrll 1017 1.2.2.2 skrll static int 1018 1.2.2.2 skrll platinumfb_getcmap(struct platinumfb_softc *sc, struct wsdisplay_cmap *cm) 1019 1.2.2.2 skrll { 1020 1.2.2.2 skrll u_int index = cm->index; 1021 1.2.2.2 skrll u_int count = cm->count; 1022 1.2.2.2 skrll int error; 1023 1.2.2.2 skrll 1024 1.2.2.2 skrll if (index >= 255 || count > 256 || index + count > 256) 1025 1.2.2.2 skrll return EINVAL; 1026 1.2.2.2 skrll 1027 1.2.2.2 skrll error = copyout(&sc->sc_cmap_red[index], cm->red, count); 1028 1.2.2.2 skrll if (error) 1029 1.2.2.2 skrll return error; 1030 1.2.2.2 skrll error = copyout(&sc->sc_cmap_green[index], cm->green, count); 1031 1.2.2.2 skrll if (error) 1032 1.2.2.2 skrll return error; 1033 1.2.2.2 skrll error = copyout(&sc->sc_cmap_blue[index], cm->blue, count); 1034 1.2.2.2 skrll if (error) 1035 1.2.2.2 skrll return error; 1036 1.2.2.2 skrll 1037 1.2.2.2 skrll return 0; 1038 1.2.2.2 skrll } 1039
Indexes created Thu Oct 23 22:10:10 GMT 2025