1/*- 2 * Copyright (c) 2011-2014 Nathan Whitehorn 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h> 28__FBSDID("$FreeBSD$"); 29 30#include <sys/param.h> 31#include <sys/systm.h> 32#include <sys/kernel.h> 33#include <sys/sysctl.h> 34#include <sys/limits.h> 35#include <sys/conf.h> 36#include <sys/cons.h> 37#include <sys/fbio.h> 38 39#include <vm/vm.h> 40#include <vm/pmap.h> 41 42#include <machine/platform.h> 43#include <machine/pmap.h> 44 45#include <dev/vt/vt.h> 46#include <dev/vt/hw/fb/vt_fb.h> 47#include <dev/vt/colors/vt_termcolors.h> 48 49#include "ps3-hvcall.h" 50 51#define PS3FB_SIZE (4*1024*1024) 52 53#define L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_MODE_SET 0x0100 54#define L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_SYNC 0x0101 55#define L1GPU_DISPLAY_SYNC_HSYNC 1 56#define L1GPU_DISPLAY_SYNC_VSYNC 2 57#define L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP 0x0102 58 59static vd_init_t ps3fb_init; 60static vd_probe_t ps3fb_probe; 61void ps3fb_remap(void); 62 63struct ps3fb_softc { 64 struct fb_info fb_info; 65 66 uint64_t sc_fbhandle; 67 uint64_t sc_fbcontext; 68 uint64_t sc_dma_control; 69 uint64_t sc_driver_info; 70 uint64_t sc_reports; 71 uint64_t sc_reports_size; 72}; 73 74static struct vt_driver vt_ps3fb_driver = { 75 .vd_name = "ps3fb", 76 .vd_probe = ps3fb_probe, 77 .vd_init = ps3fb_init, 78 .vd_blank = vt_fb_blank, 79 .vd_bitblt_text = vt_fb_bitblt_text, 80 .vd_bitblt_bmp = vt_fb_bitblt_bitmap, 81 .vd_drawrect = vt_fb_drawrect, 82 .vd_setpixel = vt_fb_setpixel, 83 .vd_fb_ioctl = vt_fb_ioctl, 84 .vd_fb_mmap = vt_fb_mmap, 85 /* Better than VGA, but still generic driver. */ 86 .vd_priority = VD_PRIORITY_GENERIC + 1, 87}; 88 89VT_DRIVER_DECLARE(vt_ps3fb, vt_ps3fb_driver); 90static struct ps3fb_softc ps3fb_softc; 91 92static int 93ps3fb_probe(struct vt_device *vd) 94{ 95 struct ps3fb_softc *sc; 96 int disable; 97 char compatible[64]; 98#if 0 99 phandle_t root; 100#endif 101 102 disable = 0; 103 TUNABLE_INT_FETCH("hw.syscons.disable", &disable); 104 if (disable != 0) 105 return (0); 106 107 sc = &ps3fb_softc; 108 109#if 0 110 root = OF_finddevice("/"); 111 if (OF_getprop(root, "compatible", compatible, sizeof(compatible)) <= 0) 112 return (0); 113 114 if (strncmp(compatible, "sony,ps3", sizeof(compatible)) != 0) 115 return (0); 116#else 117 TUNABLE_STR_FETCH("hw.platform", compatible, sizeof(compatible)); 118 if (strcmp(compatible, "ps3") != 0) 119 return (CN_DEAD); 120#endif 121 122 return (CN_INTERNAL); 123} 124 125void 126ps3fb_remap(void) 127{ 128 struct ps3fb_softc *sc; 129 vm_offset_t va, fb_paddr; 130 131 sc = &ps3fb_softc; 132 133 lv1_gpu_close(); 134 lv1_gpu_open(0); 135 136 lv1_gpu_context_attribute(0, L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_MODE_SET, 137 0,0,0,0); 138 lv1_gpu_context_attribute(0, L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_MODE_SET, 139 0,0,1,0); 140 lv1_gpu_context_attribute(0, L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_SYNC, 141 0,L1GPU_DISPLAY_SYNC_VSYNC,0,0); 142 lv1_gpu_context_attribute(0, L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_SYNC, 143 1,L1GPU_DISPLAY_SYNC_VSYNC,0,0); 144 lv1_gpu_memory_allocate(PS3FB_SIZE, 0, 0, 0, 0, &sc->sc_fbhandle, 145 &fb_paddr); 146 lv1_gpu_context_allocate(sc->sc_fbhandle, 0, &sc->sc_fbcontext, 147 &sc->sc_dma_control, &sc->sc_driver_info, &sc->sc_reports, 148 &sc->sc_reports_size); 149 150 lv1_gpu_context_attribute(sc->sc_fbcontext, 151 L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP, 0, 0, 0, 0); 152 lv1_gpu_context_attribute(sc->sc_fbcontext, 153 L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP, 1, 0, 0, 0); 154 155 sc->fb_info.fb_pbase = fb_paddr; 156 for (va = 0; va < PS3FB_SIZE; va += PAGE_SIZE) 157 pmap_kenter_attr(0x10000000 + va, fb_paddr + va, 158 VM_MEMATTR_WRITE_COMBINING); 159} 160 161static int 162ps3fb_init(struct vt_device *vd) 163{ 164 struct ps3fb_softc *sc; 165 166 /* Init softc */ 167 vd->vd_softc = sc = &ps3fb_softc; 168 169 /* XXX: get from HV repository */ 170 sc->fb_info.fb_depth = 32; 171 sc->fb_info.fb_height = 480; 172 sc->fb_info.fb_width = 720; 173 sc->fb_info.fb_stride = sc->fb_info.fb_width*4; 174 sc->fb_info.fb_size = sc->fb_info.fb_height * sc->fb_info.fb_stride; 175 sc->fb_info.fb_bpp = sc->fb_info.fb_stride / sc->fb_info.fb_width * 8; 176 177 /* 178 * The loader puts the FB at 0x10000000, so use that for now. 179 */ 180 181 sc->fb_info.fb_vbase = 0x10000000; 182 183 /* 32-bit VGA palette */ 184 vt_generate_cons_palette(sc->fb_info.fb_cmap, COLOR_FORMAT_RGB, 185 255, 0, 255, 8, 255, 16); 186 187 /* Set correct graphics context */ 188 lv1_gpu_context_attribute(sc->sc_fbcontext, 189 L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP, 0, 0, 0, 0); 190 lv1_gpu_context_attribute(sc->sc_fbcontext, 191 L1GPU_CONTEXT_ATTRIBUTE_DISPLAY_FLIP, 1, 0, 0, 0); 192 193 vt_fb_init(vd); 194 sc->fb_info.fb_flags &= ~FB_FLAG_NOMMAP; /* Set wrongly by vt_fb_init */ 195 196 return (CN_INTERNAL); 197} 198 199