/* Copyright (c) 2003-2005 Advanced Micro Devices, Inc.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to
 * deal in the Software without restriction, including without limitation the
 * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
 * sell copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
 * IN THE SOFTWARE.
 *
 * Neither the name of the Advanced Micro Devices, Inc. nor the names of its
 * contributors may be used to endorse or promote products derived from this
 * software without specific prior written permission.
 * */

/*
 * This file contains routines to set modes using the VGA registers.
 * Since this file is for the first generation graphics unit, it interfaces
 * to SoftVGA registers.  It works for both VSA1 and VSA2.
 * */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <stdlib.h>
#include <string.h>

/* VGA STRUCTURE */

#define GU2_STD_CRTC_REGS 	25
#define GU2_EXT_CRTC_REGS 	15
#define GU2_GDC_REGS 		9
#define GU2_SEQ_REGS		5

#define GU2_VGA_FLAG_MISC_OUTPUT	0x1
#define GU2_VGA_FLAG_STD_CRTC		0x2
#define GU2_VGA_FLAG_EXT_CRTC		0x4
#define GU2_VGA_FLAG_GDC			0x10
#define GU2_VGA_FLAG_SEQ			0x20
#define GU2_VGA_FLAG_PALETTE 		0x40
#define GU2_VGA_FLAG_ATTR 			0x80

static unsigned int GDCregs[10];
static unsigned int SEQregs[10];
static unsigned int palette[256];
static unsigned int ATTRregs[32];
static unsigned char *font_data = NULL;

#define VGA_BLOCK 0x40000       /* 256 k */

void gu2_vga_extcrtc(char offset, int reset);
int gu2_get_vga_active(void);
void gu2_vga_font_data(int flag);
void gu2_set_vga(int reset);
int gu2_vga_seq_blanking(void);
int gu2_vga_attr_ctrl(int reset);
void gu2_vga_to_gfx(void);
void gu2_gfx_to_vga(int vga_mode);
int gu2_vga_seq_reset(int reset);
int gu2_vga_save(gfx_vga_struct * vga, int flags);
void gu2_vga_clear_extended(void);
int gu2_vga_restore(gfx_vga_struct * vga, int flags);

int
gu2_get_vga_active(void)
{
    int data = gfx_read_reg32(MDC_GENERAL_CFG);

    if (data & MDC_GCFG_VGAE)
        return 1;

    return 0;
}

void
gu2_vga_font_data(int flag)
{
    if (flag == 0) {
        if (font_data == NULL) {
            font_data = malloc(VGA_BLOCK);
        }

        DEBUGMSG(1, (0, X_NONE, "Saving VGA Data\n"));
        memcpy(font_data, gfx_virt_fbptr, VGA_BLOCK);
    }
    else if (font_data) {
        DEBUGMSG(1, (0, X_NONE, "Restore VGA Data\n"));
        memcpy(gfx_virt_fbptr, font_data, VGA_BLOCK);
        free(font_data);
        font_data = NULL;
    }
}

void
gu2_set_vga(int reset)
{
    int data = gfx_read_reg32(MDC_GENERAL_CFG);

    if (reset)
        data |= MDC_GCFG_VGAE;
    else
        data &= ~MDC_GCFG_VGAE;

    gfx_write_reg32(MDC_GENERAL_CFG, data);
}

int
gu2_vga_seq_blanking(void)
{
    int tmp;

    gfx_outb(0x3C4, 1);
    tmp = gfx_inb(0x3C5);
    tmp |= 0x20;
    tmp |= tmp << 8;
    gfx_outw(0x3C4, tmp);

    gfx_delay_milliseconds(1);
    return (GFX_STATUS_OK);
}

int
gu2_vga_attr_ctrl(int reset)
{
    int tmp;

    tmp = gfx_inb(0x3DA);
    gfx_outb(0x3C0, (unsigned char) (reset ? 0x00 : 0x20));
    if (reset)
        tmp = gfx_inb(0x3DA);

    return (GFX_STATUS_OK);
}

void
gu2_vga_to_gfx(void)
{
    gu2_vga_attr_ctrl(0);

    gu2_vga_seq_blanking();
    gfx_delay_milliseconds(2);

    gu2_vga_extcrtc(0x3F, 1);
}

void
gu2_gfx_to_vga(int vga_mode)
{
    int tmp;
    char sequencer;

    gu2_vga_extcrtc(0x40, vga_mode);

    /* clear the display blanking bit */
    gfx_outb(MDC_SEQUENCER_INDEX, MDC_SEQUENCER_CLK_MODE);
    sequencer = gfx_inb(MDC_SEQUENCER_DATA);
    sequencer &= ~MDC_CLK_MODE_SCREEN_OFF;
    sequencer |= 1;
    gfx_outb(MDC_SEQUENCER_DATA, sequencer);

    gfx_delay_milliseconds(1);

    /*restart the sequencer */
    gfx_outw(0x3C4, 0x300);

    /* turn on the attribute controler */
    tmp = gfx_inb(0x3DA);
    gfx_outb(0x3C0, 0x20);
    tmp = gfx_inb(0x3DA);

    gu2_vga_extcrtc(0x3F, 0);
}

