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