/*
 *  GRUB  --  GRand Unified Bootloader
 *  Copyright (C) 2005,2006,2007,2008,2009,2010  Free Software Foundation, Inc.
 *
 *  GRUB is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  GRUB is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with GRUB.  If not, see <http://www.gnu.org/licenses/>.
 */

#define grub_video_render_target grub_video_fbrender_target

#include <grub/err.h>
#include <grub/types.h>
#include <grub/dl.h>
#include <grub/misc.h>
#include <grub/mm.h>
#include <grub/video.h>
#include <grub/video_fb.h>
#include <grub/pci.h>
#include <grub/vga.h>

#include "sm712_init.c"

#define GRUB_SM712_TOTAL_MEMORY_SPACE  0x700400
#define GRUB_SM712_REG_BASE 0x700000
#define GRUB_SM712_PCIID 0x0712126f

enum
  {
    GRUB_SM712_SR_TV_CONTROL = 0x65,
    GRUB_SM712_SR_RAM_LUT = 0x66,
    GRUB_SM712_SR_CLOCK_CONTROL1 = 0x68,
    GRUB_SM712_SR_CLOCK_CONTROL2 = 0x69,
    GRUB_SM712_SR_VCLK_NUM = 0x6c,
    GRUB_SM712_SR_VCLK_DENOM = 0x6d,
    GRUB_SM712_SR_VCLK2_NUM = 0x6e,
    GRUB_SM712_SR_VCLK2_DENOM = 0x6f,
    GRUB_SM712_SR_POPUP_ICON_LOW = 0x80,
    GRUB_SM712_SR_POPUP_ICON_HIGH = 0x81,
    GRUB_SM712_SR_POPUP_ICON_CTRL = 0x82,
    GRUB_SM712_SR_POPUP_ICON_COLOR1 = 0x84,
    GRUB_SM712_SR_POPUP_ICON_COLOR2 = 0x85,
    GRUB_SM712_SR_POPUP_ICON_COLOR3 = 0x86,

    GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_X_LOW = 0x88,
    GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_X_HIGH = 0x89,
    GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_Y_LOW = 0x8a,
    GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_Y_HIGH = 0x8b,
    GRUB_SM712_SR_HW_CURSOR_FG_COLOR = 0x8c,
    GRUB_SM712_SR_HW_CURSOR_BG_COLOR = 0x8d,

    GRUB_SM712_SR_POPUP_ICON_X_LOW = 0x90,
    GRUB_SM712_SR_POPUP_ICON_X_HIGH = 0x91,
    GRUB_SM712_SR_POPUP_ICON_Y_LOW = 0x92,
    GRUB_SM712_SR_POPUP_ICON_Y_HIGH = 0x93,
    GRUB_SM712_SR_PANEL_HW_VIDEO_CONTROL = 0xa0,
    GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_LOW = 0xa1,
    GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_HIGH = 0xa2,
    GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_MASK_LOW = 0xa3,
    GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_MASK_HIGH = 0xa4,
    GRUB_SM712_SR_PANEL_HW_VIDEO_RED_CONSTANT = 0xa5,
    GRUB_SM712_SR_PANEL_HW_VIDEO_GREEN_CONSTANT = 0xa6,
    GRUB_SM712_SR_PANEL_HW_VIDEO_BLUE_CONSTANT = 0xa7,
    GRUB_SM712_SR_PANEL_HW_VIDEO_TOP_BOUNDARY = 0xa8,
    GRUB_SM712_SR_PANEL_HW_VIDEO_LEFT_BOUNDARY = 0xa9,
    GRUB_SM712_SR_PANEL_HW_VIDEO_BOTTOM_BOUNDARY = 0xaa,
    GRUB_SM712_SR_PANEL_HW_VIDEO_RIGHT_BOUNDARY = 0xab,
    GRUB_SM712_SR_PANEL_HW_VIDEO_TOP_LEFT_OVERFLOW_BOUNDARY = 0xac,
    GRUB_SM712_SR_PANEL_HW_VIDEO_BOTTOM_RIGHT_OVERFLOW_BOUNDARY = 0xad,
    GRUB_SM712_SR_PANEL_HW_VIDEO_VERTICAL_STRETCH_FACTOR = 0xae,
    GRUB_SM712_SR_PANEL_HW_VIDEO_HORIZONTAL_STRETCH_FACTOR = 0xaf,
  };
enum
  {
    GRUB_SM712_SR_TV_CRT_SRAM = 0x00,
    GRUB_SM712_SR_TV_LCD_SRAM = 0x08
  };
enum
  {
    GRUB_SM712_SR_TV_ALT_CLOCK = 0x00,
    GRUB_SM712_SR_TV_FREE_RUN_CLOCK = 0x04
  };
enum
  {
    GRUB_SM712_SR_TV_CLOCK_CKIN_NTSC = 0x00,
    GRUB_SM712_SR_TV_CLOCK_REFCLK_PAL = 0x04
  };
enum
  {
    GRUB_SM712_SR_TV_HSYNC = 0x00,
    GRUB_SM712_SR_TV_COMPOSITE_HSYNC = 0x01
  };