/*---------------------------------------------------------------------------
 * gfx_vga_seq_reset
 *
 * This routine enables or disables SoftVGA.  It is used to make SoftVGA
 * "be quiet" and not interfere with any of the direct hardware access from
 * Durango.  For VSA1, the sequencer is reset to stop text redraws.  VSA2 may
 * provide a better way to have SoftVGA sit in the background.
 *---------------------------------------------------------------------------
 */
int
gu2_vga_seq_reset(int reset)
{
    gfx_outb(0x3C4, 0);
    gfx_outb(0x3C5, (unsigned char) (reset ? 0x00 : 0x03));
    return (GFX_STATUS_OK);
}

/*---------------------------------------------------------------------------
 * gfx_vga_save
 *
 * This routine saves the state of the VGA registers into the specified
 * structure.  Flags indicate what portions of the register state need to
 * be saved.
 *----------------------------------------------------------------------------
 */
int
gu2_vga_save(gfx_vga_struct * vga, int flags)
{
    int i;
    unsigned short crtcindex, crtcdata;

    crtcindex = (gfx_inb(0x3CC) & 0x01) ? 0x3D4 : 0x3B4;
    crtcdata = crtcindex + 1;

    /* CHECK MISCELLANEOUS OUTPUT FLAG */

    if (flags & GU2_VGA_FLAG_MISC_OUTPUT) {
        /* SAVE MISCCELLANEOUS OUTPUT REGISTER */
        vga->miscOutput = gfx_inb(0x3CC);
    }

    /* CHECK SEQ */

    if (flags & GU2_VGA_FLAG_SEQ) {
        /* SAVE STANDARD CRTC REGISTERS */
        for (i = 1; i < GU2_SEQ_REGS; i++) {
            gfx_outb(0x3C4, (unsigned char) i);
            SEQregs[i] = gfx_inb(0x3C5);
        }
    }

    /* CHECK STANDARD CRTC FLAG */

    if (flags & GU2_VGA_FLAG_STD_CRTC) {
        /* SAVE STANDARD CRTC REGISTERS */
        for (i = 0; i < GU2_STD_CRTC_REGS; i++) {
            gfx_outb(crtcindex, (unsigned char) i);
            vga->stdCRTCregs[i] = gfx_inb(crtcdata);
        }
    }

    /* CHECK GDC */

    if (flags & GU2_VGA_FLAG_GDC) {
        /* SAVE STANDARD CRTC REGISTERS */
        for (i = 0; i < GU2_GDC_REGS; i++) {
            gfx_outb(0x3CE, (unsigned char) i);
            GDCregs[i] = gfx_inb(0x3CF);
        }
    }

    /* CHECK EXTENDED CRTC FLAG */

    if (flags & GU2_VGA_FLAG_EXT_CRTC) {
        /* SAVE EXTENDED CRTC REGISTERS */
        for (i = 0; i < GU2_EXT_CRTC_REGS; i++) {
            gfx_outb(crtcindex, (unsigned char) (0x40 + i));
            vga->extCRTCregs[i] = gfx_inb(crtcdata);
        }
    }

    if (flags & GU2_VGA_FLAG_PALETTE) {
        /* SAVE PALETTE DATA */
        for (i = 0; i < 0x100; i++) {
            gfx_outb(0x3C7, i);
            palette[i] = gfx_inb(0x3C9);
        }
    }

    if (flags & GU2_VGA_FLAG_ATTR) {
        /* SAVE Attribute  DATA */
        for (i = 0; i < 21; i++) {
            gfx_inb(0x3DA);
            gfx_outb(0x3C0, i);
            ATTRregs[i] = gfx_inb(0x3C1);
        }
    }

    /* save the VGA data */
    gu2_vga_font_data(0);
    return (0);
}

/*----------------------------------------------------------------------------
 * gfx_vga_clear_extended
 *
 * This routine clears the extended SoftVGA register values to have SoftVGA
 * behave like standard VGA.
 *----------------------------------------------------------------------------
 */
void
gu2_vga_clear_extended(void)
{
    int i;
    unsigned short crtcindex, crtcdata;

    crtcindex = (gfx_inb(0x3CC) & 0x01) ? 0x3D4 : 0x3B4;
    crtcdata = crtcindex + 1;

    gfx_outb(crtcindex, 0x30);
    gfx_outb(crtcdata, 0x57);
    gfx_outb(crtcdata, 0x4C);
    for (i = 0x41; i <= 0x4F; i++) {
        gfx_outb(crtcindex, (unsigned char) i);
        gfx_outb(crtcdata, 0);
    }

    gfx_outb(crtcindex, 0x30);
    gfx_outb(crtcdata, 0x00);
}

