summaryrefslogtreecommitdiffstats
path: root/drivers/video/aty/mach64_gx.c
diff options
context:
space:
mode:
authorTomi Valkeinen <tomi.valkeinen@ti.com>2014-02-13 14:31:38 +0100
committerTomi Valkeinen <tomi.valkeinen@ti.com>2014-04-17 07:10:19 +0200
commitf7018c21350204c4cf628462f229d44d03545254 (patch)
tree408787177164cf51cc06f7aabdb04fcff8d2b6aa /drivers/video/aty/mach64_gx.c
parentvideo: bf54x-lq043fb: fix build error (diff)
downloadlinux-f7018c21350204c4cf628462f229d44d03545254.tar.xz
linux-f7018c21350204c4cf628462f229d44d03545254.zip
video: move fbdev to drivers/video/fbdev
The drivers/video directory is a mess. It contains generic video related files, directories for backlight, console, linux logo, lots of fbdev device drivers, fbdev framework files. Make some order into the chaos by creating drivers/video/fbdev directory, and move all fbdev related files there. No functionality is changed, although I guess it is possible that some subtle Makefile build order related issue could be created by this patch. Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ti.com> Acked-by: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Acked-by: Geert Uytterhoeven <geert@linux-m68k.org> Acked-by: Rob Clark <robdclark@gmail.com> Acked-by: Jingoo Han <jg1.han@samsung.com> Acked-by: Daniel Vetter <daniel.vetter@ffwll.ch>
Diffstat (limited to 'drivers/video/aty/mach64_gx.c')
-rw-r--r--drivers/video/aty/mach64_gx.c910
1 files changed, 0 insertions, 910 deletions
diff --git a/drivers/video/aty/mach64_gx.c b/drivers/video/aty/mach64_gx.c
deleted file mode 100644
index 10c988aef58e..000000000000
--- a/drivers/video/aty/mach64_gx.c
+++ /dev/null
@@ -1,910 +0,0 @@
-
-/*
- * ATI Mach64 GX Support
- */
-
-#include <linux/delay.h>
-#include <linux/fb.h>
-
-#include <asm/io.h>
-
-#include <video/mach64.h>
-#include "atyfb.h"
-
-/* Definitions for the ICS 2595 == ATI 18818_1 Clockchip */
-
-#define REF_FREQ_2595 1432 /* 14.33 MHz (exact 14.31818) */
-#define REF_DIV_2595 46 /* really 43 on ICS 2595 !!! */
- /* ohne Prescaler */
-#define MAX_FREQ_2595 15938 /* 159.38 MHz (really 170.486) */
-#define MIN_FREQ_2595 8000 /* 80.00 MHz ( 85.565) */
- /* mit Prescaler 2, 4, 8 */
-#define ABS_MIN_FREQ_2595 1000 /* 10.00 MHz (really 10.697) */
-#define N_ADJ_2595 257
-
-#define STOP_BITS_2595 0x1800
-
-
-#define MIN_N_408 2
-
-#define MIN_N_1703 6
-
-#define MIN_M 2
-#define MAX_M 30
-#define MIN_N 35
-#define MAX_N 255-8
-
-
- /*
- * Support Functions
- */
-
-static void aty_dac_waste4(const struct atyfb_par *par)
-{
- (void) aty_ld_8(DAC_REGS, par);
-
- (void) aty_ld_8(DAC_REGS + 2, par);
- (void) aty_ld_8(DAC_REGS + 2, par);
- (void) aty_ld_8(DAC_REGS + 2, par);
- (void) aty_ld_8(DAC_REGS + 2, par);
-}
-
-static void aty_StrobeClock(const struct atyfb_par *par)
-{
- u8 tmp;
-
- udelay(26);
-
- tmp = aty_ld_8(CLOCK_CNTL, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, tmp | CLOCK_STROBE, par);
- return;
-}
-
-
- /*
- * IBM RGB514 DAC and Clock Chip
- */
-
-static void aty_st_514(int offset, u8 val, const struct atyfb_par *par)
-{
- aty_st_8(DAC_CNTL, 1, par);
- /* right addr byte */
- aty_st_8(DAC_W_INDEX, offset & 0xff, par);
- /* left addr byte */
- aty_st_8(DAC_DATA, (offset >> 8) & 0xff, par);
- aty_st_8(DAC_MASK, val, par);
- aty_st_8(DAC_CNTL, 0, par);
-}
-
-static int aty_set_dac_514(const struct fb_info *info,
- const union aty_pll *pll, u32 bpp, u32 accel)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- static struct {
- u8 pixel_dly;
- u8 misc2_cntl;
- u8 pixel_rep;
- u8 pixel_cntl_index;
- u8 pixel_cntl_v1;
- } tab[3] = {
- {
- 0, 0x41, 0x03, 0x71, 0x45}, /* 8 bpp */
- {
- 0, 0x45, 0x04, 0x0c, 0x01}, /* 555 */
- {
- 0, 0x45, 0x06, 0x0e, 0x00}, /* XRGB */
- };
- int i;
-
- switch (bpp) {
- case 8:
- default:
- i = 0;
- break;
- case 16:
- i = 1;
- break;
- case 32:
- i = 2;
- break;
- }
- aty_st_514(0x90, 0x00, par); /* VRAM Mask Low */
- aty_st_514(0x04, tab[i].pixel_dly, par); /* Horizontal Sync Control */
- aty_st_514(0x05, 0x00, par); /* Power Management */
- aty_st_514(0x02, 0x01, par); /* Misc Clock Control */
- aty_st_514(0x71, tab[i].misc2_cntl, par); /* Misc Control 2 */
- aty_st_514(0x0a, tab[i].pixel_rep, par); /* Pixel Format */
- aty_st_514(tab[i].pixel_cntl_index, tab[i].pixel_cntl_v1, par);
- /* Misc Control 2 / 16 BPP Control / 32 BPP Control */
- return 0;
-}
-
-static int aty_var_to_pll_514(const struct fb_info *info, u32 vclk_per,
- u32 bpp, union aty_pll *pll)
-{
- /*
- * FIXME: use real calculations instead of using fixed values from the old
- * driver
- */
- static struct {
- u32 limit; /* pixlock rounding limit (arbitrary) */
- u8 m; /* (df<<6) | vco_div_count */
- u8 n; /* ref_div_count */
- } RGB514_clocks[7] = {
- {
- 8000, (3 << 6) | 20, 9}, /* 7395 ps / 135.2273 MHz */
- {
- 10000, (1 << 6) | 19, 3}, /* 9977 ps / 100.2273 MHz */
- {
- 13000, (1 << 6) | 2, 3}, /* 12509 ps / 79.9432 MHz */
- {
- 14000, (2 << 6) | 8, 7}, /* 13394 ps / 74.6591 MHz */
- {
- 16000, (1 << 6) | 44, 6}, /* 15378 ps / 65.0284 MHz */
- {
- 25000, (1 << 6) | 15, 5}, /* 17460 ps / 57.2727 MHz */
- {
- 50000, (0 << 6) | 53, 7}, /* 33145 ps / 30.1705 MHz */
- };
- int i;
-
- for (i = 0; i < ARRAY_SIZE(RGB514_clocks); i++)
- if (vclk_per <= RGB514_clocks[i].limit) {
- pll->ibm514.m = RGB514_clocks[i].m;
- pll->ibm514.n = RGB514_clocks[i].n;
- return 0;
- }
- return -EINVAL;
-}
-
-static u32 aty_pll_514_to_var(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u8 df, vco_div_count, ref_div_count;
-
- df = pll->ibm514.m >> 6;
- vco_div_count = pll->ibm514.m & 0x3f;
- ref_div_count = pll->ibm514.n;
-
- return ((par->ref_clk_per * ref_div_count) << (3 - df))/
- (vco_div_count + 65);
-}
-
-static void aty_set_pll_514(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
-
- aty_st_514(0x06, 0x02, par); /* DAC Operation */
- aty_st_514(0x10, 0x01, par); /* PLL Control 1 */
- aty_st_514(0x70, 0x01, par); /* Misc Control 1 */
- aty_st_514(0x8f, 0x1f, par); /* PLL Ref. Divider Input */
- aty_st_514(0x03, 0x00, par); /* Sync Control */
- aty_st_514(0x05, 0x00, par); /* Power Management */
- aty_st_514(0x20, pll->ibm514.m, par); /* F0 / M0 */
- aty_st_514(0x21, pll->ibm514.n, par); /* F1 / N0 */
-}
-
-const struct aty_dac_ops aty_dac_ibm514 = {
- .set_dac = aty_set_dac_514,
-};
-
-const struct aty_pll_ops aty_pll_ibm514 = {
- .var_to_pll = aty_var_to_pll_514,
- .pll_to_var = aty_pll_514_to_var,
- .set_pll = aty_set_pll_514,
-};
-
-
- /*
- * ATI 68860-B DAC
- */
-
-static int aty_set_dac_ATI68860_B(const struct fb_info *info,
- const union aty_pll *pll, u32 bpp,
- u32 accel)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 gModeReg, devSetupRegA, temp, mask;
-
- gModeReg = 0;
- devSetupRegA = 0;
-
- switch (bpp) {
- case 8:
- gModeReg = 0x83;
- devSetupRegA =
- 0x60 | 0x00 /*(info->mach64DAC8Bit ? 0x00 : 0x01) */ ;
- break;
- case 15:
- gModeReg = 0xA0;
- devSetupRegA = 0x60;
- break;
- case 16:
- gModeReg = 0xA1;
- devSetupRegA = 0x60;
- break;
- case 24:
- gModeReg = 0xC0;
- devSetupRegA = 0x60;
- break;
- case 32:
- gModeReg = 0xE3;
- devSetupRegA = 0x60;
- break;
- }
-
- if (!accel) {
- gModeReg = 0x80;
- devSetupRegA = 0x61;
- }
-
- temp = aty_ld_8(DAC_CNTL, par);
- aty_st_8(DAC_CNTL, (temp & ~DAC_EXT_SEL_RS2) | DAC_EXT_SEL_RS3,
- par);
-
- aty_st_8(DAC_REGS + 2, 0x1D, par);
- aty_st_8(DAC_REGS + 3, gModeReg, par);
- aty_st_8(DAC_REGS, 0x02, par);
-
- temp = aty_ld_8(DAC_CNTL, par);
- aty_st_8(DAC_CNTL, temp | DAC_EXT_SEL_RS2 | DAC_EXT_SEL_RS3, par);
-
- if (info->fix.smem_len < ONE_MB)
- mask = 0x04;
- else if (info->fix.smem_len == ONE_MB)
- mask = 0x08;
- else
- mask = 0x0C;
-
- /* The following assumes that the BIOS has correctly set R7 of the
- * Device Setup Register A at boot time.
- */
-#define A860_DELAY_L 0x80
-
- temp = aty_ld_8(DAC_REGS, par);
- aty_st_8(DAC_REGS, (devSetupRegA | mask) | (temp & A860_DELAY_L),
- par);
- temp = aty_ld_8(DAC_CNTL, par);
- aty_st_8(DAC_CNTL, (temp & ~(DAC_EXT_SEL_RS2 | DAC_EXT_SEL_RS3)),
- par);
-
- aty_st_le32(BUS_CNTL, 0x890e20f1, par);
- aty_st_le32(DAC_CNTL, 0x47052100, par);
- return 0;
-}
-
-const struct aty_dac_ops aty_dac_ati68860b = {
- .set_dac = aty_set_dac_ATI68860_B,
-};
-
-
- /*
- * AT&T 21C498 DAC
- */
-
-static int aty_set_dac_ATT21C498(const struct fb_info *info,
- const union aty_pll *pll, u32 bpp,
- u32 accel)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 dotClock;
- int muxmode = 0;
- int DACMask = 0;
-
- dotClock = 100000000 / pll->ics2595.period_in_ps;
-
- switch (bpp) {
- case 8:
- if (dotClock > 8000) {
- DACMask = 0x24;
- muxmode = 1;
- } else
- DACMask = 0x04;
- break;
- case 15:
- DACMask = 0x16;
- break;
- case 16:
- DACMask = 0x36;
- break;
- case 24:
- DACMask = 0xE6;
- break;
- case 32:
- DACMask = 0xE6;
- break;
- }
-
- if (1 /* info->mach64DAC8Bit */ )
- DACMask |= 0x02;
-
- aty_dac_waste4(par);
- aty_st_8(DAC_REGS + 2, DACMask, par);
-
- aty_st_le32(BUS_CNTL, 0x890e20f1, par);
- aty_st_le32(DAC_CNTL, 0x00072000, par);
- return muxmode;
-}
-
-const struct aty_dac_ops aty_dac_att21c498 = {
- .set_dac = aty_set_dac_ATT21C498,
-};
-
-
- /*
- * ATI 18818 / ICS 2595 Clock Chip
- */
-
-static int aty_var_to_pll_18818(const struct fb_info *info, u32 vclk_per,
- u32 bpp, union aty_pll *pll)
-{
- u32 MHz100; /* in 0.01 MHz */
- u32 program_bits;
- u32 post_divider;
-
- /* Calculate the programming word */
- MHz100 = 100000000 / vclk_per;
-
- program_bits = -1;
- post_divider = 1;
-
- if (MHz100 > MAX_FREQ_2595) {
- MHz100 = MAX_FREQ_2595;
- return -EINVAL;
- } else if (MHz100 < ABS_MIN_FREQ_2595) {
- program_bits = 0; /* MHz100 = 257 */
- return -EINVAL;
- } else {
- while (MHz100 < MIN_FREQ_2595) {
- MHz100 *= 2;
- post_divider *= 2;
- }
- }
- MHz100 *= 1000;
- MHz100 = (REF_DIV_2595 * MHz100) / REF_FREQ_2595;
-
- MHz100 += 500; /* + 0.5 round */
- MHz100 /= 1000;
-
- if (program_bits == -1) {
- program_bits = MHz100 - N_ADJ_2595;
- switch (post_divider) {
- case 1:
- program_bits |= 0x0600;
- break;
- case 2:
- program_bits |= 0x0400;
- break;
- case 4:
- program_bits |= 0x0200;
- break;
- case 8:
- default:
- break;
- }
- }
-
- program_bits |= STOP_BITS_2595;
-
- pll->ics2595.program_bits = program_bits;
- pll->ics2595.locationAddr = 0;
- pll->ics2595.post_divider = post_divider;
- pll->ics2595.period_in_ps = vclk_per;
-
- return 0;
-}
-
-static u32 aty_pll_18818_to_var(const struct fb_info *info,
- const union aty_pll *pll)
-{
- return (pll->ics2595.period_in_ps); /* default for now */
-}
-
-static void aty_ICS2595_put1bit(u8 data, const struct atyfb_par *par)
-{
- u8 tmp;
-
- data &= 0x01;
- tmp = aty_ld_8(CLOCK_CNTL, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset,
- (tmp & ~0x04) | (data << 2), par);
-
- tmp = aty_ld_8(CLOCK_CNTL, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, (tmp & ~0x08) | (0 << 3),
- par);
-
- aty_StrobeClock(par);
-
- tmp = aty_ld_8(CLOCK_CNTL, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, (tmp & ~0x08) | (1 << 3),
- par);
-
- aty_StrobeClock(par);
- return;
-}
-
-static void aty_set_pll18818(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 program_bits;
- u32 locationAddr;
-
- u32 i;
-
- u8 old_clock_cntl;
- u8 old_crtc_ext_disp;
-
- old_clock_cntl = aty_ld_8(CLOCK_CNTL, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, 0, par);
-
- old_crtc_ext_disp = aty_ld_8(CRTC_GEN_CNTL + 3, par);
- aty_st_8(CRTC_GEN_CNTL + 3,
- old_crtc_ext_disp | (CRTC_EXT_DISP_EN >> 24), par);
-
- mdelay(15); /* delay for 50 (15) ms */
-
- program_bits = pll->ics2595.program_bits;
- locationAddr = pll->ics2595.locationAddr;
-
- /* Program the clock chip */
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, 0, par); /* Strobe = 0 */
- aty_StrobeClock(par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset, 1, par); /* Strobe = 0 */
- aty_StrobeClock(par);
-
- aty_ICS2595_put1bit(1, par); /* Send start bits */
- aty_ICS2595_put1bit(0, par); /* Start bit */
- aty_ICS2595_put1bit(0, par); /* Read / ~Write */
-
- for (i = 0; i < 5; i++) { /* Location 0..4 */
- aty_ICS2595_put1bit(locationAddr & 1, par);
- locationAddr >>= 1;
- }
-
- for (i = 0; i < 8 + 1 + 2 + 2; i++) {
- aty_ICS2595_put1bit(program_bits & 1, par);
- program_bits >>= 1;
- }
-
- mdelay(1); /* delay for 1 ms */
-
- (void) aty_ld_8(DAC_REGS, par); /* Clear DAC Counter */
- aty_st_8(CRTC_GEN_CNTL + 3, old_crtc_ext_disp, par);
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset,
- old_clock_cntl | CLOCK_STROBE, par);
-
- mdelay(50); /* delay for 50 (15) ms */
- aty_st_8(CLOCK_CNTL + par->clk_wr_offset,
- ((pll->ics2595.locationAddr & 0x0F) | CLOCK_STROBE), par);
- return;
-}
-
-const struct aty_pll_ops aty_pll_ati18818_1 = {
- .var_to_pll = aty_var_to_pll_18818,
- .pll_to_var = aty_pll_18818_to_var,
- .set_pll = aty_set_pll18818,
-};
-
-
- /*
- * STG 1703 Clock Chip
- */
-
-static int aty_var_to_pll_1703(const struct fb_info *info, u32 vclk_per,
- u32 bpp, union aty_pll *pll)
-{
- u32 mhz100; /* in 0.01 MHz */
- u32 program_bits;
- /* u32 post_divider; */
- u32 mach64MinFreq, mach64MaxFreq, mach64RefFreq;
- u32 temp, tempB;
- u16 remainder, preRemainder;
- short divider = 0, tempA;
-
- /* Calculate the programming word */
- mhz100 = 100000000 / vclk_per;
- mach64MinFreq = MIN_FREQ_2595;
- mach64MaxFreq = MAX_FREQ_2595;
- mach64RefFreq = REF_FREQ_2595; /* 14.32 MHz */
-
- /* Calculate program word */
- if (mhz100 == 0)
- program_bits = 0xE0;
- else {
- if (mhz100 < mach64MinFreq)
- mhz100 = mach64MinFreq;
- if (mhz100 > mach64MaxFreq)
- mhz100 = mach64MaxFreq;
-
- divider = 0;
- while (mhz100 < (mach64MinFreq << 3)) {
- mhz100 <<= 1;
- divider += 0x20;
- }
-
- temp = (unsigned int) (mhz100);
- temp = (unsigned int) (temp * (MIN_N_1703 + 2));
- temp -= (short) (mach64RefFreq << 1);
-
- tempA = MIN_N_1703;
- preRemainder = 0xffff;
-
- do {
- tempB = temp;
- remainder = tempB % mach64RefFreq;
- tempB = tempB / mach64RefFreq;
-
- if ((tempB & 0xffff) <= 127
- && (remainder <= preRemainder)) {
- preRemainder = remainder;
- divider &= ~0x1f;
- divider |= tempA;
- divider =
- (divider & 0x00ff) +
- ((tempB & 0xff) << 8);
- }
-
- temp += mhz100;
- tempA++;
- } while (tempA <= (MIN_N_1703 << 1));
-
- program_bits = divider;
- }
-
- pll->ics2595.program_bits = program_bits;
- pll->ics2595.locationAddr = 0;
- pll->ics2595.post_divider = divider; /* fuer nix */
- pll->ics2595.period_in_ps = vclk_per;
-
- return 0;
-}
-
-static u32 aty_pll_1703_to_var(const struct fb_info *info,
- const union aty_pll *pll)
-{
- return (pll->ics2595.period_in_ps); /* default for now */
-}
-
-static void aty_set_pll_1703(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 program_bits;
- u32 locationAddr;
-
- char old_crtc_ext_disp;
-
- old_crtc_ext_disp = aty_ld_8(CRTC_GEN_CNTL + 3, par);
- aty_st_8(CRTC_GEN_CNTL + 3,
- old_crtc_ext_disp | (CRTC_EXT_DISP_EN >> 24), par);
-
- program_bits = pll->ics2595.program_bits;
- locationAddr = pll->ics2595.locationAddr;
-
- /* Program clock */
- aty_dac_waste4(par);
-
- (void) aty_ld_8(DAC_REGS + 2, par);
- aty_st_8(DAC_REGS + 2, (locationAddr << 1) + 0x20, par);
- aty_st_8(DAC_REGS + 2, 0, par);
- aty_st_8(DAC_REGS + 2, (program_bits & 0xFF00) >> 8, par);
- aty_st_8(DAC_REGS + 2, (program_bits & 0xFF), par);
-
- (void) aty_ld_8(DAC_REGS, par); /* Clear DAC Counter */
- aty_st_8(CRTC_GEN_CNTL + 3, old_crtc_ext_disp, par);
- return;
-}
-
-const struct aty_pll_ops aty_pll_stg1703 = {
- .var_to_pll = aty_var_to_pll_1703,
- .pll_to_var = aty_pll_1703_to_var,
- .set_pll = aty_set_pll_1703,
-};
-
-
- /*
- * Chrontel 8398 Clock Chip
- */
-
-static int aty_var_to_pll_8398(const struct fb_info *info, u32 vclk_per,
- u32 bpp, union aty_pll *pll)
-{
- u32 tempA, tempB, fOut, longMHz100, diff, preDiff;
-
- u32 mhz100; /* in 0.01 MHz */
- u32 program_bits;
- /* u32 post_divider; */
- u32 mach64MinFreq, mach64MaxFreq, mach64RefFreq;
- u16 m, n, k = 0, save_m, save_n, twoToKth;
-
- /* Calculate the programming word */
- mhz100 = 100000000 / vclk_per;
- mach64MinFreq = MIN_FREQ_2595;
- mach64MaxFreq = MAX_FREQ_2595;
- mach64RefFreq = REF_FREQ_2595; /* 14.32 MHz */
-
- save_m = 0;
- save_n = 0;
-
- /* Calculate program word */
- if (mhz100 == 0)
- program_bits = 0xE0;
- else {
- if (mhz100 < mach64MinFreq)
- mhz100 = mach64MinFreq;
- if (mhz100 > mach64MaxFreq)
- mhz100 = mach64MaxFreq;
-
- longMHz100 = mhz100 * 256 / 100; /* 8 bit scale this */
-
- while (mhz100 < (mach64MinFreq << 3)) {
- mhz100 <<= 1;
- k++;
- }
-
- twoToKth = 1 << k;
- diff = 0;
- preDiff = 0xFFFFFFFF;
-
- for (m = MIN_M; m <= MAX_M; m++) {
- for (n = MIN_N; n <= MAX_N; n++) {
- tempA = 938356; /* 14.31818 * 65536 */
- tempA *= (n + 8); /* 43..256 */
- tempB = twoToKth * 256;
- tempB *= (m + 2); /* 4..32 */
- fOut = tempA / tempB; /* 8 bit scale */
-
- if (longMHz100 > fOut)
- diff = longMHz100 - fOut;
- else
- diff = fOut - longMHz100;
-
- if (diff < preDiff) {
- save_m = m;
- save_n = n;
- preDiff = diff;
- }
- }
- }
-
- program_bits = (k << 6) + (save_m) + (save_n << 8);
- }
-
- pll->ics2595.program_bits = program_bits;
- pll->ics2595.locationAddr = 0;
- pll->ics2595.post_divider = 0;
- pll->ics2595.period_in_ps = vclk_per;
-
- return 0;
-}
-
-static u32 aty_pll_8398_to_var(const struct fb_info *info,
- const union aty_pll *pll)
-{
- return (pll->ics2595.period_in_ps); /* default for now */
-}
-
-static void aty_set_pll_8398(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 program_bits;
- u32 locationAddr;
-
- char old_crtc_ext_disp;
- char tmp;
-
- old_crtc_ext_disp = aty_ld_8(CRTC_GEN_CNTL + 3, par);
- aty_st_8(CRTC_GEN_CNTL + 3,
- old_crtc_ext_disp | (CRTC_EXT_DISP_EN >> 24), par);
-
- program_bits = pll->ics2595.program_bits;
- locationAddr = pll->ics2595.locationAddr;
-
- /* Program clock */
- tmp = aty_ld_8(DAC_CNTL, par);
- aty_st_8(DAC_CNTL, tmp | DAC_EXT_SEL_RS2 | DAC_EXT_SEL_RS3, par);
-
- aty_st_8(DAC_REGS, locationAddr, par);
- aty_st_8(DAC_REGS + 1, (program_bits & 0xff00) >> 8, par);
- aty_st_8(DAC_REGS + 1, (program_bits & 0xff), par);
-
- tmp = aty_ld_8(DAC_CNTL, par);
- aty_st_8(DAC_CNTL, (tmp & ~DAC_EXT_SEL_RS2) | DAC_EXT_SEL_RS3,
- par);
-
- (void) aty_ld_8(DAC_REGS, par); /* Clear DAC Counter */
- aty_st_8(CRTC_GEN_CNTL + 3, old_crtc_ext_disp, par);
-
- return;
-}
-
-const struct aty_pll_ops aty_pll_ch8398 = {
- .var_to_pll = aty_var_to_pll_8398,
- .pll_to_var = aty_pll_8398_to_var,
- .set_pll = aty_set_pll_8398,
-};
-
-
- /*
- * AT&T 20C408 Clock Chip
- */
-
-static int aty_var_to_pll_408(const struct fb_info *info, u32 vclk_per,
- u32 bpp, union aty_pll *pll)
-{
- u32 mhz100; /* in 0.01 MHz */
- u32 program_bits;
- /* u32 post_divider; */
- u32 mach64MinFreq, mach64MaxFreq, mach64RefFreq;
- u32 temp, tempB;
- u16 remainder, preRemainder;
- short divider = 0, tempA;
-
- /* Calculate the programming word */
- mhz100 = 100000000 / vclk_per;
- mach64MinFreq = MIN_FREQ_2595;
- mach64MaxFreq = MAX_FREQ_2595;
- mach64RefFreq = REF_FREQ_2595; /* 14.32 MHz */
-
- /* Calculate program word */
- if (mhz100 == 0)
- program_bits = 0xFF;
- else {
- if (mhz100 < mach64MinFreq)
- mhz100 = mach64MinFreq;
- if (mhz100 > mach64MaxFreq)
- mhz100 = mach64MaxFreq;
-
- while (mhz100 < (mach64MinFreq << 3)) {
- mhz100 <<= 1;
- divider += 0x40;
- }
-
- temp = (unsigned int) mhz100;
- temp = (unsigned int) (temp * (MIN_N_408 + 2));
- temp -= ((short) (mach64RefFreq << 1));
-
- tempA = MIN_N_408;
- preRemainder = 0xFFFF;
-
- do {
- tempB = temp;
- remainder = tempB % mach64RefFreq;
- tempB = tempB / mach64RefFreq;
- if (((tempB & 0xFFFF) <= 255)
- && (remainder <= preRemainder)) {
- preRemainder = remainder;
- divider &= ~0x3f;
- divider |= tempA;
- divider =
- (divider & 0x00FF) +
- ((tempB & 0xFF) << 8);
- }
- temp += mhz100;
- tempA++;
- } while (tempA <= 32);
-
- program_bits = divider;
- }
-
- pll->ics2595.program_bits = program_bits;
- pll->ics2595.locationAddr = 0;
- pll->ics2595.post_divider = divider; /* fuer nix */
- pll->ics2595.period_in_ps = vclk_per;
-
- return 0;
-}
-
-static u32 aty_pll_408_to_var(const struct fb_info *info,
- const union aty_pll *pll)
-{
- return (pll->ics2595.period_in_ps); /* default for now */
-}
-
-static void aty_set_pll_408(const struct fb_info *info,
- const union aty_pll *pll)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
- u32 program_bits;
- u32 locationAddr;
-
- u8 tmpA, tmpB, tmpC;
- char old_crtc_ext_disp;
-
- old_crtc_ext_disp = aty_ld_8(CRTC_GEN_CNTL + 3, par);
- aty_st_8(CRTC_GEN_CNTL + 3,
- old_crtc_ext_disp | (CRTC_EXT_DISP_EN >> 24), par);
-
- program_bits = pll->ics2595.program_bits;
- locationAddr = pll->ics2595.locationAddr;
-
- /* Program clock */
- aty_dac_waste4(par);
- tmpB = aty_ld_8(DAC_REGS + 2, par) | 1;
- aty_dac_waste4(par);
- aty_st_8(DAC_REGS + 2, tmpB, par);
-
- tmpA = tmpB;
- tmpC = tmpA;
- tmpA |= 8;
- tmpB = 1;
-
- aty_st_8(DAC_REGS, tmpB, par);
- aty_st_8(DAC_REGS + 2, tmpA, par);
-
- udelay(400); /* delay for 400 us */
-
- locationAddr = (locationAddr << 2) + 0x40;
- tmpB = locationAddr;
- tmpA = program_bits >> 8;
-
- aty_st_8(DAC_REGS, tmpB, par);
- aty_st_8(DAC_REGS + 2, tmpA, par);
-
- tmpB = locationAddr + 1;
- tmpA = (u8) program_bits;
-
- aty_st_8(DAC_REGS, tmpB, par);
- aty_st_8(DAC_REGS + 2, tmpA, par);
-
- tmpB = locationAddr + 2;
- tmpA = 0x77;
-
- aty_st_8(DAC_REGS, tmpB, par);
- aty_st_8(DAC_REGS + 2, tmpA, par);
-
- udelay(400); /* delay for 400 us */
- tmpA = tmpC & (~(1 | 8));
- tmpB = 1;
-
- aty_st_8(DAC_REGS, tmpB, par);
- aty_st_8(DAC_REGS + 2, tmpA, par);
-
- (void) aty_ld_8(DAC_REGS, par); /* Clear DAC Counter */
- aty_st_8(CRTC_GEN_CNTL + 3, old_crtc_ext_disp, par);
- return;
-}
-
-const struct aty_pll_ops aty_pll_att20c408 = {
- .var_to_pll = aty_var_to_pll_408,
- .pll_to_var = aty_pll_408_to_var,
- .set_pll = aty_set_pll_408,
-};
-
-
- /*
- * Unsupported DAC and Clock Chip
- */
-
-static int aty_set_dac_unsupported(const struct fb_info *info,
- const union aty_pll *pll, u32 bpp,
- u32 accel)
-{
- struct atyfb_par *par = (struct atyfb_par *) info->par;
-
- aty_st_le32(BUS_CNTL, 0x890e20f1, par);
- aty_st_le32(DAC_CNTL, 0x47052100, par);
- /* new in 2.2.3p1 from Geert. ???????? */
- aty_st_le32(BUS_CNTL, 0x590e10ff, par);
- aty_st_le32(DAC_CNTL, 0x47012100, par);
- return 0;
-}
-
-static int dummy(void)
-{
- return 0;
-}
-
-const struct aty_dac_ops aty_dac_unsupported = {
- .set_dac = aty_set_dac_unsupported,
-};
-
-const struct aty_pll_ops aty_pll_unsupported = {
- .var_to_pll = (void *) dummy,
- .pll_to_var = (void *) dummy,
- .set_pll = (void *) dummy,
-};