enum
  {
    GRUB_SM712_SR_RAM_LUT_NORMAL = 0,
    GRUB_SM712_SR_RAM_LUT_LCD_RAM_OFF = 0x80,
    GRUB_SM712_SR_RAM_LUT_CRT_RAM_OFF = 0x40,
    GRUB_SM712_SR_RAM_LUT_LCD_RAM_NO_WRITE = 0x20,
    GRUB_SM712_SR_RAM_LUT_CRT_RAM_NO_WRITE = 0x10,
    GRUB_SM712_SR_RAM_LUT_CRT_8BIT = 0x08,
    GRUB_SM712_SR_RAM_LUT_CRT_GAMMA = 0x04
  };

enum
  {
    GRUB_SM712_SR_CLOCK_CONTROL1_VCLK_FROM_CCR = 0x40,
    GRUB_SM712_SR_CLOCK_CONTROL1_8DOT_CLOCK = 0x10,
  };

enum
  {
    GRUB_SM712_SR_CLOCK_CONTROL2_PROGRAM_VCLOCK = 0x03
  };

#define GRUB_SM712_SR_POPUP_ICON_HIGH_MASK 0x7
#define GRUB_SM712_SR_POPUP_ICON_HIGH_HW_CURSOR_EN 0x80
  enum
  {
    GRUB_SM712_SR_POPUP_ICON_CTRL_DISABLED = 0,
    GRUB_SM712_SR_POPUP_ICON_CTRL_ZOOM_ENABLED = 0x40,
    GRUB_SM712_SR_POPUP_ICON_CTRL_ENABLED = 0x80
  };
#define RGB332_BLACK 0
#define RGB332_WHITE 0xff

  enum
  {
    GRUB_SM712_CR_OVERFLOW_INTERLACE = 0x30,
    GRUB_SM712_CR_INTERLACE_RETRACE = 0x31,
    GRUB_SM712_CR_TV_VDISPLAY_START = 0x32,
    GRUB_SM712_CR_TV_VDISPLAY_END_HIGH = 0x33,
    GRUB_SM712_CR_TV_VDISPLAY_END_LOW = 0x34,
    GRUB_SM712_CR_DDA_CONTROL_LOW = 0x35,
    GRUB_SM712_CR_DDA_CONTROL_HIGH = 0x36,
    GRUB_SM712_CR_TV_EQUALIZER = 0x38,
    GRUB_SM712_CR_TV_SERRATION = 0x39,
    GRUB_SM712_CR_HSYNC_CTRL = 0x3a,
    GRUB_SM712_CR_DEBUG = 0x3c,
    GRUB_SM712_CR_SHADOW_VGA_HTOTAL = 0x40,
    GRUB_SM712_CR_SHADOW_VGA_HBLANK_START = 0x41,
    GRUB_SM712_CR_SHADOW_VGA_HBLANK_END = 0x42,
    GRUB_SM712_CR_SHADOW_VGA_HRETRACE_START = 0x43,
    GRUB_SM712_CR_SHADOW_VGA_HRETRACE_END = 0x44,
    GRUB_SM712_CR_SHADOW_VGA_VERTICAL_TOTAL = 0x45,
    GRUB_SM712_CR_SHADOW_VGA_VBLANK_START = 0x46,
    GRUB_SM712_CR_SHADOW_VGA_VBLANK_END = 0x47,
    GRUB_SM712_CR_SHADOW_VGA_VRETRACE_START = 0x48,
    GRUB_SM712_CR_SHADOW_VGA_VRETRACE_END = 0x49,    
    GRUB_SM712_CR_SHADOW_VGA_OVERFLOW = 0x4a,
    GRUB_SM712_CR_SHADOW_VGA_CELL_HEIGHT = 0x4b,
    GRUB_SM712_CR_SHADOW_VGA_HDISPLAY_END = 0x4c,
    GRUB_SM712_CR_SHADOW_VGA_VDISPLAY_END = 0x4d,
    GRUB_SM712_CR_DDA_LOOKUP_REG3_START = 0x90,
    GRUB_SM712_CR_DDA_LOOKUP_REG2_START = 0x91,
    GRUB_SM712_CR_DDA_LOOKUP_REG1_START = 0xa0,
    GRUB_SM712_CR_VCENTERING_OFFSET = 0xa6,
    GRUB_SM712_CR_HCENTERING_OFFSET = 0xa7,
  };

#define GRUB_SM712_CR_DEBUG_NONE 0

#define SM712_DDA_REG3_COMPARE_SHIFT 2
#define SM712_DDA_REG3_COMPARE_MASK  0xfc
#define SM712_DDA_REG3_DDA_SHIFT 8
#define SM712_DDA_REG3_DDA_MASK  0x3
#define SM712_DDA_REG2_DDA_MASK  0xff
#define SM712_DDA_REG2_VCENTER_MASK 0x3f

static struct
{
  grub_uint8_t compare;
  grub_uint16_t dda;
  grub_uint8_t vcentering;
} dda_lookups[] = {
  { 21, 469,  2},
  { 23, 477,  2},
  { 33, 535,  2},
  { 35, 682, 21},
  { 34, 675,  2},
  { 55, 683,  6},
};

static struct
{
  struct grub_video_mode_info mode_info;
  struct grub_video_render_target *render_target;