void
gu2_vga_extcrtc(char offset, int reset)
{
    unsigned short crtcindex, crtcdata;

    crtcindex = (gfx_inb(0x3CC) & 0x01) ? 0x3D4 : 0x3B4;
    crtcdata = crtcindex + 1;

    /* UNLOCK EXTENDED CRTC REGISTERS */

    gfx_outb(crtcindex, 0x30);
    gfx_outb(crtcdata, 0x57);
    gfx_outb(crtcdata, 0x4C);

    /* RESTORE EXTENDED CRTC REGISTERS */

    gfx_outb(crtcindex, offset);
    gfx_outb(crtcdata, reset);
}

/*----------------------------------------------------------------------------
 * gfx_vga_restore
 *
 * This routine restores the state of the VGA registers from the specified
 * structure.  Flags indicate what portions of the register state need to
 * be saved.
 *----------------------------------------------------------------------------
 */
int
gu2_vga_restore(gfx_vga_struct * vga, int flags)
{
    int i;
    unsigned short crtcindex, crtcdata;

    crtcindex = (gfx_inb(0x3CC) & 0x01) ? 0x3D4 : 0x3B4;
    crtcdata = crtcindex + 1;

    /* CHECK MISCELLANEOUS OUTPUT FLAG */

    if (flags & GU2_VGA_FLAG_MISC_OUTPUT) {
        /* RESTORE MISCELLANEOUS OUTPUT REGISTER VALUE */
        gfx_outb(0x3C2, vga->miscOutput);
    }

    /* CHECK SEQ */

    if (flags & GU2_VGA_FLAG_SEQ) {
        /* RESTORE STANDARD CRTC REGISTERS */
        for (i = 1; i < GU2_SEQ_REGS; i++) {
            gfx_outb(0x3C4, (unsigned char) i);
            gfx_outb(0x3C5, SEQregs[i]);
        }
    }

    /* CHECK STANDARD CRTC FLAG */

    if (flags & GU2_VGA_FLAG_STD_CRTC) {
        /* UNLOCK STANDARD CRTC REGISTERS */
        gfx_outb(crtcindex, 0x11);
        gfx_outb(crtcdata, 0);

        /* RESTORE STANDARD CRTC REGISTERS */

        for (i = 0; i < GU2_STD_CRTC_REGS; i++) {
            gfx_outb(crtcindex, (unsigned char) i);
            gfx_outb(crtcdata, vga->stdCRTCregs[i]);
        }
    }

    /* CHECK GDC */

    if (flags & GU2_VGA_FLAG_GDC) {
        /* SAVE STANDARD CRTC REGISTERS */
        for (i = 0; i < GU2_GDC_REGS; i++) {
            gfx_outb(0x3CE, (unsigned char) i);
            gfx_outb(0x3CF, GDCregs[i]);
        }
    }

    /* CHECK EXTENDED CRTC FLAG */

    if (flags & GU2_VGA_FLAG_EXT_CRTC) {
        /* UNLOCK EXTENDED CRTC REGISTERS */
        gfx_outb(crtcindex, 0x30);
        gfx_outb(crtcdata, 0x57);
        gfx_outb(crtcdata, 0x4C);

        /* RESTORE EXTENDED CRTC REGISTERS */

        for (i = 1; i < GU2_EXT_CRTC_REGS; i++) {
            gfx_outb(crtcindex, (unsigned char) (0x40 + i));
            gfx_outb(crtcdata, vga->extCRTCregs[i]);
        }

        /* LOCK EXTENDED CRTC REGISTERS */

        gfx_outb(crtcindex, 0x30);
        gfx_outb(crtcdata, 0x00);

        /* CHECK IF DIRECT FRAME BUFFER MODE (VESA MODE) */

        if (vga->extCRTCregs[0x03] & 1) {
            /* SET BORDER COLOR TO BLACK */
            /* This really should be another thing saved/restored, but */
            /* Durango currently doesn't do the attr controller registers. */

            gfx_inb(0x3BA);     /* Reset flip-flop */
            gfx_inb(0x3DA);
            gfx_outb(0x3C0, 0x11);
            gfx_outb(0x3C0, 0x00);
        }
    }

    if (flags & GU2_VGA_FLAG_PALETTE) {
        /* RESTORE PALETTE DATA */
        for (i = 0; i < 0x100; i++) {
            gfx_outb(0x3C8, i);
            gfx_outb(0x3C9, palette[i]);
        }
    }

    if (flags & GU2_VGA_FLAG_ATTR) {
        /* RESTORE Attribute  DATA */
        for (i = 0; i < 21; i++) {
            gfx_inb(0x3DA);
            gfx_outb(0x3C0, i);
            gfx_outb(0x3C0, ATTRregs[i]);
        }
        /* SAVE Attribute  DATA */

        for (i = 0; i < 21; i++) {
            gfx_inb(0x3DA);
            gfx_outb(0x3C0, i);
        }
    }

    /* restore the VGA data */
    gu2_vga_font_data(1);

    return (0);
}

/* END OF FILE */