void vga_gr_mask(unsigned char index, unsigned char value, unsigned char mask) { unsigned char tmp; tmp = vga_gr_read(index); tmp &= ~mask; tmp |= (value & mask); vga_gr_write(index, tmp); }
static void vga_font_8x16_load(void) { unsigned char *p; int i, j; unsigned char sr2, sr4, gr5, gr6; #define height 16 #define count 256 sr2 = vga_sr_read(0x02); sr4 = vga_sr_read(0x04); gr5 = vga_gr_read(0x05); gr6 = vga_gr_read(0x06); /* disable odd/even */ vga_sr_mask(0x04, 0x04, 0x04); vga_gr_mask(0x05, 0x00, 0x10); vga_gr_mask(0x06, 0x00, 0x02); /* plane 2 */ vga_sr_write(0x02, 0x04); p = (unsigned char *) VGA_FB; for (i = 0; i < count; i++) { for (j = 0; j < 32; j++) { if (j < height) *p = vga_font_8x16[i][j]; else *p = 0x00; p++; } } vga_gr_write(0x06, gr6); vga_gr_write(0x05, gr5); vga_sr_write(0x04, sr4); vga_sr_write(0x02, sr2); /* set up font size */ vga_cr_mask(0x09, 16 - 1, 0x1F); }
static void vga_fb_init(void) { vga_sr_write(0x02, 0x03); vga_sr_write(0x03, 0x00); vga_sr_write(0x04, 0x02); /* access all 256kB */ vga_gr_write(0x00, 0x00); vga_gr_write(0x01, 0x00); vga_gr_write(0x02, 0x00); vga_gr_write(0x03, 0x00); vga_gr_write(0x04, 0x00); vga_gr_write(0x05, 0x10); vga_gr_write(0x06, 0x0E); /* map at 0xB8000 */ vga_gr_write(0x07, 0x00); vga_gr_write(0x08, 0xFF); /* o/e enable: ram enable */ vga_misc_mask(0x22, 0x22); }
static void intel_gma_init(const struct northbridge_intel_gm45_config *info, u8 *mmio, u32 physbase, u16 piobase, u32 lfb) { int i; u8 edid_data[128]; struct edid edid; struct edid_mode *mode; u32 hactive, vactive, right_border, bottom_border; int hpolarity, vpolarity; u32 vsync, hsync, vblank, hblank, hfront_porch, vfront_porch; u32 candp1, candn; u32 best_delta = 0xffffffff; u32 target_frequency; u32 pixel_p1 = 1; u32 pixel_n = 1; u32 pixel_m1 = 1; u32 pixel_m2 = 1; u32 link_frequency = info->gfx.link_frequency_270_mhz ? 270000 : 162000; u32 data_m1; u32 data_n1 = 0x00800000; u32 link_m1; u32 link_n1 = 0x00080000; vga_gr_write(0x18, 0); /* Setup GTT. */ for (i = 0; i < 0x2000; i++) { outl((i << 2) | 1, piobase); outl(physbase + (i << 12) + 1, piobase + 4); } write32(mmio + ADPA, 0x40008c18); write32(mmio + 0x7041c, 0x0); write32(mmio + _DPLL_B_MD, 0x3); vga_misc_write(0x67); const u8 cr[] = { 0x5f, 0x4f, 0x50, 0x82, 0x55, 0x81, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x1f, 0x96, 0xb9, 0xa3, 0xff }; vga_cr_write(0x11, 0); for (i = 0; i <= 0x18; i++) vga_cr_write(i, cr[i]); power_port(mmio); intel_gmbus_read_edid(mmio + GMBUS0, 3, 0x50, edid_data, 128); decode_edid(edid_data, sizeof(edid_data), &edid); mode = &edid.mode; /* Disable screen memory to prevent garbage from appearing. */ vga_sr_write(1, vga_sr_read(1) | 0x20); hactive = edid.x_resolution; vactive = edid.y_resolution; right_border = mode->hborder; bottom_border = mode->vborder; hpolarity = (mode->phsync == '-'); vpolarity = (mode->pvsync == '-'); vsync = mode->vspw; hsync = mode->hspw; vblank = mode->vbl; hblank = mode->hbl; hfront_porch = mode->hso; vfront_porch = mode->vso; target_frequency = mode->lvds_dual_channel ? mode->pixel_clock : (2 * mode->pixel_clock); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { vga_sr_write(1, 1); vga_sr_write(0x2, 0xf); vga_sr_write(0x3, 0x0); vga_sr_write(0x4, 0xe); vga_gr_write(0, 0x0); vga_gr_write(1, 0x0); vga_gr_write(2, 0x0); vga_gr_write(3, 0x0); vga_gr_write(4, 0x0); vga_gr_write(5, 0x0); vga_gr_write(6, 0x5); vga_gr_write(7, 0xf); vga_gr_write(0x10, 0x1); vga_gr_write(0x11, 0); edid.bytes_per_line = (edid.bytes_per_line + 63) & ~63; write32(mmio + DSPCNTR(0), DISPPLANE_BGRX888); write32(mmio + DSPADDR(0), 0); write32(mmio + DSPSTRIDE(0), edid.bytes_per_line); write32(mmio + DSPSURF(0), 0); for (i = 0; i < 0x100; i++) write32(mmio + LGC_PALETTE(0) + 4 * i, i * 0x010101); } else { vga_textmode_init(); } /* Find suitable divisors. */ for (candp1 = 1; candp1 <= 8; candp1++) { for (candn = 5; candn <= 10; candn++) { u32 cur_frequency; u32 m; /* 77 - 131. */ u32 denom; /* 35 - 560. */ u32 current_delta; denom = candn * candp1 * 7; /* Doesnt overflow for up to 5000000 kHz = 5 GHz. */ m = (target_frequency * denom + 60000) / 120000; if (m < 77 || m > 131) continue; cur_frequency = (120000 * m) / denom; if (target_frequency > cur_frequency) current_delta = target_frequency - cur_frequency; else current_delta = cur_frequency - target_frequency; if (best_delta > current_delta) { best_delta = current_delta; pixel_n = candn; pixel_p1 = candp1; pixel_m2 = ((m + 3) % 5) + 7; pixel_m1 = (m - pixel_m2) / 5; } } } if (best_delta == 0xffffffff) { printk (BIOS_ERR, "Couldn't find GFX clock divisors\n"); return; } link_m1 = ((uint64_t)link_n1 * mode->pixel_clock) / link_frequency; data_m1 = ((uint64_t)data_n1 * 18 * mode->pixel_clock) / (link_frequency * 8 * 4); printk(BIOS_INFO, "bringing up panel at resolution %d x %d\n", hactive, vactive); printk(BIOS_DEBUG, "Borders %d x %d\n", right_border, bottom_border); printk(BIOS_DEBUG, "Blank %d x %d\n", hblank, vblank); printk(BIOS_DEBUG, "Sync %d x %d\n", hsync, vsync); printk(BIOS_DEBUG, "Front porch %d x %d\n", hfront_porch, vfront_porch); printk(BIOS_DEBUG, (info->gfx.use_spread_spectrum_clock ? "Spread spectrum clock\n" : "DREF clock\n")); printk(BIOS_DEBUG, mode->lvds_dual_channel ? "Dual channel\n" : "Single channel\n"); printk(BIOS_DEBUG, "Polarities %d, %d\n", hpolarity, vpolarity); printk(BIOS_DEBUG, "Data M1=%d, N1=%d\n", data_m1, data_n1); printk(BIOS_DEBUG, "Link frequency %d kHz\n", link_frequency); printk(BIOS_DEBUG, "Link M1=%d, N1=%d\n", link_m1, link_n1); printk(BIOS_DEBUG, "Pixel N=%d, M1=%d, M2=%d, P1=%d\n", pixel_n, pixel_m1, pixel_m2, pixel_p1); printk(BIOS_DEBUG, "Pixel clock %d kHz\n", 120000 * (5 * pixel_m1 + pixel_m2) / pixel_n / (pixel_p1 * 7)); write32(mmio + LVDS, (hpolarity << 20) | (vpolarity << 21) | (mode->lvds_dual_channel ? LVDS_CLOCK_B_POWERUP_ALL | LVDS_CLOCK_BOTH_POWERUP_ALL : 0) | LVDS_BORDER_ENABLE | LVDS_CLOCK_A_POWERUP_ALL); mdelay(1); write32(mmio + PP_CONTROL, PANEL_UNLOCK_REGS | (read32(mmio + PP_CONTROL) & ~PANEL_UNLOCK_MASK)); write32(mmio + FP0(0), ((pixel_n - 2) << 16) | ((pixel_m1 - 2) << 8) | pixel_m2); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLLB_MODE_LVDS | (mode->lvds_dual_channel ? DPLLB_LVDS_P2_CLOCK_DIV_7 : DPLLB_LVDS_P2_CLOCK_DIV_14) | (0x10000 << (pixel_p1 - 1)) | ((info->gfx.use_spread_spectrum_clock ? 3 : 0) << 13) | (0x1 << (pixel_p1 - 1))); mdelay(1); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLLB_MODE_LVDS | (mode->lvds_dual_channel ? DPLLB_LVDS_P2_CLOCK_DIV_7 : DPLLB_LVDS_P2_CLOCK_DIV_14) | (0x10000 << (pixel_p1 - 1)) | ((info->gfx.use_spread_spectrum_clock ? 3 : 0) << 13) | (0x1 << (pixel_p1 - 1))); /* Re-lock the registers. */ write32(mmio + PP_CONTROL, (read32(mmio + PP_CONTROL) & ~PANEL_UNLOCK_MASK)); write32(mmio + LVDS, (hpolarity << 20) | (vpolarity << 21) | (mode->lvds_dual_channel ? LVDS_CLOCK_B_POWERUP_ALL | LVDS_CLOCK_BOTH_POWERUP_ALL : 0) | LVDS_BORDER_ENABLE | LVDS_CLOCK_A_POWERUP_ALL); write32(mmio + HTOTAL(0), ((hactive + right_border + hblank - 1) << 16) | (hactive - 1)); write32(mmio + HBLANK(0), ((hactive + right_border + hblank - 1) << 16) | (hactive + right_border - 1)); write32(mmio + HSYNC(0), ((hactive + right_border + hfront_porch + hsync - 1) << 16) | (hactive + right_border + hfront_porch - 1)); write32(mmio + VTOTAL(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive - 1)); write32(mmio + VBLANK(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive + bottom_border - 1)); write32(mmio + VSYNC(0), (vactive + bottom_border + vfront_porch + vsync - 1) | (vactive + bottom_border + vfront_porch - 1)); write32(mmio + PIPECONF(0), PIPECONF_DISABLE); write32(mmio + PF_WIN_POS(0), 0); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { write32(mmio + PIPESRC(0), ((hactive - 1) << 16) | (vactive - 1)); write32(mmio + PF_CTL(0), 0); write32(mmio + PF_WIN_SZ(0), 0); write32(mmio + PFIT_CONTROL, 0x20000000); } else { write32(mmio + PIPESRC(0), (639 << 16) | 399); write32(mmio + PF_CTL(0), PF_ENABLE | PF_FILTER_MED_3x3); write32(mmio + PF_WIN_SZ(0), vactive | (hactive << 16)); write32(mmio + PFIT_CONTROL, 0xa0000000); } mdelay(1); write32(mmio + PIPE_DATA_M1(0), 0x7e000000 | data_m1); write32(mmio + PIPE_DATA_N1(0), data_n1); write32(mmio + PIPE_LINK_M1(0), link_m1); write32(mmio + PIPE_LINK_N1(0), link_n1); write32(mmio + 0x000f000c, 0x00002040); mdelay(1); write32(mmio + 0x000f000c, 0x00002050); write32(mmio + 0x00060100, 0x00044000); mdelay(1); write32(mmio + PIPECONF(0), PIPECONF_BPP_6); write32(mmio + 0x000f0008, 0x00000040); write32(mmio + 0x000f000c, 0x00022050); write32(mmio + PIPECONF(0), PIPECONF_BPP_6 | PIPECONF_DITHER_EN); write32(mmio + PIPECONF(0), PIPECONF_ENABLE | PIPECONF_BPP_6 | PIPECONF_DITHER_EN); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { write32(mmio + VGACNTRL, 0x22c4008e | VGA_DISP_DISABLE); write32(mmio + DSPCNTR(0), DISPLAY_PLANE_ENABLE | DISPPLANE_BGRX888); mdelay(1); } else { write32(mmio + VGACNTRL, 0x22c4008e); } write32(mmio + TRANS_HTOTAL(0), ((hactive + right_border + hblank - 1) << 16) | (hactive - 1)); write32(mmio + TRANS_HBLANK(0), ((hactive + right_border + hblank - 1) << 16) | (hactive + right_border - 1)); write32(mmio + TRANS_HSYNC(0), ((hactive + right_border + hfront_porch + hsync - 1) << 16) | (hactive + right_border + hfront_porch - 1)); write32(mmio + TRANS_VTOTAL(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive - 1)); write32(mmio + TRANS_VBLANK(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive + bottom_border - 1)); write32(mmio + TRANS_VSYNC(0), (vactive + bottom_border + vfront_porch + vsync - 1) | (vactive + bottom_border + vfront_porch - 1)); write32(mmio + 0x00060100, 0xb01c4000); write32(mmio + 0x000f000c, 0xb01a2050); mdelay(1); write32(mmio + TRANSCONF(0), TRANS_ENABLE | TRANS_6BPC ); write32(mmio + LVDS, LVDS_PORT_ENABLE | (hpolarity << 20) | (vpolarity << 21) | (mode->lvds_dual_channel ? LVDS_CLOCK_B_POWERUP_ALL | LVDS_CLOCK_BOTH_POWERUP_ALL : 0) | LVDS_BORDER_ENABLE | LVDS_CLOCK_A_POWERUP_ALL); write32(mmio + PP_CONTROL, PANEL_POWER_ON | PANEL_POWER_RESET); /* Enable screen memory. */ vga_sr_write(1, vga_sr_read(1) & ~0x20); /* Clear interrupts. */ write32(mmio + DEIIR, 0xffffffff); write32(mmio + SDEIIR, 0xffffffff); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { memset((void *) lfb, 0, edid.x_resolution * edid.y_resolution * 4); set_vbe_mode_info_valid(&edid, lfb); } }
static void intel_gma_init(const struct northbridge_intel_x4x_config *info, u8 *mmio, u32 physbase, u16 piobase, u32 lfb) { int i; u8 edid_data[128]; struct edid edid; struct edid_mode *mode; u8 edid_is_found; /* Initialise mode variables for 640 x 480 @ 60Hz */ u32 hactive = 640, vactive = 480; u32 right_border = 0, bottom_border = 0; int hpolarity = 0, vpolarity = 0; u32 hsync = 96, vsync = 2; u32 hblank = 160, vblank = 45; u32 hfront_porch = 16, vfront_porch = 10; u32 target_frequency = 25175; u32 err_most = 0xffffffff; u32 pixel_p1 = 1; u32 pixel_p2; u32 pixel_n = 1; u32 pixel_m1 = 1; u32 pixel_m2 = 1; vga_gr_write(0x18, 0); /* Set up GTT */ for (i = 0; i < 0x1000; i++) { outl((i << 2) | 1, piobase); outl(physbase + (i << 12) + 1, piobase + 4); } write32(mmio + VGA0, 0x31108); write32(mmio + VGA1, 0x31406); write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_CRT_HOTPLUG_MONITOR_COLOR | ADPA_CRT_HOTPLUG_ENABLE | ADPA_USE_VGA_HVPOLARITY | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON ); write32(mmio + 0x7041c, 0x0); write32(mmio + DPLL_MD(0), 0x3); write32(mmio + DPLL_MD(1), 0x3); vga_misc_write(0x67); const u8 cr[] = { 0x5f, 0x4f, 0x50, 0x82, 0x55, 0x81, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x1f, 0x96, 0xb9, 0xa3, 0xff }; vga_cr_write(0x11, 0); for (i = 0; i <= 0x18; i++) vga_cr_write(i, cr[i]); udelay(1); intel_gmbus_read_edid(mmio + GMBUS0, 2, 0x50, edid_data, sizeof(edid_data)); intel_gmbus_stop(mmio + GMBUS0); decode_edid(edid_data, sizeof(edid_data), &edid); mode = &edid.mode; /* Disable screen memory to prevent garbage from appearing. */ vga_sr_write(1, vga_sr_read(1) | 0x20); edid_is_found = edid_is_present(edid_data, sizeof(edid_data)); if (edid_is_found) { printk(BIOS_DEBUG, "EDID is not null"); hactive = edid.x_resolution; vactive = edid.y_resolution; right_border = mode->hborder; bottom_border = mode->vborder; hpolarity = (mode->phsync == '-'); vpolarity = (mode->pvsync == '-'); vsync = mode->vspw; hsync = mode->hspw; vblank = mode->vbl; hblank = mode->hbl; hfront_porch = mode->hso; vfront_porch = mode->vso; target_frequency = mode->pixel_clock; } else printk(BIOS_DEBUG, "EDID is null, using 640 x 480 @ 60Hz mode"); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { vga_sr_write(1, 1); vga_sr_write(0x2, 0xf); vga_sr_write(0x3, 0x0); vga_sr_write(0x4, 0xe); vga_gr_write(0, 0x0); vga_gr_write(1, 0x0); vga_gr_write(2, 0x0); vga_gr_write(3, 0x0); vga_gr_write(4, 0x0); vga_gr_write(5, 0x0); vga_gr_write(6, 0x5); vga_gr_write(7, 0xf); vga_gr_write(0x10, 0x1); vga_gr_write(0x11, 0); edid.bytes_per_line = (edid.bytes_per_line + 63) & ~63; write32(mmio + DSPCNTR(0), DISPLAY_PLANE_ENABLE | DISPPLANE_BGRX888); write32(mmio + DSPADDR(0), 0); write32(mmio + DSPSTRIDE(0), edid.bytes_per_line); write32(mmio + DSPSURF(0), 0); for (i = 0; i < 0x100; i++) write32(mmio + LGC_PALETTE(0) + 4 * i, i * 0x010101); } else { vga_textmode_init(); } pixel_p2 = target_frequency <= 225000 ? 10 : 5; u32 candn, candm1, candm2, candp1; for (candn = 1; candn <= 4; candn++) { for (candm1 = 23; candm1 >= 16; candm1--) { for (candm2 = 11; candm2 >= 5; candm2--) { for (candp1 = 8; candp1 >= 1; candp1--) { u32 m = 5 * (candm1 + 2) + (candm2 + 2); u32 p = candp1 * pixel_p2; u32 vco = DIV_ROUND_CLOSEST( BASE_FREQUENCY * m, candn + 2); u32 dot = DIV_ROUND_CLOSEST(vco, p); u32 this_err = MAX(dot, target_frequency) - MIN(dot, target_frequency); if (this_err < err_most) { err_most = this_err; pixel_n = candn; pixel_m1 = candm1; pixel_m2 = candm2; pixel_p1 = candp1; } } } } } if (err_most == 0xffffffff) { printk(BIOS_ERR, "Couldn't find GFX clock divisors\n"); return; } printk(BIOS_INFO, "bringing up panel at resolution %d x %d\n", hactive, vactive); printk(BIOS_DEBUG, "Borders %d x %d\n", right_border, bottom_border); printk(BIOS_DEBUG, "Blank %d x %d\n", hblank, vblank); printk(BIOS_DEBUG, "Sync %d x %d\n", hsync, vsync); printk(BIOS_DEBUG, "Front porch %d x %d\n", hfront_porch, vfront_porch); printk(BIOS_DEBUG, (info->gfx.use_spread_spectrum_clock ? "Spread spectrum clock\n" : "DREF clock\n")); printk(BIOS_DEBUG, "Polarities %d, %d\n", hpolarity, vpolarity); printk(BIOS_DEBUG, "Pixel N=%d, M1=%d, M2=%d, P1=%d, P2=%d\n", pixel_n, pixel_m1, pixel_m2, pixel_p1, pixel_p2); printk(BIOS_DEBUG, "Pixel clock %d kHz\n", BASE_FREQUENCY * (5 * (pixel_m1 + 2) + (pixel_m2 + 2)) / (pixel_n + 2) / (pixel_p1 * pixel_p2)); mdelay(1); write32(mmio + FP0(0), (pixel_n << 16) | (pixel_m1 << 8) | pixel_m2); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLL_VGA_MODE_DIS | DPLLB_MODE_DAC_SERIAL | (pixel_p2 == 10 ? DPLL_DAC_SERIAL_P2_CLOCK_DIV_10 : DPLL_DAC_SERIAL_P2_CLOCK_DIV_5) | (0x10000 << (pixel_p1 - 1)) | (6 << 9)); mdelay(1); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLL_VGA_MODE_DIS | DPLLB_MODE_DAC_SERIAL | (pixel_p2 == 10 ? DPLL_DAC_SERIAL_P2_CLOCK_DIV_10 : DPLL_DAC_SERIAL_P2_CLOCK_DIV_5) | (0x10000 << (pixel_p1 - 1)) | (6 << 9)); write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_CRT_HOTPLUG_MONITOR_COLOR | ADPA_CRT_HOTPLUG_ENABLE | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON | (vpolarity ? ADPA_VSYNC_ACTIVE_LOW : ADPA_VSYNC_ACTIVE_HIGH) | (hpolarity ? ADPA_HSYNC_ACTIVE_LOW : ADPA_HSYNC_ACTIVE_HIGH)); write32(mmio + HTOTAL(0), ((hactive + right_border + hblank - 1) << 16) | (hactive - 1)); write32(mmio + HBLANK(0), ((hactive + right_border + hblank - 1) << 16) | (hactive + right_border - 1)); write32(mmio + HSYNC(0), ((hactive + right_border + hfront_porch + hsync - 1) << 16) | (hactive + right_border + hfront_porch - 1)); write32(mmio + VTOTAL(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive - 1)); write32(mmio + VBLANK(0), ((vactive + bottom_border + vblank - 1) << 16) | (vactive + bottom_border - 1)); write32(mmio + VSYNC(0), ((vactive + bottom_border + vfront_porch + vsync - 1) << 16) | (vactive + bottom_border + vfront_porch - 1)); write32(mmio + PIPECONF(0), PIPECONF_DISABLE); write32(mmio + PF_WIN_POS(0), 0); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { write32(mmio + PIPESRC(0), ((hactive - 1) << 16) | (vactive - 1)); write32(mmio + PF_CTL(0), 0); write32(mmio + PF_WIN_SZ(0), 0); write32(mmio + PFIT_CONTROL, 0); } else { write32(mmio + PIPESRC(0), (639 << 16) | 399); write32(mmio + PF_CTL(0), PF_ENABLE | PF_FILTER_MED_3x3); write32(mmio + PF_WIN_SZ(0), vactive | (hactive << 16)); write32(mmio + PFIT_CONTROL, 0x80000000); } mdelay(1); write32(mmio + PIPECONF(0), PIPECONF_BPP_6); write32(mmio + PIPECONF(0), PIPECONF_BPP_6 | PIPECONF_DITHER_EN); write32(mmio + PIPECONF(0), PIPECONF_ENABLE | PIPECONF_BPP_6 | PIPECONF_DITHER_EN); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { write32(mmio + VGACNTRL, VGA_DISP_DISABLE); write32(mmio + DSPCNTR(0), DISPLAY_PLANE_ENABLE | DISPPLANE_BGRX888); mdelay(1); } else { write32(mmio + VGACNTRL, 0xc4008e); } write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_CRT_HOTPLUG_MONITOR_COLOR | ADPA_CRT_HOTPLUG_ENABLE | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON | (vpolarity ? ADPA_VSYNC_ACTIVE_LOW : ADPA_VSYNC_ACTIVE_HIGH) | (hpolarity ? ADPA_HSYNC_ACTIVE_LOW : ADPA_HSYNC_ACTIVE_HIGH)); write32(mmio + PP_CONTROL, PANEL_POWER_ON | PANEL_POWER_RESET); /* Enable screen memory. */ vga_sr_write(1, vga_sr_read(1) & ~0x20); /* Clear interrupts. */ write32(mmio + DEIIR, 0xffffffff); write32(mmio + SDEIIR, 0xffffffff); if (IS_ENABLED(CONFIG_FRAMEBUFFER_KEEP_VESA_MODE)) { memset((void *) lfb, 0, hactive * vactive * 4); set_vbe_mode_info_valid(&edid, lfb); } }
static void intel_gma_init(const struct northbridge_intel_pineview_config *info, struct device *vga, u8 *mmio, u8 *gtt, u32 physbase, u16 piobase) { int i; u32 hactive, vactive; u32 temp; printk(BIOS_SPEW, "gtt %x mmio %x addrport %x physbase %x\n", (u32)gtt, (u32)mmio, piobase, physbase); gtt_setup(mmio); pci_write_config16(vga, 0x52, 0x130); /* Disable VGA. */ write32(mmio + VGACNTRL, VGA_DISP_DISABLE); /* Disable pipes. */ write32(mmio + PIPECONF(0), 0); write32(mmio + PIPECONF(1), 0); write32(mmio + INSTPM, 0x800); vga_gr_write(0x18, 0); write32(mmio + VGA0, 0x200074); write32(mmio + VGA1, 0x200074); write32(mmio + DSPFW3, 0x7f3f00c1 & ~PINEVIEW_SELF_REFRESH_EN); write32(mmio + DSPCLK_GATE_D, 0); write32(mmio + FW_BLC, 0x03060106); write32(mmio + FW_BLC2, 0x00000306); write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_HOTPLUG_BITS | ADPA_USE_VGA_HVPOLARITY | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON ); write32(mmio + 0x7041c, 0x0); write32(mmio + DPLL_MD(0), 0x3); write32(mmio + DPLL_MD(1), 0x3); write32(mmio + DSPCNTR(1), 0x1000000); write32(mmio + PIPESRC(1), 0x027f01df); vga_misc_write(0x67); const u8 cr[] = { 0x5f, 0x4f, 0x50, 0x82, 0x55, 0x81, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x1f, 0x96, 0xb9, 0xa3, 0xff }; vga_cr_write(0x11, 0); for (i = 0; i <= 0x18; i++) vga_cr_write(i, cr[i]); // Disable screen memory to prevent garbage from appearing. vga_sr_write(1, vga_sr_read(1) | 0x20); hactive = 640; vactive = 400; mdelay(1); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLLB_MODE_DAC_SERIAL | DPLL_VGA_MODE_DIS | DPLL_DAC_SERIAL_P2_CLOCK_DIV_10 | 0x400601 ); mdelay(1); write32(mmio + DPLL(0), DPLL_VCO_ENABLE | DPLLB_MODE_DAC_SERIAL | DPLL_VGA_MODE_DIS | DPLL_DAC_SERIAL_P2_CLOCK_DIV_10 | 0x400601 ); write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_HOTPLUG_BITS | ADPA_USE_VGA_HVPOLARITY | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON ); write32(mmio + HTOTAL(1), 0x031f027f); write32(mmio + HBLANK(1), 0x03170287); write32(mmio + HSYNC(1), 0x02ef028f); write32(mmio + VTOTAL(1), 0x020c01df); write32(mmio + VBLANK(1), 0x020401e7); write32(mmio + VSYNC(1), 0x01eb01e9); write32(mmio + HTOTAL(0), ((hactive - 1) << 16) | (hactive - 1)); write32(mmio + HBLANK(0), ((hactive - 1) << 16) | (hactive - 1)); write32(mmio + HSYNC(0), ((hactive - 1) << 16) | (hactive - 1)); write32(mmio + VTOTAL(0), ((vactive - 1) << 16) | (vactive - 1)); write32(mmio + VBLANK(0), ((vactive - 1) << 16) | (vactive - 1)); write32(mmio + VSYNC(0), ((vactive - 1) << 16) | (vactive - 1)); write32(mmio + PF_WIN_POS(0), 0); write32(mmio + PIPESRC(0), (639 << 16) | 399); write32(mmio + PF_CTL(0),PF_ENABLE | PF_FILTER_MED_3x3); write32(mmio + PF_WIN_SZ(0), vactive | (hactive << 16)); write32(mmio + PFIT_CONTROL, 0x0); mdelay(1); write32(mmio + FDI_RX_CTL(0), 0x00002040); mdelay(1); write32(mmio + FDI_RX_CTL(0), 0x80002050); write32(mmio + FDI_TX_CTL(0), 0x00044000); mdelay(1); write32(mmio + FDI_TX_CTL(0), 0x80044000); write32(mmio + PIPECONF(0), PIPECONF_ENABLE | PIPECONF_BPP_6 | PIPECONF_DITHER_EN); write32(mmio + VGACNTRL, 0x0); write32(mmio + DSPCNTR(0), DISPLAY_PLANE_ENABLE | DISPPLANE_BGRX888); mdelay(1); write32(mmio + ADPA, ADPA_DAC_ENABLE | ADPA_PIPE_A_SELECT | ADPA_HOTPLUG_BITS | ADPA_USE_VGA_HVPOLARITY | ADPA_VSYNC_CNTL_ENABLE | ADPA_HSYNC_CNTL_ENABLE | ADPA_DPMS_ON ); write32(mmio + DSPFW3, 0x7f3f00c1); write32(mmio + MI_MODE, 0x200 | VS_TIMER_DISPATCH); write32(mmio + CACHE_MODE_0, (0x6820 | (1 << 9)) & ~(1 << 5)); write32(mmio + CACHE_MODE_1, 0x380 & ~(1 << 9)); for (i = 0; i < (8192 - 512) / 4; i++) { outl((i << 2) | 1, piobase); outl(physbase + (i << 12) + 1, piobase + 4); } temp = read32(mmio + PGETBL_CTL); printk(BIOS_INFO, "GTT PGETBL_CTL register : 0x%08x\n", temp); temp = read32(mmio + PGETBL2_CTL); printk(BIOS_INFO, "GTT PGETBL2_CTL register: 0x%08x\n", temp); /* Clear interrupts. */ write32(mmio + DEIIR, 0xffffffff); write32(mmio + SDEIIR, 0xffffffff); write32(mmio + IIR, 0xffffffff); write32(mmio + IMR, 0xffffffff); write32(mmio + EIR, 0xffffffff); vga_textmode_init(); /* Enable screen memory. */ vga_sr_write(1, vga_sr_read(1) & ~0x20); }