  grub_uint8_t *ptr;
  int mapped;
  grub_uint32_t base;
  grub_pci_device_t dev;
} framebuffer;

#ifndef TEST
static grub_err_t
grub_video_sm712_video_init (void)
{
  /* Reset frame buffer.  */
  grub_memset (&framebuffer, 0, sizeof(framebuffer));

  return grub_video_fb_init ();
}

static grub_err_t
grub_video_sm712_video_fini (void)
{
  if (framebuffer.mapped)
    grub_pci_device_unmap_range (framebuffer.dev, framebuffer.ptr,
				 GRUB_SM712_TOTAL_MEMORY_SPACE);

  return grub_video_fb_fini ();
}
#endif

static inline void
grub_sm712_write_reg (grub_uint8_t val, grub_uint16_t addr)
{
#ifdef TEST
  printf ("  {1, 0x%x, 0x%x},\n", addr, val);
#else
   *(volatile grub_uint8_t *) (framebuffer.ptr + GRUB_SM712_REG_BASE
			       + addr) = val;
#endif
}

static inline grub_uint8_t
grub_sm712_read_reg (grub_uint16_t addr)
{
#ifdef TEST
  printf ("  {-1, 0x%x, 0x5},\n", addr);
#else
  return *(volatile grub_uint8_t *) (framebuffer.ptr + GRUB_SM712_REG_BASE
				     + addr);
#endif
}

static inline grub_uint8_t
grub_sm712_sr_read (grub_uint8_t addr)
{
  grub_sm712_write_reg (addr, GRUB_VGA_IO_SR_INDEX);
  return grub_sm712_read_reg (GRUB_VGA_IO_SR_DATA);
}

static inline void
grub_sm712_sr_write (grub_uint8_t val, grub_uint8_t addr)
{
  grub_sm712_write_reg (addr, GRUB_VGA_IO_SR_INDEX);
  grub_sm712_write_reg (val, GRUB_VGA_IO_SR_DATA);
}

static inline void
grub_sm712_gr_write (grub_uint8_t val, grub_uint8_t addr)
{
  grub_sm712_write_reg (addr, GRUB_VGA_IO_GR_INDEX);
  grub_sm712_write_reg (val, GRUB_VGA_IO_GR_DATA);
}

static inline void
grub_sm712_cr_write (grub_uint8_t val, grub_uint8_t addr)
{
  grub_sm712_write_reg (addr, GRUB_VGA_IO_CR_INDEX);
  grub_sm712_write_reg (val, GRUB_VGA_IO_CR_DATA);
}

static inline void
grub_sm712_write_arx (grub_uint8_t val, grub_uint8_t addr)
{
  grub_sm712_read_reg (GRUB_VGA_IO_INPUT_STATUS1_REGISTER);
  grub_sm712_write_reg (addr, GRUB_VGA_IO_ARX);
  grub_sm712_read_reg (GRUB_VGA_IO_ARX_READ);
  grub_sm712_write_reg (val, GRUB_VGA_IO_ARX);
}

static inline void
grub_sm712_cr_shadow_write (grub_uint8_t val, grub_uint8_t addr)
{
  grub_uint8_t mapping[] =
    {
      [GRUB_VGA_CR_HTOTAL] = GRUB_SM712_CR_SHADOW_VGA_HTOTAL,
      [GRUB_VGA_CR_HORIZ_END] = 0xff,
      [GRUB_VGA_CR_HBLANK_START] = GRUB_SM712_CR_SHADOW_VGA_HBLANK_START,
      [GRUB_VGA_CR_HBLANK_END] = GRUB_SM712_CR_SHADOW_VGA_HBLANK_END,
      [GRUB_VGA_CR_HORIZ_SYNC_PULSE_START] = GRUB_SM712_CR_SHADOW_VGA_HRETRACE_START,
      [GRUB_VGA_CR_HORIZ_SYNC_PULSE_END] = GRUB_SM712_CR_SHADOW_VGA_HRETRACE_END,
      [GRUB_VGA_CR_VERT_TOTAL] = GRUB_SM712_CR_SHADOW_VGA_VERTICAL_TOTAL,
      [GRUB_VGA_CR_OVERFLOW] = GRUB_SM712_CR_SHADOW_VGA_OVERFLOW,
      [GRUB_VGA_CR_BYTE_PANNING] = 0xff,
      [GRUB_VGA_CR_CELL_HEIGHT] = GRUB_SM712_CR_SHADOW_VGA_CELL_HEIGHT,
      [GRUB_VGA_CR_CURSOR_START] = 0xff,
      [GRUB_VGA_CR_CURSOR_END] = 0xff,
      [GRUB_VGA_CR_START_ADDR_HIGH_REGISTER] = 0xff,
      [GRUB_VGA_CR_START_ADDR_LOW_REGISTER] = 0xff,
      [GRUB_VGA_CR_CURSOR_ADDR_HIGH] = 0xff,
      [GRUB_VGA_CR_CURSOR_ADDR_LOW] = 0xff,
      [GRUB_VGA_CR_VSYNC_START] = GRUB_SM712_CR_SHADOW_VGA_VRETRACE_START,
      [GRUB_VGA_CR_VSYNC_END] = GRUB_SM712_CR_SHADOW_VGA_VRETRACE_END,
      [GRUB_VGA_CR_VDISPLAY_END] = GRUB_SM712_CR_SHADOW_VGA_VDISPLAY_END,
      [GRUB_VGA_CR_PITCH] = GRUB_SM712_CR_SHADOW_VGA_HDISPLAY_END,
      [GRUB_VGA_CR_UNDERLINE_LOCATION] = 0xff,

      [GRUB_VGA_CR_VERTICAL_BLANK_START] = GRUB_SM712_CR_SHADOW_VGA_VBLANK_START,
      [GRUB_VGA_CR_VERTICAL_BLANK_END] = GRUB_SM712_CR_SHADOW_VGA_VBLANK_END,
      [GRUB_VGA_CR_MODE] = 0xff,
      [GRUB_VGA_CR_LINE_COMPARE] = 0xff
    };
  if (addr >= ARRAY_SIZE (mapping) || mapping[addr] == 0xff)
    return;
  grub_sm712_cr_write (val, mapping[addr]);
}

