grub-core/video/sis315pro.c

   1 /*
   2  *  GRUB  --  GRand Unified Bootloader
   3  *  Copyright (C) 2005,2006,2007,2008,2009,2010  Free Software Foundation, Inc.
   4  *
   5  *  GRUB is free software: you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation, either version 3 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  GRUB is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #define grub_video_render_target grub_video_fbrender_target
  20
  21 #include <grub/err.h>
  22 #include <grub/types.h>
  23 #include <grub/dl.h>
  24 #include <grub/misc.h>
  25 #include <grub/mm.h>
  26 #include <grub/video.h>
  27 #include <grub/video_fb.h>
  28 #include <grub/pci.h>
  29 #include <grub/vga.h>
  30
  31 #define GRUB_SIS315PRO_PCIID 0x03251039
  32 #define GRUB_SIS315PRO_TOTAL_MEMORY_SPACE  0x800000
  33 #define GRUB_SIS315PRO_MMIO_SPACE 0x1000
  34
  35 static struct
  36 {
  37   struct grub_video_mode_info mode_info;
  38   struct grub_video_render_target *render_target;
  39
  40   grub_uint8_t *ptr;
  41   int mapped;
  42   grub_uint32_t base;
  43   grub_uint32_t mmiobase;
  44   volatile grub_uint32_t *mmioptr;
  45   grub_pci_device_t dev;
  46   grub_port_t io;
  47 } framebuffer;
  48
  49 static grub_uint8_t
  50 read_sis_cmd (grub_uint8_t addr)
  51 {
  52   grub_outb (addr, framebuffer.io + 0x44);
  53   return grub_inb (framebuffer.io + 0x45);
  54 }
  55
  56 static void
  57 write_sis_cmd (grub_uint8_t val, grub_uint8_t addr)
  58 {
  59   grub_outb (addr, framebuffer.io + 0x44);
  60   grub_outb (val, framebuffer.io + 0x45);
  61 }
  62
  63 #ifndef TEST
  64 static grub_err_t
  65 grub_video_sis315pro_video_init (void)
  66 {
  67   /* Reset frame buffer.  */
  68   grub_memset (&framebuffer, 0, sizeof(framebuffer));
  69
  70   return grub_video_fb_init ();
  71 }
  72
  73 static grub_err_t
  74 grub_video_sis315pro_video_fini (void)
  75 {
  76   if (framebuffer.mapped)
  77     grub_pci_device_unmap_range (framebuffer.dev, framebuffer.ptr,
  78                                  GRUB_SIS315PRO_TOTAL_MEMORY_SPACE);
  79
  80   return grub_video_fb_fini ();
  81 }
  82 #endif
  83
  84 #include "sis315_init.c"
  85
  86 static grub_err_t
  87 grub_video_sis315pro_setup (unsigned int width, unsigned int height,
  88                             unsigned int mode_type,
  89                             unsigned int mode_mask __attribute__ ((unused)))
  90 {
  91   int depth;
  92   grub_err_t err;
  93   int found = 0;
  94   unsigned i;
  95
  96 #ifndef TEST
  97   auto int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)));
  98   int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)))
  99     {
 100       grub_pci_address_t addr;
 101       grub_uint32_t class;
 102
 103       addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
 104       class = grub_pci_read (addr);
 105
 106       if (((class >> 16) & 0xffff) != GRUB_PCI_CLASS_SUBCLASS_VGA
 107           || pciid != GRUB_SIS315PRO_PCIID)
 108         return 0;
 109
 110       found = 1;
 111
 112       addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG0);
 113       framebuffer.base = grub_pci_read (addr) & GRUB_PCI_ADDR_MEM_MASK;
 114       addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG1);
 115       framebuffer.mmiobase = grub_pci_read (addr) & GRUB_PCI_ADDR_MEM_MASK;
 116       addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG2);
 117       framebuffer.io = (grub_pci_read (addr) & GRUB_PCI_ADDR_IO_MASK)
 118         + GRUB_MACHINE_PCI_IO_BASE;
 119       framebuffer.dev = dev;
 120
 121       return 1;
 122     }
 123
 124   /* Decode depth from mode_type.  If it is zero, then autodetect.  */
 125   depth = (mode_type & GRUB_VIDEO_MODE_TYPE_DEPTH_MASK)
 126           >> GRUB_VIDEO_MODE_TYPE_DEPTH_POS;
 127
 128   if ((width != 640 && width != 0) || (height != 480 && height != 0)
 129       || (depth != 8 && depth != 0))
 130     return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
 131                        "Only 640x400x8 is supported");
 132
 133   grub_pci_iterate (find_card);
 134   if (!found)
 135     return grub_error (GRUB_ERR_IO, "Couldn't find graphics card");
 136 #endif
 137   /* Fill mode info details.  */
 138   framebuffer.mode_info.width = 640;
 139   framebuffer.mode_info.height = 480;
 140   framebuffer.mode_info.mode_type = GRUB_VIDEO_MODE_TYPE_INDEX_COLOR;
 141   framebuffer.mode_info.bpp = 8;
 142   framebuffer.mode_info.bytes_per_pixel = 1;
 143   framebuffer.mode_info.pitch = 640 * 1;
 144   framebuffer.mode_info.number_of_colors = 256;
 145   framebuffer.mode_info.red_mask_size = 0;
 146   framebuffer.mode_info.red_field_pos = 0;
 147   framebuffer.mode_info.green_mask_size = 0;
 148   framebuffer.mode_info.green_field_pos = 0;
 149   framebuffer.mode_info.blue_mask_size = 0;
 150   framebuffer.mode_info.blue_field_pos = 0;
 151   framebuffer.mode_info.reserved_mask_size = 0;
 152   framebuffer.mode_info.reserved_field_pos = 0;
 153 #ifndef TEST
 154   framebuffer.mode_info.blit_format
 155     = grub_video_get_blit_format (&framebuffer.mode_info);
 156 #endif
 157
 158 #ifndef TEST
 159   if (found && (framebuffer.base == 0 || framebuffer.mmiobase == 0))
 160     {
 161       grub_pci_address_t addr;
 162       /* FIXME: choose address dynamically if needed.   */
 163       framebuffer.base =     0x40000000;
 164       framebuffer.mmiobase = 0x04000000;
 165       framebuffer.io = 0xb300;
 166
 167       addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_ADDRESS_REG0);
 168       grub_pci_write (addr, framebuffer.base | GRUB_PCI_ADDR_MEM_PREFETCH);
 169
 170       addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_ADDRESS_REG1);
 171       grub_pci_write (addr, framebuffer.mmiobase);
 172
 173       addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_ADDRESS_REG2);
 174       grub_pci_write (addr, framebuffer.io | GRUB_PCI_ADDR_SPACE_IO);
 175
 176       /* Set latency.  */
 177       addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_CACHELINE);
 178       grub_pci_write (addr, 0x80004700);
 179
 180       /* Enable address spaces.  */
 181       addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_COMMAND);
 182       grub_pci_write (addr, 0x7);
 183
 184       addr = grub_pci_make_address (framebuffer.dev, 0x30);
 185       grub_pci_write (addr, 0x04060001);
 186
 187       framebuffer.io += GRUB_MACHINE_PCI_IO_BASE;
 188     }
 189 #endif
 190
 191
 192   /* We can safely discard volatile attribute.  */
 193 #ifndef TEST
 194   framebuffer.ptr
 195     = (void *) grub_pci_device_map_range (framebuffer.dev,
 196                                           framebuffer.base,
 197                                           GRUB_SIS315PRO_TOTAL_MEMORY_SPACE);
 198   framebuffer.mmioptr = grub_pci_device_map_range (framebuffer.dev,
 199                                                    framebuffer.mmiobase,
 200                                                    GRUB_SIS315PRO_MMIO_SPACE);
 201 #endif
 202   framebuffer.mapped = 1;
 203
 204 #ifndef TEST
 205   /* Prevent garbage from appearing on the screen.  */
 206   grub_memset (framebuffer.ptr, 0,
 207                framebuffer.mode_info.height * framebuffer.mode_info.pitch);
 208 #endif
 209
 210   grub_outb (GRUB_VGA_IO_MISC_NEGATIVE_VERT_POLARITY
 211              | GRUB_VGA_IO_MISC_NEGATIVE_HORIZ_POLARITY
 212              | GRUB_VGA_IO_MISC_UPPER_64K
 213              | GRUB_VGA_IO_MISC_EXTERNAL_CLOCK_0
 214              | GRUB_VGA_IO_MISC_28MHZ
 215              | GRUB_VGA_IO_MISC_ENABLE_VRAM_ACCESS
 216              | GRUB_VGA_IO_MISC_COLOR,
 217              GRUB_VGA_IO_MISC_WRITE + GRUB_MACHINE_PCI_IO_BASE);
 218
 219   grub_vga_sr_write (0x86, 5);
 220   for (i = 6; i <= 0x27; i++)
 221     grub_vga_sr_write (0, i);
 222
 223   for (i = 0x31; i <= 0x3d; i++)
 224     grub_vga_sr_write (0, i);
 225
 226   for (i = 0; i < ARRAY_SIZE (sr_dump); i++)
 227     grub_vga_sr_write (sr_dump[i].val, sr_dump[i].reg);
 228
 229   for (i = 0x30; i < 0x40; i++)
 230     grub_vga_cr_write (0, i);
 231
 232   grub_vga_cr_write (0x77, 0x40);
 233   grub_vga_cr_write (0x77, 0x41);
 234   grub_vga_cr_write (0x00, 0x42);
 235   grub_vga_cr_write (0x5b, 0x43);
 236   grub_vga_cr_write (0x00, 0x44);
 237   grub_vga_cr_write (0x23, 0x48);
 238   grub_vga_cr_write (0xaa, 0x49);
 239   grub_vga_cr_write (0x02, 0x37);
 240   grub_vga_cr_write (0x20, 0x5b);
 241   grub_vga_cr_write (0x00, 0x83);
 242   grub_vga_cr_write (0x80, 0x63);
 243
 244   grub_vga_cr_write (0x0c, GRUB_VGA_CR_VSYNC_END);
 245   grub_vga_cr_write (0x5f, GRUB_VGA_CR_HTOTAL);
 246   grub_vga_cr_write (0x4f, GRUB_VGA_CR_HORIZ_END);
 247   grub_vga_cr_write (0x50, GRUB_VGA_CR_HBLANK_START);
 248   grub_vga_cr_write (0x82, GRUB_VGA_CR_HBLANK_END);
 249   grub_vga_cr_write (0x54, GRUB_VGA_CR_HORIZ_SYNC_PULSE_START);
 250   grub_vga_cr_write (0x80, GRUB_VGA_CR_HORIZ_SYNC_PULSE_END);
 251   grub_vga_cr_write (0x0b, GRUB_VGA_CR_VERT_TOTAL);
 252   grub_vga_cr_write (0x3e, GRUB_VGA_CR_OVERFLOW);
 253   grub_vga_cr_write (0x00, GRUB_VGA_CR_BYTE_PANNING);
 254   grub_vga_cr_write (0x40, GRUB_VGA_CR_CELL_HEIGHT);
 255   grub_vga_cr_write (0x00, GRUB_VGA_CR_CURSOR_START);
 256   grub_vga_cr_write (0x00, GRUB_VGA_CR_CURSOR_END);
 257   grub_vga_cr_write (0x00, GRUB_VGA_CR_START_ADDR_HIGH_REGISTER);
 258   grub_vga_cr_write (0x00, GRUB_VGA_CR_START_ADDR_LOW_REGISTER);
 259   grub_vga_cr_write (0x00, GRUB_VGA_CR_CURSOR_ADDR_HIGH);
 260   grub_vga_cr_write (0x00, GRUB_VGA_CR_CURSOR_ADDR_LOW);
 261   grub_vga_cr_write (0xea, GRUB_VGA_CR_VSYNC_START);
 262   grub_vga_cr_write (0x8c, GRUB_VGA_CR_VSYNC_END);
 263   grub_vga_cr_write (0xdf, GRUB_VGA_CR_VDISPLAY_END);
 264   grub_vga_cr_write (0x28, GRUB_VGA_CR_PITCH);
 265   grub_vga_cr_write (0x40, GRUB_VGA_CR_UNDERLINE_LOCATION);
 266   grub_vga_cr_write (0xe7, GRUB_VGA_CR_VERTICAL_BLANK_START);
 267   grub_vga_cr_write (0x04, GRUB_VGA_CR_VERTICAL_BLANK_END);
 268   grub_vga_cr_write (0xa3, GRUB_VGA_CR_MODE);
 269   grub_vga_cr_write (0xff, GRUB_VGA_CR_LINE_COMPARE);
 270
 271   grub_vga_cr_write (0x0c, GRUB_VGA_CR_VSYNC_END);
 272   grub_vga_cr_write (0x5f, GRUB_VGA_CR_HTOTAL);
 273   grub_vga_cr_write (0x4f, GRUB_VGA_CR_HORIZ_END);
 274   grub_vga_cr_write (0x50, GRUB_VGA_CR_HBLANK_START);
 275   grub_vga_cr_write (0x82, GRUB_VGA_CR_HBLANK_END);
 276   grub_vga_cr_write (0x55, GRUB_VGA_CR_HORIZ_SYNC_PULSE_START);
 277   grub_vga_cr_write (0x81, GRUB_VGA_CR_HORIZ_SYNC_PULSE_END);
 278   grub_vga_cr_write (0x0b, GRUB_VGA_CR_VERT_TOTAL);
 279   grub_vga_cr_write (0x3e, GRUB_VGA_CR_OVERFLOW);
 280   grub_vga_cr_write (0xe9, GRUB_VGA_CR_VSYNC_START);
 281   grub_vga_cr_write (0x8b, GRUB_VGA_CR_VSYNC_END);
 282   grub_vga_cr_write (0xdf, GRUB_VGA_CR_VDISPLAY_END);
 283   grub_vga_cr_write (0xe7, GRUB_VGA_CR_VERTICAL_BLANK_START);
 284   grub_vga_cr_write (0x04, GRUB_VGA_CR_VERTICAL_BLANK_END);
 285   grub_vga_cr_write (0x40, GRUB_VGA_CR_CELL_HEIGHT);
 286   grub_vga_cr_write (0x50, GRUB_VGA_CR_PITCH);
 287
 288   grub_vga_cr_write (0x00, 0x19);
 289   grub_vga_cr_write (0x00, 0x1a);
 290   grub_vga_cr_write (0x6c, 0x52);
 291   grub_vga_cr_write (0x2e, 0x34);
 292   grub_vga_cr_write (0x00, 0x31);
 293
 294
 295   grub_vga_cr_write (0, GRUB_VGA_CR_START_ADDR_HIGH_REGISTER);
 296   grub_vga_cr_write (0, GRUB_VGA_CR_START_ADDR_LOW_REGISTER);
 297
 298   for (i = 0; i < 16; i++)
 299     grub_vga_write_arx (i, i);
 300   grub_vga_write_arx (1, GRUB_VGA_ARX_MODE);
 301   grub_vga_write_arx (0, GRUB_VGA_ARX_OVERSCAN);
 302   grub_vga_write_arx (0, GRUB_VGA_ARX_COLOR_PLANE_ENABLE);
 303   grub_vga_write_arx (0, GRUB_VGA_ARX_HORIZONTAL_PANNING);
 304   grub_vga_write_arx (0, GRUB_VGA_ARX_COLOR_SELECT);
 305
 306   grub_outb (0xff, GRUB_VGA_IO_PIXEL_MASK + GRUB_MACHINE_PCI_IO_BASE);
 307
 308   for (i = 0; i < ARRAY_SIZE (gr); i++)
 309     grub_vga_gr_write (gr[i], i);
 310
 311   for (i = 0; i < GRUB_VIDEO_FBSTD_NUMCOLORS; i++)
 312     grub_vga_palette_write (i, grub_video_fbstd_colors[i].r,
 313                             grub_video_fbstd_colors[i].g,
 314                             grub_video_fbstd_colors[i].b);
 315
 316 #if 1
 317   {
 318     if (read_sis_cmd (0x5) != 0xa1)
 319       write_sis_cmd (0x86, 0x5);
 320
 321     write_sis_cmd (read_sis_cmd (0x20) | 0xa1, 0x20);
 322     write_sis_cmd (read_sis_cmd (0x1e) | 0xda, 0x1e);
 323
 324 #define IND_SIS_CMDQUEUE_SET            0x26
 325 #define IND_SIS_CMDQUEUE_THRESHOLD      0x27
 326
 327 #define COMMAND_QUEUE_THRESHOLD 0x1F
 328 #define SIS_CMD_QUEUE_RESET             0x01
 329
 330 #define SIS_AGP_CMDQUEUE_ENABLE         0x80  /* 315/330/340 series SR26 */
 331 #define SIS_VRAM_CMDQUEUE_ENABLE        0x40
 332 #define SIS_MMIO_CMD_ENABLE             0x20
 333 #define SIS_CMD_QUEUE_SIZE_512k         0x00
 334 #define SIS_CMD_QUEUE_SIZE_1M           0x04
 335 #define SIS_CMD_QUEUE_SIZE_2M           0x08
 336 #define SIS_CMD_QUEUE_SIZE_4M           0x0C
 337 #define SIS_CMD_QUEUE_RESET             0x01
 338 #define SIS_CMD_AUTO_CORR               0x02
 339
 340
 341     write_sis_cmd (COMMAND_QUEUE_THRESHOLD, IND_SIS_CMDQUEUE_THRESHOLD);
 342     write_sis_cmd (SIS_CMD_QUEUE_RESET, IND_SIS_CMDQUEUE_SET);
 343     framebuffer.mmioptr[0x85C4 / 4] = framebuffer.mmioptr[0x85C8 / 4];
 344     write_sis_cmd (SIS_MMIO_CMD_ENABLE | SIS_CMD_AUTO_CORR, IND_SIS_CMDQUEUE_SET);
 345     framebuffer.mmioptr[0x85C0 / 4] = (0x1000000 - (512 * 1024));
 346   }
 347 #endif
 348
 349 #ifndef TEST
 350   err = grub_video_fb_create_render_target_from_pointer (&framebuffer
 351                                                          .render_target,
 352                                                          &framebuffer.mode_info,
 353                                                          framebuffer.ptr);
 354
 355   if (err)
 356     return err;
 357
 358   err = grub_video_fb_set_active_render_target (framebuffer.render_target);
 359
 360   if (err)
 361     return err;
 362
 363   /* Copy default palette to initialize emulated palette.  */
 364   err = grub_video_fb_set_palette (0, GRUB_VIDEO_FBSTD_NUMCOLORS,
 365                                    grub_video_fbstd_colors);
 366 #endif
 367   return err;
 368 }
 369
 370 #ifndef TEST
 371
 372 static grub_err_t
 373 grub_video_sis315pro_swap_buffers (void)
 374 {
 375   /* TODO: Implement buffer swapping.  */
 376   return GRUB_ERR_NONE;
 377 }
 378
 379 static grub_err_t
 380 grub_video_sis315pro_set_active_render_target (struct grub_video_render_target *target)
 381 {
 382   if (target == GRUB_VIDEO_RENDER_TARGET_DISPLAY)
 383       target = framebuffer.render_target;
 384
 385   return grub_video_fb_set_active_render_target (target);
 386 }
 387
 388 static grub_err_t
 389 grub_video_sis315pro_get_info_and_fini (struct grub_video_mode_info *mode_info,
 390                                         void **framebuf)
 391 {
 392   grub_memcpy (mode_info, &(framebuffer.mode_info), sizeof (*mode_info));
 393   *framebuf = (char *) framebuffer.ptr;
 394
 395   grub_video_fb_fini ();
 396
 397   return GRUB_ERR_NONE;
 398 }
 399
 400 static struct grub_video_adapter grub_video_sis315pro_adapter =
 401   {
 402     .name = "SIS315PRO Video Driver",
 403     .id = GRUB_VIDEO_DRIVER_SIS315PRO,
 404
 405     .prio = GRUB_VIDEO_ADAPTER_PRIO_NATIVE,
 406
 407     .init = grub_video_sis315pro_video_init,
 408     .fini = grub_video_sis315pro_video_fini,
 409     .setup = grub_video_sis315pro_setup,
 410     .get_info = grub_video_fb_get_info,
 411     .get_info_and_fini = grub_video_sis315pro_get_info_and_fini,
 412     .set_palette = grub_video_fb_set_palette,
 413     .get_palette = grub_video_fb_get_palette,
 414     .set_viewport = grub_video_fb_set_viewport,
 415     .get_viewport = grub_video_fb_get_viewport,
 416     .map_color = grub_video_fb_map_color,
 417     .map_rgb = grub_video_fb_map_rgb,
 418     .map_rgba = grub_video_fb_map_rgba,
 419     .unmap_color = grub_video_fb_unmap_color,
 420     .fill_rect = grub_video_fb_fill_rect,
 421     .blit_bitmap = grub_video_fb_blit_bitmap,
 422     .blit_render_target = grub_video_fb_blit_render_target,
 423     .scroll = grub_video_fb_scroll,
 424     .swap_buffers = grub_video_sis315pro_swap_buffers,
 425     .create_render_target = grub_video_fb_create_render_target,
 426     .delete_render_target = grub_video_fb_delete_render_target,
 427     .set_active_render_target = grub_video_sis315pro_set_active_render_target,
 428     .get_active_render_target = grub_video_fb_get_active_render_target,
 429
 430     .next = 0
 431   };
 432
 433 GRUB_MOD_INIT(video_sis315pro)
 434 {
 435   grub_video_register (&grub_video_sis315pro_adapter);
 436 }
 437
 438 GRUB_MOD_FINI(video_sis315pro)
 439 {
 440   grub_video_unregister (&grub_video_sis315pro_adapter);
 441 }
 442 #else
 443 int
 444 main ()
 445 {
 446   grub_video_sis315pro_setup (640, 400, 0, 0);
 447 }
 448 #endif