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