static inline void
grub_sm712_write_dda_lookup (int idx, grub_uint8_t compare, grub_uint16_t dda,
			     grub_uint8_t vcentering)
{
  grub_sm712_cr_write (((compare << SM712_DDA_REG3_COMPARE_SHIFT)
			& SM712_DDA_REG3_COMPARE_MASK)
		       | ((dda >> SM712_DDA_REG3_DDA_SHIFT)
			  & SM712_DDA_REG3_DDA_MASK),
		       GRUB_SM712_CR_DDA_LOOKUP_REG3_START + 2 * idx);
  grub_sm712_cr_write (dda & SM712_DDA_REG2_DDA_MASK,
		       GRUB_SM712_CR_DDA_LOOKUP_REG2_START + 2 * idx);
  grub_sm712_cr_write (vcentering & SM712_DDA_REG2_VCENTER_MASK,
		       GRUB_SM712_CR_DDA_LOOKUP_REG1_START + idx);
}

static grub_err_t
grub_video_sm712_setup (unsigned int width, unsigned int height,
			unsigned int mode_type, unsigned int mode_mask __attribute__ ((unused)))
{
  int depth;
  grub_err_t err;
  int found = 0;
  unsigned i;

#ifndef TEST
  auto int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)));
  int NESTED_FUNC_ATTR find_card (grub_pci_device_t dev, grub_pci_id_t pciid __attribute__ ((unused)))
    {
      grub_pci_address_t addr;
      grub_uint32_t class;

      addr = grub_pci_make_address (dev, GRUB_PCI_REG_CLASS);
      class = grub_pci_read (addr);

      if (((class >> 16) & 0xffff) != GRUB_PCI_CLASS_SUBCLASS_VGA
	  || pciid != GRUB_SM712_PCIID)
	return 0;
      
      found = 1;

      addr = grub_pci_make_address (dev, GRUB_PCI_REG_ADDRESS_REG0);
      framebuffer.base = grub_pci_read (addr);
      framebuffer.dev = dev;

      return 1;
    }

  /* Decode depth from mode_type.  If it is zero, then autodetect.  */
  depth = (mode_type & GRUB_VIDEO_MODE_TYPE_DEPTH_MASK)
          >> GRUB_VIDEO_MODE_TYPE_DEPTH_POS;

  if ((width != 1024 && width != 0) || (height != 600 && height != 0)
      || (depth != 16 && depth != 0))
    return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
		       "Only 1024x600x16 is supported");

  grub_pci_iterate (find_card);
  if (!found)
    return grub_error (GRUB_ERR_IO, "Couldn't find graphics card");
#endif
  /* Fill mode info details.  */
  framebuffer.mode_info.width = 1024;
  framebuffer.mode_info.height = 600;
  framebuffer.mode_info.mode_type = GRUB_VIDEO_MODE_TYPE_RGB;
  framebuffer.mode_info.bpp = 16;
  framebuffer.mode_info.bytes_per_pixel = 2;
  framebuffer.mode_info.pitch = 1024 * 2;
  framebuffer.mode_info.number_of_colors = 256;
  framebuffer.mode_info.red_mask_size = 5;
  framebuffer.mode_info.red_field_pos = 11;
  framebuffer.mode_info.green_mask_size = 6;
  framebuffer.mode_info.green_field_pos = 5;
  framebuffer.mode_info.blue_mask_size = 5;
  framebuffer.mode_info.blue_field_pos = 0;
  framebuffer.mode_info.reserved_mask_size = 0;
  framebuffer.mode_info.reserved_field_pos = 0;
#ifndef TEST
  framebuffer.mode_info.blit_format
    = grub_video_get_blit_format (&framebuffer.mode_info);
#endif

#ifndef TEST
  if (found && framebuffer.base == 0)
    {
      grub_pci_address_t addr;
      /* FIXME: choose address dynamically if needed.   */
      framebuffer.base = 0x04000000;

      addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_ADDRESS_REG0);
      grub_pci_write (addr, framebuffer.base);

      /* Set latency.  */
      addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_CACHELINE);
      grub_pci_write (addr, 0x8);

      /* Enable address spaces.  */
      addr = grub_pci_make_address (framebuffer.dev, GRUB_PCI_REG_COMMAND);
      grub_pci_write (addr, 0x7);
    }
#endif

  /* We can safely discard volatile attribute.  */
#ifndef TEST
  framebuffer.ptr
    = (void *) grub_pci_device_map_range (framebuffer.dev,
					  framebuffer.base,
					  GRUB_SM712_TOTAL_MEMORY_SPACE);
#endif
  framebuffer.mapped = 1;

  /* Initialise SM712.  */
#ifndef TEST
  /* FIXME */
  grub_vga_sr_write (0x11, 0x18);
#endif

#ifndef TEST
  /* Prevent garbage from appearing on the screen.  */
  grub_memset (framebuffer.ptr, 0, 
	       framebuffer.mode_info.height * framebuffer.mode_info.pitch);
#endif

  /* FIXME */
  grub_sm712_sr_write (0, 0x21);
  grub_sm712_sr_write (0x7a, 0x62);
  grub_sm712_sr_write (0x16, 0x6a);
  grub_sm712_sr_write (0x2, 0x6b);
  grub_sm712_write_reg (0, GRUB_VGA_IO_PIXEL_MASK);
  grub_sm712_sr_write (GRUB_VGA_SR_RESET_ASYNC, GRUB_VGA_SR_RESET);
  grub_sm712_write_reg (GRUB_VGA_IO_MISC_NEGATIVE_VERT_POLARITY 
			| GRUB_VGA_IO_MISC_NEGATIVE_HORIZ_POLARITY
			| GRUB_VGA_IO_MISC_UPPER_64K
			| GRUB_VGA_IO_MISC_EXTERNAL_CLOCK_0
			| GRUB_VGA_IO_MISC_ENABLE_VRAM_ACCESS
			| GRUB_VGA_IO_MISC_COLOR, GRUB_VGA_IO_MISC_WRITE);
  grub_sm712_sr_write (GRUB_VGA_SR_RESET_ASYNC | GRUB_VGA_SR_RESET_SYNC,
		       GRUB_VGA_SR_RESET);
  grub_sm712_sr_write (GRUB_VGA_SR_CLOCKING_MODE_8_DOT_CLOCK,
		       GRUB_VGA_SR_CLOCKING_MODE);
  grub_sm712_sr_write (GRUB_VGA_ALL_PLANES, GRUB_VGA_SR_MAP_MASK_REGISTER);
  grub_sm712_sr_write (0, GRUB_VGA_SR_CHAR_MAP_SELECT);
  grub_sm712_sr_write (GRUB_VGA_SR_MEMORY_MODE_CHAIN4
		       | GRUB_VGA_SR_MEMORY_MODE_SEQUENTIAL_ADDRESSING
		       | GRUB_VGA_SR_MEMORY_MODE_EXTERNAL_VIDEO_MEMORY,
		       GRUB_VGA_SR_MEMORY_MODE);

  for (i = 0; i < ARRAY_SIZE (sm712_sr_seq1); i++)
    grub_sm712_sr_write (sm712_sr_seq1[i], 0x10 + i);

  for (i = 0; i < ARRAY_SIZE (sm712_sr_seq2); i++)
    grub_sm712_sr_write (sm712_sr_seq2[i], 0x30 + i);

  /* Undocumented.  */
  grub_sm712_sr_write (0x1a, 0x63);
  /* Undocumented.  */
  grub_sm712_sr_write (0x1a, 0x64);

  grub_sm712_sr_write (GRUB_SM712_SR_TV_CRT_SRAM | GRUB_SM712_SR_TV_ALT_CLOCK
		       | GRUB_SM712_SR_TV_CLOCK_CKIN_NTSC
		       | GRUB_SM712_SR_TV_HSYNC,
		       GRUB_SM712_SR_TV_CONTROL);

  grub_sm712_sr_write (GRUB_SM712_SR_RAM_LUT_NORMAL, GRUB_SM712_SR_RAM_LUT);

  /* Undocumented.  */
  grub_sm712_sr_write (0x00, 0x67);

  grub_sm712_sr_write (GRUB_SM712_SR_CLOCK_CONTROL1_VCLK_FROM_CCR
		       | GRUB_SM712_SR_CLOCK_CONTROL1_8DOT_CLOCK,
		       GRUB_SM712_SR_CLOCK_CONTROL1);
  grub_sm712_sr_write (GRUB_SM712_SR_CLOCK_CONTROL2_PROGRAM_VCLOCK,
		       GRUB_SM712_SR_CLOCK_CONTROL2);

  grub_sm712_sr_write (82, GRUB_SM712_SR_VCLK_NUM);
  grub_sm712_sr_write (137, GRUB_SM712_SR_VCLK_DENOM);

  grub_sm712_sr_write (9, GRUB_SM712_SR_VCLK2_NUM);
  grub_sm712_sr_write (2, GRUB_SM712_SR_VCLK2_DENOM);
  /* FIXME */
  grub_sm712_sr_write (0x04, 0x70);
  /* FIXME */
  grub_sm712_sr_write (0x45, 0x71);
  /* Undocumented */
  grub_sm712_sr_write (0x30, 0x72);
  /* Undocumented */
  grub_sm712_sr_write (0x30, 0x73);
  /* Undocumented */
  grub_sm712_sr_write (0x40, 0x74);
  /* Undocumented */
  grub_sm712_sr_write (0x20, 0x75);

  grub_sm712_sr_write (0xff, GRUB_SM712_SR_POPUP_ICON_LOW);
  grub_sm712_sr_write (GRUB_SM712_SR_POPUP_ICON_HIGH_MASK,
		       GRUB_SM712_SR_POPUP_ICON_HIGH);
  grub_sm712_sr_write (GRUB_SM712_SR_POPUP_ICON_CTRL_DISABLED,
		       GRUB_SM712_SR_POPUP_ICON_CTRL);
  /* Undocumented */
  grub_sm712_sr_write (0x0, 0x83);

  grub_sm712_sr_write (8, GRUB_SM712_SR_POPUP_ICON_COLOR1);
  grub_sm712_sr_write (0, GRUB_SM712_SR_POPUP_ICON_COLOR2);
  grub_sm712_sr_write (0x42, GRUB_SM712_SR_POPUP_ICON_COLOR3);

  /* Undocumented */
  grub_sm712_sr_write (0x3a, 0x87);

  /* Why theese coordinates?  */
  grub_sm712_sr_write (0x59, GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_X_LOW);
  grub_sm712_sr_write (0x02, GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_X_HIGH);
  grub_sm712_sr_write (0x44, GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_Y_LOW);
  grub_sm712_sr_write (0x02, GRUB_SM712_SR_HW_CURSOR_UPPER_LEFT_Y_HIGH);

  grub_sm712_sr_write (RGB332_BLACK, GRUB_SM712_SR_HW_CURSOR_FG_COLOR);
  grub_sm712_sr_write (RGB332_WHITE, GRUB_SM712_SR_HW_CURSOR_BG_COLOR);

  /* Undocumented */
  grub_sm712_sr_write (0x3a, 0x8e);
  grub_sm712_sr_write (0x3a, 0x8f);

  grub_sm712_sr_write (0, GRUB_SM712_SR_POPUP_ICON_X_LOW);
  grub_sm712_sr_write (0, GRUB_SM712_SR_POPUP_ICON_X_HIGH);
  grub_sm712_sr_write (0, GRUB_SM712_SR_POPUP_ICON_Y_LOW);
  grub_sm712_sr_write (0, GRUB_SM712_SR_POPUP_ICON_Y_HIGH);

  grub_sm712_sr_write (0, GRUB_SM712_SR_PANEL_HW_VIDEO_CONTROL);
  grub_sm712_sr_write (0x10, GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_LOW);
  grub_sm712_sr_write (0x08, GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_HIGH);
  grub_sm712_sr_write (0x00, GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_MASK_LOW);
  grub_sm712_sr_write (0x02, GRUB_SM712_SR_PANEL_HW_VIDEO_COLOR_KEY_MASK_HIGH);
  grub_sm712_sr_write (0xed, GRUB_SM712_SR_PANEL_HW_VIDEO_RED_CONSTANT);
  grub_sm712_sr_write (0xed, GRUB_SM712_SR_PANEL_HW_VIDEO_GREEN_CONSTANT);
  grub_sm712_sr_write (0xed, GRUB_SM712_SR_PANEL_HW_VIDEO_BLUE_CONSTANT);

  grub_sm712_sr_write (0x7b, GRUB_SM712_SR_PANEL_HW_VIDEO_TOP_BOUNDARY);
  grub_sm712_sr_write (0xfb, GRUB_SM712_SR_PANEL_HW_VIDEO_LEFT_BOUNDARY);
  grub_sm712_sr_write (0xff, GRUB_SM712_SR_PANEL_HW_VIDEO_BOTTOM_BOUNDARY);
  grub_sm712_sr_write (0xff, GRUB_SM712_SR_PANEL_HW_VIDEO_RIGHT_BOUNDARY);
  /* Doesn't match documentation?  */
  grub_sm712_sr_write (0x97, GRUB_SM712_SR_PANEL_HW_VIDEO_TOP_LEFT_OVERFLOW_BOUNDARY);
  grub_sm712_sr_write (0xef, GRUB_SM712_SR_PANEL_HW_VIDEO_BOTTOM_RIGHT_OVERFLOW_BOUNDARY);

  grub_sm712_sr_write (0xbf, GRUB_SM712_SR_PANEL_HW_VIDEO_VERTICAL_STRETCH_FACTOR);
  grub_sm712_sr_write (0xdf, GRUB_SM712_SR_PANEL_HW_VIDEO_HORIZONTAL_STRETCH_FACTOR);

  grub_sm712_gr_write (GRUB_VGA_NO_PLANES, GRUB_VGA_GR_SET_RESET_PLANE);
  grub_sm712_gr_write (GRUB_VGA_NO_PLANES, GRUB_VGA_GR_SET_RESET_PLANE_ENABLE);
  grub_sm712_gr_write (GRUB_VGA_NO_PLANES, GRUB_VGA_GR_COLOR_COMPARE);
  grub_sm712_gr_write (GRUB_VGA_GR_DATA_ROTATE_NOP, GRUB_VGA_GR_DATA_ROTATE);
  grub_sm712_gr_write (GRUB_VGA_NO_PLANES, GRUB_VGA_GR_READ_MAP_REGISTER);
  grub_sm712_gr_write (GRUB_VGA_GR_MODE_256_COLOR, GRUB_VGA_GR_MODE);
  grub_sm712_gr_write (GRUB_VGA_GR_GR6_MMAP_A0
		       | GRUB_VGA_GR_GR6_GRAPHICS_MODE, GRUB_VGA_GR_GR6);
  grub_sm712_gr_write (GRUB_VGA_ALL_PLANES, GRUB_VGA_GR_COLOR_COMPARE_DISABLE);
  grub_sm712_gr_write (0xff, GRUB_VGA_GR_BITMASK);

  /* Write palette mapping.  */
  for (i = 0; i < 16; i++)
    grub_sm712_write_arx (i, i);

  grub_sm712_write_arx (GRUB_VGA_ARX_MODE_ENABLE_256COLOR
			| GRUB_VGA_ARX_MODE_GRAPHICS, GRUB_VGA_ARX_MODE);
  grub_sm712_write_arx (0, GRUB_VGA_ARX_OVERSCAN);
  grub_sm712_write_arx (GRUB_VGA_ALL_PLANES, GRUB_VGA_ARX_COLOR_PLANE_ENABLE);
  grub_sm712_write_arx (0, GRUB_VGA_ARX_HORIZONTAL_PANNING);
  grub_sm712_write_arx (0, GRUB_VGA_ARX_COLOR_SELECT);

  /* FIXME: compute this generically.  */
  {
    struct grub_video_hw_config config =
      {
	.vertical_total = 806,
	.vertical_blank_start = 0x300,
	.vertical_blank_end = 0,
	.vertical_sync_start = 0x303,
	.vertical_sync_end = 0x9,
	.line_compare = 0x3ff,
	.vdisplay_end = 0x300,
	.pitch = 0x80,
	.horizontal_total = 164,
	.horizontal_end = 128,
	.horizontal_blank_start = 128,
	.horizontal_blank_end = 0,
	.horizontal_sync_pulse_start = 133,
	.horizontal_sync_pulse_end = 22
      };
    grub_vga_set_geometry (&config, grub_sm712_cr_write);
    config.horizontal_sync_pulse_start = 134;
    config.horizontal_sync_pulse_end = 21;
    config.vertical_sync_start = 0x301;
    config.vertical_sync_end = 0x0;
    config.line_compare = 0x0ff;
    config.vdisplay_end = 0x258;
    config.pitch = 0x7f;
    grub_vga_set_geometry (&config, grub_sm712_cr_shadow_write);
  }

  grub_sm712_cr_write (GRUB_VGA_CR_BYTE_PANNING_NORMAL,
		       GRUB_VGA_CR_BYTE_PANNING);
  grub_sm712_cr_write (0, GRUB_VGA_CR_CURSOR_START);
  grub_sm712_cr_write (0, GRUB_VGA_CR_CURSOR_END);
  grub_sm712_cr_write (0, GRUB_VGA_CR_START_ADDR_HIGH_REGISTER);
  grub_sm712_cr_write (0, GRUB_VGA_CR_START_ADDR_LOW_REGISTER);
  grub_sm712_cr_write (0, GRUB_VGA_CR_CURSOR_ADDR_HIGH);
  grub_sm712_cr_write (0, GRUB_VGA_CR_CURSOR_ADDR_LOW);
  grub_sm712_cr_write (GRUB_VGA_CR_UNDERLINE_LOCATION_DWORD_MODE,
		       GRUB_VGA_CR_UNDERLINE_LOCATION);
  grub_sm712_cr_write (GRUB_VGA_CR_MODE_ADDRESS_WRAP
		       | GRUB_VGA_CR_MODE_BYTE_MODE
		       | GRUB_VGA_CR_MODE_TIMING_ENABLE
		       | GRUB_VGA_CR_MODE_NO_CGA
		       | GRUB_VGA_CR_MODE_NO_HERCULES,
		       GRUB_VGA_CR_MODE);

  grub_sm712_cr_write (0, GRUB_SM712_CR_OVERFLOW_INTERLACE);
  grub_sm712_cr_write (0, GRUB_SM712_CR_INTERLACE_RETRACE);
  grub_sm712_cr_write (0, GRUB_SM712_CR_TV_VDISPLAY_START);
  grub_sm712_cr_write (0, GRUB_SM712_CR_TV_VDISPLAY_END_HIGH);
  grub_sm712_cr_write (0, GRUB_SM712_CR_TV_VDISPLAY_END_LOW);
  grub_sm712_cr_write (0x80, GRUB_SM712_CR_DDA_CONTROL_LOW);
  grub_sm712_cr_write (0x02, GRUB_SM712_CR_DDA_CONTROL_HIGH);

  /* Undocumented */
  grub_sm712_cr_write (0x20, 0x37);

  grub_sm712_cr_write (0, GRUB_SM712_CR_TV_EQUALIZER);
  grub_sm712_cr_write (0, GRUB_SM712_CR_TV_SERRATION);
  grub_sm712_cr_write (0, GRUB_SM712_CR_HSYNC_CTRL);

  /* Undocumented */
  grub_sm712_cr_write (0x40, 0x3b);

  grub_sm712_cr_write (GRUB_SM712_CR_DEBUG_NONE, GRUB_SM712_CR_DEBUG);

  /* Undocumented */
  grub_sm712_cr_write (0xff, 0x3d);
  grub_sm712_cr_write (0x46, 0x3e);
  grub_sm712_cr_write (0x91, 0x3f);

  for (i = 0; i < ARRAY_SIZE (dda_lookups); i++)
    grub_sm712_write_dda_lookup (i, dda_lookups[i].compare, dda_lookups[i].dda,
				 dda_lookups[i].vcentering);
  
  /* Undocumented  */
  grub_sm712_cr_write (0, 0x9c);
  grub_sm712_cr_write (0, 0x9d);
  grub_sm712_cr_write (0, 0x9e);
  grub_sm712_cr_write (0, 0x9f);

  grub_sm712_cr_write (0, GRUB_SM712_CR_VCENTERING_OFFSET);
  grub_sm712_cr_write (0, GRUB_SM712_CR_HCENTERING_OFFSET);

  grub_sm712_write_reg (GRUB_VGA_IO_MISC_NEGATIVE_HORIZ_POLARITY
			| GRUB_VGA_IO_MISC_UPPER_64K
			| GRUB_VGA_IO_MISC_28MHZ
			| GRUB_VGA_IO_MISC_ENABLE_VRAM_ACCESS
			| GRUB_VGA_IO_MISC_COLOR,
			GRUB_VGA_IO_MISC_WRITE);

#ifndef TEST
  /* Undocumented? */
  *(volatile grub_uint32_t *) ((char *) framebuffer.ptr + 0x40c00c) = 0;
  *(volatile grub_uint32_t *) ((char *) framebuffer.ptr + 0x40c040) = 0;
  *(volatile grub_uint32_t *) ((char *) framebuffer.ptr + 0x40c000) = 0x20000;
  *(volatile grub_uint32_t *) ((char *) framebuffer.ptr + 0x40c010) = 0x1020100;
#endif

  (void) grub_sm712_sr_read (0x16);

#ifndef TEST
  err = grub_video_fb_create_render_target_from_pointer (&framebuffer
							 .render_target,
							 &framebuffer.mode_info,
							 framebuffer.ptr);

  if (err)
    return err;

  err = grub_video_fb_set_active_render_target (framebuffer.render_target);
  
  if (err)
    return err;

  /* Copy default palette to initialize emulated palette.  */
  err = grub_video_fb_set_palette (0, GRUB_VIDEO_FBSTD_NUMCOLORS,
				   grub_video_fbstd_colors);
#endif
  return err;
}

#ifndef TEST

static grub_err_t
grub_video_sm712_swap_buffers (void)
{
  /* TODO: Implement buffer swapping.  */
  return GRUB_ERR_NONE;
}

static grub_err_t
grub_video_sm712_set_active_render_target (struct grub_video_render_target *target)
{
  if (target == GRUB_VIDEO_RENDER_TARGET_DISPLAY)
      target = framebuffer.render_target;

  return grub_video_fb_set_active_render_target (target);
}

static grub_err_t
grub_video_sm712_get_info_and_fini (struct grub_video_mode_info *mode_info,
				    void **framebuf)
{
  grub_memcpy (mode_info, &(framebuffer.mode_info), sizeof (*mode_info));
  *framebuf = (char *) framebuffer.ptr;

  grub_video_fb_fini ();

  return GRUB_ERR_NONE;
}

static struct grub_video_adapter grub_video_sm712_adapter =
  {
    .name = "SM712 Video Driver",
    .id = GRUB_VIDEO_DRIVER_SM712,

    .prio = GRUB_VIDEO_ADAPTER_PRIO_NATIVE,

    .init = grub_video_sm712_video_init,
    .fini = grub_video_sm712_video_fini,
    .setup = grub_video_sm712_setup,
    .get_info = grub_video_fb_get_info,
    .get_info_and_fini = grub_video_sm712_get_info_and_fini,
    .set_palette = grub_video_fb_set_palette,
    .get_palette = grub_video_fb_get_palette,
    .set_viewport = grub_video_fb_set_viewport,
    .get_viewport = grub_video_fb_get_viewport,
    .map_color = grub_video_fb_map_color,
    .map_rgb = grub_video_fb_map_rgb,
    .map_rgba = grub_video_fb_map_rgba,
    .unmap_color = grub_video_fb_unmap_color,
    .fill_rect = grub_video_fb_fill_rect,
    .blit_bitmap = grub_video_fb_blit_bitmap,
    .blit_render_target = grub_video_fb_blit_render_target,
    .scroll = grub_video_fb_scroll,
    .swap_buffers = grub_video_sm712_swap_buffers,
    .create_render_target = grub_video_fb_create_render_target,
    .delete_render_target = grub_video_fb_delete_render_target,
    .set_active_render_target = grub_video_sm712_set_active_render_target,
    .get_active_render_target = grub_video_fb_get_active_render_target,

    .next = 0
  };

GRUB_MOD_INIT(video_sm712)
{
  grub_video_register (&grub_video_sm712_adapter);
}

GRUB_MOD_FINI(video_sm712)
{
  grub_video_unregister (&grub_video_sm712_adapter);
}
#else
int
main ()
{
  grub_video_sm712_setup (1024, 600, 0, 0);
}
#endif