mirror of
https://github.com/mpv-player/mpv
synced 2024-12-14 02:45:43 +00:00
5d36d8991d
Ugly fix (from non-x86 point) of FPU problems for Radeons color correction Added checking of boundaries during color correction on Radeon git-svn-id: svn://svn.mplayerhq.hu/mplayer/trunk@3941 b3059339-0415-0410-9bf9-f77b7e298cf2
3163 lines
89 KiB
C
3163 lines
89 KiB
C
/*
|
|
* drivers/video/radeonfb.c
|
|
* framebuffer driver for ATI Radeon chipset video boards
|
|
*
|
|
* Copyright 2000 Ani Joshi <ajoshi@unixbox.com>
|
|
*
|
|
*
|
|
* ChangeLog:
|
|
* 2000-08-03 initial version 0.0.1
|
|
* 2000-09-10 more bug fixes, public release 0.0.5
|
|
* 2001-02-19 mode bug fixes, 0.0.7
|
|
* 2001-07-05 fixed scrolling issues, engine initialization,
|
|
* and minor mode tweaking, 0.0.9
|
|
*
|
|
* 2001-09-07 Radeon VE support
|
|
* 2001-09-10 Radeon VE QZ support by Nick Kurshev <nickols_k@mail.ru>
|
|
* (limitations: on dualhead Radeons (VE, M6, M7)
|
|
* driver works only on second head (DVI port).
|
|
* TVout is not supported too. M6 & M7 chips
|
|
* currently are not supported. Driver has a lot
|
|
* of other bugs. Probably they can be solved by
|
|
* importing XFree86 code, which has ATI's support).,
|
|
* 0.0.11
|
|
* 2001-09-13 merge Ani Joshi radeonfb-0.1.0:
|
|
* console switching fixes, blanking fixes,
|
|
* 0.1.0-ve.0
|
|
* 2001-09-18 Radeon VE, M6 support (by Nick Kurshev <nickols_k@mail.ru>),
|
|
* Fixed bug of rom bios detection on VE (by NK),
|
|
* Minor code cleanup (by NK),
|
|
* Enable CRT port on VE (by NK),
|
|
* Disable SURFACE_CNTL because mplayer doesn't work
|
|
* propertly (by NK)
|
|
* 0.1.0-ve.1
|
|
* 2001-09-25 MTRR support (by NK)
|
|
* 0.1.0-ve.2
|
|
* 2001-12-17 sync with 0.1.1:
|
|
* PanelYRes - module parameter
|
|
* - rage theatre (please see gatos.sf.net)
|
|
* - buggy tvout detection (need radeon_i2c)
|
|
* + better powerpc support
|
|
* + better radeon2 pll computing
|
|
* * Note: my stuff still work better for me than official
|
|
* linux driver :(
|
|
* Special thanks to ATI DevRel team for their hardware donations.
|
|
*
|
|
* LIMITATIONS: on dualhead Radeons (VE, M6, M7) driver doesn't work in
|
|
* dual monitor configuration. TVout is not supported too.
|
|
* Probably these problems can be solved by importing XFree86 code, which
|
|
* has ATI's support.
|
|
*
|
|
* Mini-HOWTO: This driver doesn't accept any options. It only switches your
|
|
* video card to graphics mode. Standard way to change video modes and other
|
|
* video attributes is using 'fbset' utility.
|
|
* Sample:
|
|
*
|
|
* #!/bin/sh
|
|
* fbset -fb /dev/fb0 -xres 640 -yres 480 -depth 32 -vxres 640 -vyres 480 -left 70 -right 50 -upper 70 -lower 70 -laced false -pixclock 39767
|
|
*
|
|
*/
|
|
|
|
#define RADEON_VERSION "0.1.1-ve"
|
|
|
|
#include <linux/config.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/string.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/fb.h>
|
|
#include <linux/console.h>
|
|
#include <linux/selection.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/init.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/unistd.h>
|
|
|
|
#include <asm/io.h>
|
|
|
|
#include <video/fbcon.h>
|
|
#include <video/fbcon-cfb8.h>
|
|
#include <video/fbcon-cfb16.h>
|
|
#include <video/fbcon-cfb24.h>
|
|
#include <video/fbcon-cfb32.h>
|
|
|
|
#ifdef CONFIG_MTRR
|
|
#include <asm/mtrr.h>
|
|
#endif
|
|
#if defined(__powerpc__)
|
|
#include <asm/prom.h>
|
|
#endif
|
|
|
|
#include "radeon.h"
|
|
|
|
|
|
#define DEBUG 0
|
|
|
|
#if DEBUG
|
|
#define RTRACE printk
|
|
#else
|
|
#define RTRACE(...) ((void)0)
|
|
#endif
|
|
|
|
MODULE_AUTHOR("Ani Joshi. (Radeon VE extensions by Nick Kurshev)");
|
|
MODULE_DESCRIPTION("framebuffer driver for ATI Radeon chipset. Ver: "RADEON_VERSION);
|
|
#ifdef CONFIG_MTRR
|
|
MODULE_PARM(nomtrr, "i");
|
|
MODULE_PARM_DESC(nomtrr, "Don't touch MTRR (touch=0(default))");
|
|
#endif
|
|
MODULE_PARM(yres_panel, "i");
|
|
MODULE_PARM_DESC(yres_panel, "Force DFP height");
|
|
|
|
|
|
enum radeon_chips {
|
|
RADEON_QD,
|
|
RADEON_QE,
|
|
RADEON_QF,
|
|
RADEON_QG,
|
|
RADEON_QY,
|
|
RADEON_QZ,
|
|
RADEON_LY,
|
|
RADEON_LZ,
|
|
RADEON_LW,
|
|
R200_QL,
|
|
R200_BB,
|
|
RV200_QW
|
|
};
|
|
|
|
enum radeon_montype
|
|
{
|
|
MT_NONE,
|
|
MT_CRT, /* CRT-(cathode ray tube) analog monitor. (15-pin VGA connector) */
|
|
MT_LCD, /* Liquid Crystal Display */
|
|
MT_DFP, /* DFP-digital flat panel monitor. (24-pin DVI-I connector) */
|
|
MT_CTV, /* Composite TV out (not in VE) */
|
|
MT_STV /* S-Video TV out (probably in VE only) */
|
|
};
|
|
|
|
static struct pci_device_id radeonfb_pci_table[] __devinitdata = {
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QD, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QD},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QE, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QE},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QF, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QF},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QG, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QG},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QY, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QY},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_QZ, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_QZ},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_LY, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LY},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_LZ, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LZ},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RADEON_LW, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RADEON_LW},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_R200_QL, PCI_ANY_ID, PCI_ANY_ID, 0, 0, R200_QL},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_R200_BB, PCI_ANY_ID, PCI_ANY_ID, 0, 0, R200_BB},
|
|
{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_RV200_QW, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RV200_QW},
|
|
{ 0, }
|
|
};
|
|
MODULE_DEVICE_TABLE(pci, radeonfb_pci_table);
|
|
|
|
|
|
typedef struct {
|
|
u16 reg;
|
|
u32 val;
|
|
} reg_val;
|
|
|
|
|
|
#define COMMON_REGS_SIZE = (sizeof(common_regs)/sizeof(common_regs[0]))
|
|
|
|
typedef struct {
|
|
u8 clock_chip_type;
|
|
u8 struct_size;
|
|
u8 accelerator_entry;
|
|
u8 VGA_entry;
|
|
u16 VGA_table_offset;
|
|
u16 POST_table_offset;
|
|
u16 XCLK;
|
|
u16 MCLK;
|
|
u8 num_PLL_blocks;
|
|
u8 size_PLL_blocks;
|
|
u16 PCLK_ref_freq;
|
|
u16 PCLK_ref_divider;
|
|
u32 PCLK_min_freq;
|
|
u32 PCLK_max_freq;
|
|
u16 MCLK_ref_freq;
|
|
u16 MCLK_ref_divider;
|
|
u32 MCLK_min_freq;
|
|
u32 MCLK_max_freq;
|
|
u16 XCLK_ref_freq;
|
|
u16 XCLK_ref_divider;
|
|
u32 XCLK_min_freq;
|
|
u32 XCLK_max_freq;
|
|
} __attribute__ ((packed)) PLL_BLOCK;
|
|
|
|
|
|
struct pll_info {
|
|
int ppll_max;
|
|
int ppll_min;
|
|
int xclk;
|
|
int ref_div;
|
|
int ref_clk;
|
|
};
|
|
|
|
|
|
struct ram_info {
|
|
int ml;
|
|
int mb;
|
|
int trcd;
|
|
int trp;
|
|
int twr;
|
|
int cl;
|
|
int tr2w;
|
|
int loop_latency;
|
|
int rloop;
|
|
};
|
|
|
|
|
|
struct radeon_regs {
|
|
/* Common registers */
|
|
u32 ovr_clr;
|
|
u32 ovr_wid_left_right;
|
|
u32 ovr_wid_top_bottom;
|
|
u32 ov0_scale_cntl;
|
|
u32 mpp_tb_config;
|
|
u32 mpp_gp_config;
|
|
u32 subpic_cntl;
|
|
u32 i2c_cntl_1;
|
|
u32 gen_int_cntl;
|
|
u32 cap0_trig_cntl;
|
|
u32 cap1_trig_cntl;
|
|
u32 bus_cntl;
|
|
/* Other registers to save for VT switches */
|
|
u32 dp_datatype;
|
|
u32 rbbm_soft_reset;
|
|
u32 clock_cntl_index;
|
|
u32 amcgpio_en_reg;
|
|
u32 amcgpio_mask;
|
|
/* CRTC registers */
|
|
u32 crtc_gen_cntl;
|
|
u32 crtc_ext_cntl;
|
|
u32 dac_cntl;
|
|
u32 crtc_h_total_disp;
|
|
u32 crtc_h_sync_strt_wid;
|
|
u32 crtc_v_total_disp;
|
|
u32 crtc_v_sync_strt_wid;
|
|
u32 crtc_offset;
|
|
u32 crtc_offset_cntl;
|
|
u32 crtc_pitch;
|
|
/* CRTC2 registers */
|
|
u32 crtc2_gen_cntl;
|
|
u32 dac2_cntl;
|
|
u32 disp_output_cntl;
|
|
u32 crtc2_h_total_disp;
|
|
u32 crtc2_h_sync_strt_wid;
|
|
u32 crtc2_v_total_disp;
|
|
u32 crtc2_v_sync_strt_wid;
|
|
u32 crtc2_offset;
|
|
u32 crtc2_offset_cntl;
|
|
u32 crtc2_pitch;
|
|
/* Flat panel registers */
|
|
u32 fp_crtc_h_total_disp;
|
|
u32 fp_crtc_v_total_disp;
|
|
u32 fp_gen_cntl;
|
|
u32 fp_h_sync_strt_wid;
|
|
u32 fp_horz_stretch;
|
|
u32 fp_panel_cntl;
|
|
u32 fp_v_sync_strt_wid;
|
|
u32 fp_vert_stretch;
|
|
u32 lvds_gen_cntl;
|
|
u32 lvds_pll_cntl;
|
|
u32 tmds_crc;
|
|
/* DDA registers */
|
|
u32 dda_config;
|
|
u32 dda_on_off;
|
|
|
|
/* Computed values for PLL */
|
|
u32 dot_clock_freq;
|
|
u32 pll_output_freq;
|
|
int feedback_div;
|
|
int post_div;
|
|
/* PLL registers */
|
|
u32 ppll_ref_div;
|
|
u32 ppll_div_3;
|
|
u32 htotal_cntl;
|
|
/* Computed values for PLL2 */
|
|
u32 dot_clock_freq_2;
|
|
u32 pll_output_freq_2;
|
|
int feedback_div_2;
|
|
int post_div_2;
|
|
/* PLL2 registers */
|
|
u32 p2pll_ref_div;
|
|
u32 p2pll_div_0;
|
|
u32 htotal_cntl2;
|
|
/* Pallet */
|
|
int palette_valid;
|
|
u32 palette[256];
|
|
u32 palette2[256];
|
|
|
|
u32 flags;
|
|
u32 pix_clock;
|
|
int xres, yres;
|
|
int bpp;
|
|
#if defined(__BIG_ENDIAN)
|
|
u32 surface_cntl;
|
|
#endif
|
|
};
|
|
|
|
|
|
struct radeonfb_info {
|
|
struct fb_info info;
|
|
|
|
struct radeon_regs state;
|
|
struct radeon_regs init_state;
|
|
|
|
char name[17];
|
|
char ram_type[12];
|
|
|
|
int hasCRTC2;
|
|
int crtDispType;
|
|
int dviDispType;
|
|
int isM7;
|
|
int isM6;
|
|
int isR200;
|
|
/* Computed values for FPs */
|
|
int PanelXRes;
|
|
int PanelYRes;
|
|
int HOverPlus;
|
|
int HSyncWidth;
|
|
int HBlank;
|
|
int VOverPlus;
|
|
int VSyncWidth;
|
|
int VBlank;
|
|
int PanelPwrDly;
|
|
|
|
u32 mmio_base_phys;
|
|
u32 fb_base_phys;
|
|
|
|
u32 mmio_base;
|
|
u32 fb_base;
|
|
|
|
u32 MemCntl;
|
|
u32 BusCntl;
|
|
|
|
struct pci_dev *pdev;
|
|
|
|
struct display disp;
|
|
int currcon;
|
|
struct display *currcon_display;
|
|
|
|
struct { u8 red, green, blue, pad; } palette[256];
|
|
|
|
int chipset;
|
|
int video_ram;
|
|
u8 rev;
|
|
int pitch, bpp, depth;
|
|
int xres, yres, pixclock;
|
|
|
|
u32 dp_gui_master_cntl;
|
|
|
|
struct pll_info pll;
|
|
int pll_output_freq, post_div, fb_div;
|
|
|
|
struct ram_info ram;
|
|
|
|
#ifdef CONFIG_MTRR
|
|
struct { int vram; int vram_valid; } mtrr;
|
|
#endif
|
|
#if defined(FBCON_HAS_CFB16) || defined(FBCON_HAS_CFB32)
|
|
union {
|
|
#if defined(FBCON_HAS_CFB16)
|
|
u_int16_t cfb16[16];
|
|
#endif
|
|
#if defined(FBCON_HAS_CFB24)
|
|
u_int32_t cfb24[16];
|
|
#endif
|
|
#if defined(FBCON_HAS_CFB32)
|
|
u_int32_t cfb32[16];
|
|
#endif
|
|
} con_cmap;
|
|
#endif
|
|
};
|
|
|
|
#define SINGLE_MONITOR(rinfo) (rinfo->crtDispType == MT_NONE || rinfo->dviDispType == MT_NONE)
|
|
/*#define DUAL_MONITOR(rinfo) (rinfo->crtDispType != MT_NONE && rinfo->dviDispType != MT_NONE)*/
|
|
/* Disable DUAL monitor support for now */
|
|
#define DUAL_MONITOR(rinfo) (0)
|
|
#define PRIMARY_MONITOR(rinfo) (rinfo->dviDispType != MT_NONE &&\
|
|
rinfo->dviDispType != MT_STV &&\
|
|
rinfo->dviDispType != MT_CTV ?\
|
|
rinfo->dviDispType : rinfo->crtDispType)
|
|
|
|
static struct fb_var_screeninfo radeonfb_default_var = {
|
|
640, 480, 640, 480, 0, 0, 8, 0,
|
|
{0, 6, 0}, {0, 6, 0}, {0, 6, 0}, {0, 0, 0},
|
|
0, 0, -1, -1, 0, 39721, 40, 24, 32, 11, 96, 2,
|
|
0, FB_VMODE_NONINTERLACED
|
|
};
|
|
|
|
|
|
/*
|
|
* IO macros
|
|
*/
|
|
|
|
#define INREG8(addr) readb((rinfo->mmio_base)+addr)
|
|
#define OUTREG8(addr,val) writeb(val, (rinfo->mmio_base)+addr)
|
|
#define INREG(addr) readl((rinfo->mmio_base)+addr)
|
|
#define OUTREG(addr,val) writel(val, (rinfo->mmio_base)+addr)
|
|
|
|
#define OUTPLL(addr,val) OUTREG8(CLOCK_CNTL_INDEX, (addr & 0x0000001f) | 0x00000080); \
|
|
OUTREG(CLOCK_CNTL_DATA, val)
|
|
#define OUTPLLP(addr,val,mask) \
|
|
do { \
|
|
unsigned int _tmp = INPLL(addr); \
|
|
_tmp &= (mask); \
|
|
_tmp |= (val); \
|
|
OUTPLL(addr, _tmp); \
|
|
} while (0)
|
|
|
|
#define OUTREGP(addr,val,mask) \
|
|
do { \
|
|
unsigned int _tmp = INREG(addr); \
|
|
_tmp &= (mask); \
|
|
_tmp |= (val); \
|
|
OUTREG(addr, _tmp); \
|
|
} while (0)
|
|
|
|
|
|
static __inline__ u32 _INPLL(struct radeonfb_info *rinfo, u32 addr)
|
|
{
|
|
OUTREG8(CLOCK_CNTL_INDEX, addr & 0x0000001f);
|
|
return (INREG(CLOCK_CNTL_DATA));
|
|
}
|
|
|
|
#define INPLL(addr) _INPLL(rinfo, addr)
|
|
|
|
static __inline__ u8 radeon_get_post_div_bitval(int post_div)
|
|
{
|
|
switch (post_div) {
|
|
case 1:
|
|
return 0x00;
|
|
case 2:
|
|
return 0x01;
|
|
case 3:
|
|
return 0x04;
|
|
case 4:
|
|
return 0x02;
|
|
case 6:
|
|
return 0x06;
|
|
case 8:
|
|
return 0x03;
|
|
case 12:
|
|
return 0x07;
|
|
default:
|
|
return 0x02;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
static __inline__ int round_div(int num, int den)
|
|
{
|
|
return (num + (den / 2)) / den;
|
|
}
|
|
|
|
|
|
|
|
static __inline__ int min_bits_req(int val)
|
|
{
|
|
int bits_req = 0;
|
|
|
|
if (val == 0)
|
|
bits_req = 1;
|
|
|
|
while (val) {
|
|
val >>= 1;
|
|
bits_req++;
|
|
}
|
|
|
|
return (bits_req);
|
|
}
|
|
|
|
|
|
static __inline__ int _max(int val1, int val2)
|
|
{
|
|
if (val1 >= val2)
|
|
return val1;
|
|
else
|
|
return val2;
|
|
}
|
|
|
|
|
|
/*
|
|
* 2D engine routines
|
|
*/
|
|
|
|
static __inline__ void radeon_engine_flush (struct radeonfb_info *rinfo)
|
|
{
|
|
int i;
|
|
|
|
/* initiate flush */
|
|
OUTREGP(RB2D_DSTCACHE_CTLSTAT, RB2D_DC_FLUSH_ALL,
|
|
~RB2D_DC_FLUSH_ALL);
|
|
|
|
for (i=0; i < 2000000; i++) {
|
|
if (!(INREG(RB2D_DSTCACHE_CTLSTAT) & RB2D_DC_BUSY))
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
static __inline__ void _radeon_fifo_wait (struct radeonfb_info *rinfo, int entries)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<2000000; i++)
|
|
if ((INREG(RBBM_STATUS) & 0x7f) >= entries)
|
|
return;
|
|
}
|
|
|
|
|
|
static __inline__ void _radeon_engine_idle (struct radeonfb_info *rinfo)
|
|
{
|
|
int i;
|
|
|
|
/* ensure FIFO is empty before waiting for idle */
|
|
_radeon_fifo_wait (rinfo, 64);
|
|
|
|
for (i=0; i<2000000; i++) {
|
|
if (((INREG(RBBM_STATUS) & GUI_ACTIVE)) == 0) {
|
|
radeon_engine_flush (rinfo);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
#define radeon_engine_idle() _radeon_engine_idle(rinfo)
|
|
#define radeon_fifo_wait(entries) _radeon_fifo_wait(rinfo,entries)
|
|
|
|
|
|
|
|
/*
|
|
* helper routines
|
|
*/
|
|
|
|
static __inline__ u32 radeon_get_dstbpp(u16 depth)
|
|
{
|
|
switch (depth) {
|
|
case 8:
|
|
return DST_8BPP;
|
|
case 15:
|
|
return DST_15BPP;
|
|
case 16:
|
|
return DST_16BPP;
|
|
case 24:
|
|
return DST_24BPP;
|
|
case 32:
|
|
return DST_32BPP;
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
static void _radeon_engine_reset(struct radeonfb_info *rinfo)
|
|
{
|
|
u32 clock_cntl_index, mclk_cntl, rbbm_soft_reset;
|
|
|
|
radeon_engine_flush (rinfo);
|
|
|
|
clock_cntl_index = INREG(CLOCK_CNTL_INDEX);
|
|
mclk_cntl = INPLL(MCLK_CNTL);
|
|
|
|
OUTPLL(MCLK_CNTL, (mclk_cntl |
|
|
FORCEON_MCLKA |
|
|
FORCEON_MCLKB |
|
|
FORCEON_YCLKA |
|
|
FORCEON_YCLKB |
|
|
FORCEON_MC |
|
|
FORCEON_AIC));
|
|
rbbm_soft_reset = INREG(RBBM_SOFT_RESET);
|
|
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset |
|
|
SOFT_RESET_CP |
|
|
SOFT_RESET_HI |
|
|
SOFT_RESET_SE |
|
|
SOFT_RESET_RE |
|
|
SOFT_RESET_PP |
|
|
SOFT_RESET_E2 |
|
|
SOFT_RESET_RB |
|
|
SOFT_RESET_HDP);
|
|
INREG(RBBM_SOFT_RESET);
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset & (u32)
|
|
~(SOFT_RESET_CP |
|
|
SOFT_RESET_HI |
|
|
SOFT_RESET_SE |
|
|
SOFT_RESET_RE |
|
|
SOFT_RESET_PP |
|
|
SOFT_RESET_E2 |
|
|
SOFT_RESET_RB |
|
|
SOFT_RESET_HDP));
|
|
INREG(RBBM_SOFT_RESET);
|
|
|
|
OUTPLL(MCLK_CNTL, mclk_cntl);
|
|
OUTREG(CLOCK_CNTL_INDEX, clock_cntl_index);
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset);
|
|
|
|
return;
|
|
}
|
|
|
|
#define radeon_engine_reset() _radeon_engine_reset(rinfo)
|
|
|
|
/*
|
|
* globals
|
|
*/
|
|
|
|
static char fontname[40] __initdata;
|
|
static char *mode_option __initdata;
|
|
static char noaccel __initdata = 0;
|
|
static int nomtrr __initdata = 0;
|
|
static int yres_panel __initdata = 0;
|
|
static char panel_yres __initdata = 0;
|
|
|
|
#if 0
|
|
#ifdef FBCON_HAS_CFB8
|
|
static struct display_switch fbcon_radeon8;
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef CONFIG_MTRR
|
|
static int mtrr = 1;
|
|
#endif
|
|
|
|
/*
|
|
* prototypes
|
|
*/
|
|
|
|
static int radeonfb_get_fix (struct fb_fix_screeninfo *fix, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_get_var (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_set_var (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_get_cmap (struct fb_cmap *cmap, int kspc, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_set_cmap (struct fb_cmap *cmap, int kspc, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_pan_display (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info);
|
|
static int radeonfb_ioctl (struct inode *inode, struct file *file, unsigned int cmd,
|
|
unsigned long arg, int con, struct fb_info *info);
|
|
static int radeonfb_switch (int con, struct fb_info *info);
|
|
static int radeonfb_updatevar (int con, struct fb_info *info);
|
|
static void radeonfb_blank (int blank, struct fb_info *info);
|
|
static int radeon_get_cmap_len (const struct fb_var_screeninfo *var);
|
|
static int radeon_getcolreg (unsigned regno, unsigned *red, unsigned *green,
|
|
unsigned *blue, unsigned *transp,
|
|
struct fb_info *info);
|
|
static int radeon_setcolreg (unsigned regno, unsigned red, unsigned green,
|
|
unsigned blue, unsigned transp, struct fb_info *info);
|
|
static void radeon_set_dispsw (struct radeonfb_info *rinfo, struct display *disp);
|
|
static void radeon_save_mode (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save);
|
|
static void radeon_save_state (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save);
|
|
static void radeon_engine_init (struct radeonfb_info *rinfo);
|
|
static int radeon_load_video_mode (struct radeonfb_info *rinfo,
|
|
struct fb_var_screeninfo *mode);
|
|
static void radeon_write_mode (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *mode);
|
|
static void radeon_write_state (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *mode);
|
|
static int __devinit radeon_set_fbinfo (struct radeonfb_info *rinfo);
|
|
static int __devinit radeon_init_disp (struct radeonfb_info *rinfo);
|
|
static int radeon_init_disp_var (struct radeonfb_info *rinfo);
|
|
static int radeonfb_pci_register (struct pci_dev *pdev,
|
|
const struct pci_device_id *ent);
|
|
static void __devexit radeonfb_pci_unregister (struct pci_dev *pdev);
|
|
static char *radeon_find_rom(struct radeonfb_info *rinfo);
|
|
static void radeon_get_pllinfo(struct radeonfb_info *rinfo, char *bios_seg);
|
|
static void do_install_cmap(int con, struct fb_info *info);
|
|
static int radeonfb_do_maximize(struct radeonfb_info *rinfo,
|
|
struct fb_var_screeninfo *var,
|
|
struct fb_var_screeninfo *v,
|
|
int nom, int den);
|
|
#if defined(__powerpc__)
|
|
extern struct device_node *pci_device_to_OF_node(struct pci_dev *dev);
|
|
#endif
|
|
|
|
static struct fb_ops radeon_fb_ops = {
|
|
fb_get_fix: radeonfb_get_fix,
|
|
fb_get_var: radeonfb_get_var,
|
|
fb_set_var: radeonfb_set_var,
|
|
fb_get_cmap: radeonfb_get_cmap,
|
|
fb_set_cmap: radeonfb_set_cmap,
|
|
fb_pan_display: radeonfb_pan_display,
|
|
fb_ioctl: radeonfb_ioctl,
|
|
};
|
|
|
|
|
|
static struct pci_driver radeonfb_driver = {
|
|
name: "radeonfb",
|
|
id_table: radeonfb_pci_table,
|
|
probe: radeonfb_pci_register,
|
|
remove: radeonfb_pci_unregister,
|
|
};
|
|
|
|
static void _radeon_wait_for_idle(struct radeonfb_info *rinfo);
|
|
/* Restore the acceleration hardware to its previous state. */
|
|
static void _radeon_engine_restore(struct radeonfb_info *rinfo)
|
|
{
|
|
int pitch64;
|
|
|
|
radeon_fifo_wait(1);
|
|
/* turn of all automatic flushing - we'll do it all */
|
|
OUTREG(RB2D_DSTCACHE_MODE, 0);
|
|
|
|
pitch64 = ((rinfo->xres * (rinfo->bpp / 8) + 0x3f)) >> 6;
|
|
|
|
radeon_fifo_wait(1);
|
|
OUTREG(DEFAULT_OFFSET, (INREG(DEFAULT_OFFSET) & 0xC0000000) |
|
|
(pitch64 << 22));
|
|
|
|
radeon_fifo_wait(1);
|
|
#if defined(__BIG_ENDIAN)
|
|
OUTREGP(DP_DATATYPE,
|
|
HOST_BIG_ENDIAN_EN, ~HOST_BIG_ENDIAN_EN);
|
|
#else
|
|
OUTREGP(DP_DATATYPE, 0, ~HOST_BIG_ENDIAN_EN);
|
|
#endif
|
|
|
|
radeon_fifo_wait(1);
|
|
OUTREG(DEFAULT_SC_BOTTOM_RIGHT, (DEFAULT_SC_RIGHT_MAX
|
|
| DEFAULT_SC_BOTTOM_MAX));
|
|
radeon_fifo_wait(1);
|
|
OUTREG(DP_GUI_MASTER_CNTL, (INREG(DP_GUI_MASTER_CNTL)
|
|
| GMC_BRUSH_SOLID_COLOR
|
|
| GMC_SRC_DATATYPE_COLOR));
|
|
|
|
radeon_fifo_wait(7);
|
|
OUTREG(DST_LINE_START, 0);
|
|
OUTREG(DST_LINE_END, 0);
|
|
OUTREG(DP_BRUSH_FRGD_CLR, 0xffffffff);
|
|
OUTREG(DP_BRUSH_BKGD_CLR, 0x00000000);
|
|
OUTREG(DP_SRC_FRGD_CLR, 0xffffffff);
|
|
OUTREG(DP_SRC_BKGD_CLR, 0x00000000);
|
|
OUTREG(DP_WRITE_MASK, 0xffffffff);
|
|
|
|
_radeon_wait_for_idle(rinfo);
|
|
}
|
|
|
|
/* The FIFO has 64 slots. This routines waits until at least `entries' of
|
|
these slots are empty. */
|
|
#define RADEON_TIMEOUT 2000000 /* Fall out of wait loops after this count */
|
|
static void _radeon_wait_for_fifo_function(struct radeonfb_info *rinfo, int entries)
|
|
{
|
|
int i;
|
|
|
|
for (;;) {
|
|
for (i = 0; i < RADEON_TIMEOUT; i++) {
|
|
if((INREG(RBBM_STATUS) & RBBM_FIFOCNT_MASK) >= entries) return;
|
|
}
|
|
radeon_engine_reset();
|
|
_radeon_engine_restore(rinfo);
|
|
/* it might be that DRI has been compiled in, but corresponding
|
|
library was not loaded.. */
|
|
}
|
|
}
|
|
/* Wait for the graphics engine to be completely idle: the FIFO has
|
|
drained, the Pixel Cache is flushed, and the engine is idle. This is a
|
|
standard "sync" function that will make the hardware "quiescent". */
|
|
static void _radeon_wait_for_idle(struct radeonfb_info *rinfo)
|
|
{
|
|
int i;
|
|
|
|
_radeon_wait_for_fifo_function(rinfo, 64);
|
|
|
|
for (;;) {
|
|
for (i = 0; i < RADEON_TIMEOUT; i++) {
|
|
if (!(INREG(RBBM_STATUS) & RBBM_ACTIVE)) {
|
|
radeon_engine_flush(rinfo);
|
|
return;
|
|
}
|
|
}
|
|
_radeon_engine_reset(rinfo);
|
|
_radeon_engine_restore(rinfo);
|
|
}
|
|
}
|
|
|
|
int __init radeonfb_init (void)
|
|
{
|
|
#ifdef CONFIG_MTRR
|
|
if (nomtrr) {
|
|
mtrr = 0;
|
|
printk("radeonfb: Parameter NOMTRR set\n");
|
|
}
|
|
#endif
|
|
if (yres_panel) panel_yres = yres_panel;
|
|
return pci_module_init (&radeonfb_driver);
|
|
}
|
|
|
|
|
|
void __exit radeonfb_exit (void)
|
|
{
|
|
pci_unregister_driver (&radeonfb_driver);
|
|
}
|
|
|
|
|
|
int __init radeonfb_setup (char *options)
|
|
{
|
|
char *this_opt;
|
|
|
|
if (!options || !*options)
|
|
return 0;
|
|
|
|
while ((this_opt = strsep (&options, ",")) != NULL) {
|
|
if (!*this_opt)
|
|
continue;
|
|
if (!strncmp (this_opt, "font:", 5)) {
|
|
char *p;
|
|
int i;
|
|
|
|
p = this_opt + 5;
|
|
for (i=0; i<sizeof (fontname) - 1; i++)
|
|
if (!*p || *p == ' ' || *p == ',')
|
|
break;
|
|
memcpy(fontname, this_opt + 5, i);
|
|
} else if (!strncmp(this_opt, "noaccel", 7)) {
|
|
noaccel = 1;
|
|
}
|
|
#ifdef CONFIG_MTRR
|
|
else if(!strncmp(this_opt, "nomtrr", 6)) {
|
|
mtrr = 0;
|
|
}
|
|
#endif
|
|
else if (!strncmp(this_opt, "panel_yres:", 11)) {
|
|
panel_yres = simple_strtoul((this_opt+11), NULL, 0);
|
|
} else
|
|
mode_option = this_opt;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef MODULE
|
|
module_init(radeonfb_init);
|
|
module_exit(radeonfb_exit);
|
|
#endif
|
|
|
|
static char * GET_MON_NAME(int type)
|
|
{
|
|
char *pret;
|
|
switch(type)
|
|
{
|
|
case MT_NONE: pret = "no"; break;
|
|
case MT_CRT: pret = "CRT"; break;
|
|
case MT_DFP: pret = "DFP"; break;
|
|
case MT_LCD: pret = "LCD"; break;
|
|
case MT_CTV: pret = "CTV"; break;
|
|
case MT_STV: pret = "STV"; break;
|
|
default: pret = "Unknown";
|
|
}
|
|
return pret;
|
|
}
|
|
|
|
/*This funtion is used to reverse calculate
|
|
panel information from register settings in VGA mode.
|
|
More graceful way is to use EDID information... if it can be detected.
|
|
This way may be better than directly probing BIOS image. Because
|
|
BIOS image could change from version to version, while the
|
|
registers should always(?) contain right information, otherwise
|
|
the VGA mode display will not be correct. Well, if someone
|
|
messes up these registers before our driver is loaded, we'll be in
|
|
trouble...*/
|
|
static int radeon_get_dfp_info(struct radeonfb_info *rinfo)
|
|
{
|
|
unsigned long r;
|
|
unsigned short a, b;
|
|
|
|
if (panel_yres) {
|
|
rinfo->PanelYRes = panel_yres;
|
|
} else {
|
|
r = INREG(FP_VERT_STRETCH);
|
|
r &= 0x00fff000;
|
|
rinfo->PanelYRes = (unsigned short)(r >> 0x0c) + 1;
|
|
}
|
|
switch(rinfo->PanelYRes)
|
|
{
|
|
case 480: rinfo->PanelXRes = 640;
|
|
break;
|
|
case 600: rinfo->PanelXRes = 800;
|
|
break;
|
|
case 768: rinfo->PanelXRes = 1024;
|
|
break;
|
|
case 1024: rinfo->PanelXRes = 1280;
|
|
break;
|
|
case 1050: rinfo->PanelXRes = 1400;
|
|
break;
|
|
case 1200: rinfo->PanelXRes = 1600;
|
|
break;
|
|
default:
|
|
printk("radeonfb: Failed to detect the DFP panel size.\n");
|
|
return 0;
|
|
|
|
}
|
|
|
|
printk("Detected DFP panel size: %dx%d\n", rinfo->PanelXRes, rinfo->PanelYRes);
|
|
|
|
r = INREG(FP_CRTC_H_TOTAL_DISP);
|
|
a = (r & FP_CRTC_H_TOTAL_MASK) + 4;
|
|
b = (r & 0x01FF0000) >> FP_CRTC_H_DISP_SHIFT;
|
|
rinfo->HBlank = (a - b + 1) * 8;
|
|
|
|
r = INREG(FP_H_SYNC_STRT_WID);
|
|
rinfo->HOverPlus =
|
|
(unsigned short)((r & FP_H_SYNC_STRT_CHAR_MASK)
|
|
>> FP_H_SYNC_STRT_CHAR_SHIFT) - b - 1;
|
|
rinfo->HOverPlus *= 8;
|
|
rinfo->HSyncWidth =
|
|
(unsigned short)((r & FP_H_SYNC_WID_MASK)
|
|
>> FP_H_SYNC_WID_SHIFT);
|
|
rinfo->HSyncWidth *= 8;
|
|
r = INREG(FP_CRTC_V_TOTAL_DISP);
|
|
a = (r & FP_CRTC_V_TOTAL_MASK) + 1;
|
|
b = (r & FP_CRTC_V_DISP_MASK) >> FP_CRTC_V_DISP_SHIFT;
|
|
rinfo->VBlank = a - b /*+ 24*/;
|
|
|
|
r = INREG(FP_V_SYNC_STRT_WID);
|
|
rinfo->VOverPlus = (unsigned short)(r & FP_V_SYNC_STRT_MASK)
|
|
- b + 1;
|
|
rinfo->VSyncWidth = (unsigned short)((r & FP_V_SYNC_WID_MASK)
|
|
>> FP_V_SYNC_WID_SHIFT);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static void radeon_get_moninfo (struct radeonfb_info *rinfo)
|
|
{
|
|
unsigned int tmp;
|
|
|
|
tmp = INREG(RADEON_BIOS_4_SCRATCH);
|
|
|
|
if (rinfo->hasCRTC2) {
|
|
/* primary DVI port */
|
|
if (tmp & 0x08)
|
|
rinfo->dviDispType = MT_DFP;
|
|
else if (tmp & 0x4)
|
|
rinfo->dviDispType = MT_LCD;
|
|
else if (tmp & 0x200)
|
|
rinfo->dviDispType = MT_CRT;
|
|
else if (tmp & 0x10)
|
|
rinfo->dviDispType = MT_CTV;
|
|
else if (tmp & 0x20)
|
|
rinfo->dviDispType = MT_STV;
|
|
|
|
/* secondary CRT port */
|
|
if (tmp & 0x2)
|
|
rinfo->crtDispType = MT_CRT;
|
|
else if (tmp & 0x800)
|
|
rinfo->crtDispType = MT_DFP;
|
|
else if (tmp & 0x400)
|
|
rinfo->crtDispType = MT_LCD;
|
|
else if (tmp & 0x1000)
|
|
rinfo->crtDispType = MT_CTV;
|
|
else if (tmp & 0x2000)
|
|
rinfo->crtDispType = MT_STV;
|
|
} else {
|
|
rinfo->dviDispType = MT_NONE;
|
|
|
|
tmp = INREG(FP_GEN_CNTL);
|
|
|
|
if (tmp & FP_EN_TMDS)
|
|
rinfo->crtDispType = MT_DFP;
|
|
else
|
|
rinfo->crtDispType = MT_CRT;
|
|
}
|
|
}
|
|
|
|
static int radeonfb_pci_register (struct pci_dev *pdev,
|
|
const struct pci_device_id *ent)
|
|
{
|
|
struct radeonfb_info *rinfo;
|
|
u32 tmp;
|
|
int i, j;
|
|
char *bios_seg = NULL;
|
|
|
|
rinfo = kmalloc (sizeof (struct radeonfb_info), GFP_KERNEL);
|
|
if (!rinfo) {
|
|
printk ("radeonfb: could not allocate memory\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
memset (rinfo, 0, sizeof (struct radeonfb_info));
|
|
|
|
rinfo->pdev = pdev;
|
|
|
|
/* enable device */
|
|
{
|
|
int err;
|
|
|
|
if ((err = pci_enable_device(pdev))) {
|
|
printk("radeonfb: cannot enable device\n");
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
/* set base addrs */
|
|
rinfo->fb_base_phys = pci_resource_start (pdev, 0);
|
|
rinfo->mmio_base_phys = pci_resource_start (pdev, 2);
|
|
|
|
/* request the mem regions */
|
|
if (!request_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0), "radeonfb")) {
|
|
printk ("radeonfb: cannot reserve FB region\n");
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (!request_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2), "radeonfb")) {
|
|
printk ("radeonfb: cannot reserve MMIO region\n");
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* map the regions */
|
|
rinfo->mmio_base = (u32) ioremap (rinfo->mmio_base_phys,
|
|
RADEON_REGSIZE);
|
|
if (!rinfo->mmio_base) {
|
|
printk ("radeonfb: cannot map MMIO\n");
|
|
release_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2));
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
rinfo->chipset = pdev->device;
|
|
|
|
/* chipset */
|
|
switch (pdev->device) {
|
|
case PCI_DEVICE_ID_RADEON_QD:
|
|
strcpy(rinfo->name, "Radeon QD ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QE:
|
|
strcpy(rinfo->name, "Radeon QE ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QF:
|
|
strcpy(rinfo->name, "Radeon QF ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QG:
|
|
strcpy(rinfo->name, "Radeon QG ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QY:
|
|
rinfo->hasCRTC2 = 1;
|
|
strcpy(rinfo->name, "Radeon VE QY ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QZ:
|
|
rinfo->hasCRTC2 = 1;
|
|
strcpy(rinfo->name, "Radeon VE QZ ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_LY:
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isM6 = 1;
|
|
strcpy(rinfo->name, "Radeon M6 LY ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_LZ:
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isM6 = 1;
|
|
strcpy(rinfo->name, "Radeon M6 LZ ");
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_LW:
|
|
/* Note: Only difference between VE,M6 and M7 is initialization CRTC2
|
|
registers in dual monitor configuration!!! */
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isM7 = 1;
|
|
strcpy(rinfo->name, "Radeon M7 LW ");
|
|
break;
|
|
case PCI_DEVICE_ID_R200_QL:
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isR200 = 1;
|
|
strcpy(rinfo->name, "Radeon2 8500 QL ");
|
|
break;
|
|
case PCI_DEVICE_ID_R200_BB:
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isR200 = 1;
|
|
strcpy(rinfo->name, "Radeon2 8500 AIW");
|
|
break;
|
|
case PCI_DEVICE_ID_RV200_QW:
|
|
rinfo->hasCRTC2 = 1;
|
|
rinfo->isM7 = 1;
|
|
strcpy(rinfo->name, "Radeon2 7500 QW ");
|
|
break;
|
|
default:
|
|
release_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2));
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* framebuffer size */
|
|
tmp = INREG(CONFIG_MEMSIZE);
|
|
|
|
/* mem size is bits [28:0], mask off the rest */
|
|
rinfo->video_ram = tmp & CONFIG_MEMSIZE_MASK;
|
|
|
|
/* ram type */
|
|
rinfo->MemCntl = INREG(MEM_SDRAM_MODE_REG);
|
|
switch ((MEM_CFG_TYPE & rinfo->MemCntl) >> 30) {
|
|
case 0:
|
|
/* SDR SGRAM (2:1) */
|
|
strcpy(rinfo->ram_type, "SDR SGRAM");
|
|
rinfo->ram.ml = 4;
|
|
rinfo->ram.mb = 4;
|
|
rinfo->ram.trcd = 1;
|
|
rinfo->ram.trp = 2;
|
|
rinfo->ram.twr = 1;
|
|
rinfo->ram.cl = 2;
|
|
rinfo->ram.loop_latency = 16;
|
|
rinfo->ram.rloop = 16;
|
|
|
|
break;
|
|
case 1:
|
|
/* DDR SGRAM */
|
|
strcpy(rinfo->ram_type, "DDR SGRAM");
|
|
rinfo->ram.ml = 4;
|
|
rinfo->ram.mb = 4;
|
|
rinfo->ram.trcd = 3;
|
|
rinfo->ram.trp = 3;
|
|
rinfo->ram.twr = 2;
|
|
rinfo->ram.cl = 3;
|
|
rinfo->ram.tr2w = 1;
|
|
rinfo->ram.loop_latency = 16;
|
|
rinfo->ram.rloop = 16;
|
|
|
|
break;
|
|
default:
|
|
/* 64-bit SDR SGRAM */
|
|
strcpy(rinfo->ram_type, "SDR SGRAM 64");
|
|
rinfo->ram.ml = 4;
|
|
rinfo->ram.mb = 8;
|
|
rinfo->ram.trcd = 3;
|
|
rinfo->ram.trp = 3;
|
|
rinfo->ram.twr = 1;
|
|
rinfo->ram.cl = 3;
|
|
rinfo->ram.tr2w = 1;
|
|
rinfo->ram.loop_latency = 17;
|
|
rinfo->ram.rloop = 17;
|
|
|
|
break;
|
|
}
|
|
/* Bus type */
|
|
rinfo->BusCntl = INREG(BUS_CNTL);
|
|
|
|
bios_seg = radeon_find_rom(rinfo);
|
|
radeon_get_pllinfo(rinfo, bios_seg);
|
|
|
|
printk("radeonfb: ref_clk=%d, ref_div=%d, xclk=%d\n",
|
|
rinfo->pll.ref_clk, rinfo->pll.ref_div, rinfo->pll.xclk);
|
|
|
|
RTRACE("radeonfb: probed %s %dk videoram\n", (rinfo->ram_type), (rinfo->video_ram/1024));
|
|
|
|
radeon_get_moninfo(rinfo);
|
|
|
|
if((rinfo->dviDispType == MT_DFP || rinfo->dviDispType == MT_LCD ||
|
|
rinfo->crtDispType == MT_DFP))
|
|
if(!radeon_get_dfp_info(rinfo)) goto reg_err;
|
|
rinfo->fb_base = (u32) ioremap (rinfo->fb_base_phys,
|
|
rinfo->video_ram);
|
|
if (!rinfo->fb_base) {
|
|
printk ("radeonfb: cannot map FB\n");
|
|
reg_err:
|
|
iounmap ((void*)rinfo->mmio_base);
|
|
release_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2));
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* XXX turn off accel for now, blts aren't working right */
|
|
noaccel = 1;
|
|
|
|
/* set all the vital stuff */
|
|
radeon_set_fbinfo (rinfo);
|
|
|
|
/* save current mode regs before we switch into the new one
|
|
* so we can restore this upon __exit
|
|
*/
|
|
radeon_save_state (rinfo, &rinfo->init_state);
|
|
|
|
/* init palette */
|
|
for (i=0; i<16; i++) {
|
|
j = color_table[i];
|
|
rinfo->palette[i].red = default_red[j];
|
|
rinfo->palette[i].green = default_grn[j];
|
|
rinfo->palette[i].blue = default_blu[j];
|
|
}
|
|
|
|
pci_set_drvdata(pdev, rinfo);
|
|
|
|
if (register_framebuffer ((struct fb_info *) rinfo) < 0) {
|
|
printk ("radeonfb: could not register framebuffer\n");
|
|
iounmap ((void*)rinfo->fb_base);
|
|
iounmap ((void*)rinfo->mmio_base);
|
|
release_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2));
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
kfree (rinfo);
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (!noaccel) {
|
|
/* initialize the engine */
|
|
radeon_engine_init (rinfo);
|
|
}
|
|
|
|
printk ("radeonfb: ATI %s %s %d MB\n",rinfo->name,rinfo->ram_type,
|
|
(rinfo->video_ram/(1024*1024)));
|
|
if(rinfo->hasCRTC2) {
|
|
printk("radeonfb: DVI port has %s monitor connected\n",GET_MON_NAME(rinfo->dviDispType));
|
|
printk("radeonfb: CRT port has %s monitor connected\n",GET_MON_NAME(rinfo->crtDispType));
|
|
}
|
|
else
|
|
printk("radeonfb: CRT port has %s monitor connected\n",GET_MON_NAME(rinfo->crtDispType));
|
|
#ifdef CONFIG_MTRR
|
|
if (mtrr) {
|
|
rinfo->mtrr.vram = mtrr_add(rinfo->fb_base_phys,
|
|
rinfo->video_ram, MTRR_TYPE_WRCOMB, 1);
|
|
rinfo->mtrr.vram_valid = 1;
|
|
/* let there be speed */
|
|
printk("radeonfb: MTRR set to ON\n");
|
|
}
|
|
#endif /* CONFIG_MTRR */
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static void __devexit radeonfb_pci_unregister (struct pci_dev *pdev)
|
|
{
|
|
struct radeonfb_info *rinfo = pci_get_drvdata(pdev);
|
|
|
|
if (!rinfo)
|
|
return;
|
|
|
|
/* restore original state */
|
|
radeon_write_state (rinfo, &rinfo->init_state);
|
|
|
|
unregister_framebuffer ((struct fb_info *) rinfo);
|
|
#ifdef CONFIG_MTRR
|
|
if (rinfo->mtrr.vram_valid)
|
|
mtrr_del(rinfo->mtrr.vram, rinfo->fb_base_phys,
|
|
rinfo->video_ram);
|
|
#endif /* CONFIG_MTRR */
|
|
iounmap ((void*)rinfo->mmio_base);
|
|
iounmap ((void*)rinfo->fb_base);
|
|
|
|
release_mem_region (rinfo->mmio_base_phys,
|
|
pci_resource_len(pdev, 2));
|
|
release_mem_region (rinfo->fb_base_phys,
|
|
pci_resource_len(pdev, 0));
|
|
|
|
kfree (rinfo);
|
|
}
|
|
|
|
|
|
|
|
static char *radeon_find_rom(struct radeonfb_info *rinfo)
|
|
{
|
|
#if defined(__i386__)
|
|
u32 segstart;
|
|
char *rom_base;
|
|
char *rom;
|
|
int stage;
|
|
int i,j;
|
|
char aty_rom_sig[] = "761295520";
|
|
char *radeon_sig[] = {
|
|
"RG6",
|
|
"RADEON"
|
|
};
|
|
|
|
for(segstart=0x000c0000; segstart<0x000f0000; segstart+=0x00001000) {
|
|
stage = 1;
|
|
|
|
rom_base = (char *)ioremap(segstart, 0x1000);
|
|
|
|
if ((*rom_base == 0x55) && (((*(rom_base + 1)) & 0xff) == 0xaa))
|
|
stage = 2;
|
|
|
|
|
|
if (stage != 2) {
|
|
iounmap(rom_base);
|
|
continue;
|
|
}
|
|
|
|
rom = rom_base;
|
|
|
|
for (i = 0; (i < 128 - strlen(aty_rom_sig)) && (stage != 3); i++) {
|
|
if (aty_rom_sig[0] == *rom)
|
|
if (strncmp(aty_rom_sig, rom,
|
|
strlen(aty_rom_sig)) == 0)
|
|
stage = 3;
|
|
rom++;
|
|
}
|
|
if (stage != 3) {
|
|
iounmap(rom_base);
|
|
continue;
|
|
}
|
|
rom = rom_base;
|
|
|
|
for (i = 0; (i < 512) && (stage != 4); i++) {
|
|
for(j = 0;j < sizeof(radeon_sig)/sizeof(char *);j++) {
|
|
if (radeon_sig[j][0] == *rom)
|
|
if (strncmp(radeon_sig[j], rom,
|
|
strlen(radeon_sig[j])) == 0) {
|
|
stage = 4;
|
|
break;
|
|
}
|
|
}
|
|
rom++;
|
|
}
|
|
if (stage != 4) {
|
|
iounmap(rom_base);
|
|
continue;
|
|
}
|
|
|
|
return rom_base;
|
|
}
|
|
#endif
|
|
return NULL;
|
|
}
|
|
|
|
#if defined(__powerpc__)
|
|
static int radeon_read_OF (struct radeonfb_info *rinfo)
|
|
{
|
|
struct device_node *dp;
|
|
unsigned int *xtal;
|
|
|
|
dp = pci_device_to_OF_node(rinfo->pdev);
|
|
|
|
xtal = (unsigned int *) get_property(dp, "ATY,RefCLK", 0);
|
|
|
|
rinfo->pll.ref_clk = *xtal / 10;
|
|
|
|
if (*xtal)
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static void radeon_get_pllinfo(struct radeonfb_info *rinfo, char *bios_seg)
|
|
{
|
|
void *bios_header;
|
|
void *header_ptr;
|
|
u16 bios_header_offset, pll_info_offset;
|
|
PLL_BLOCK pll;
|
|
|
|
if (bios_seg) {
|
|
bios_header = bios_seg + 0x48L;
|
|
header_ptr = bios_header;
|
|
|
|
bios_header_offset = readw(header_ptr);
|
|
bios_header = bios_seg + bios_header_offset;
|
|
bios_header += 0x30;
|
|
|
|
header_ptr = bios_header;
|
|
pll_info_offset = readw(header_ptr);
|
|
header_ptr = bios_seg + pll_info_offset;
|
|
|
|
memcpy_fromio(&pll, header_ptr, 50);
|
|
|
|
rinfo->pll.xclk = (u32)pll.XCLK;
|
|
rinfo->pll.ref_clk = (u32)pll.PCLK_ref_freq;
|
|
rinfo->pll.ref_div = (u32)pll.PCLK_ref_divider;
|
|
rinfo->pll.ppll_min = pll.PCLK_min_freq;
|
|
rinfo->pll.ppll_max = pll.PCLK_max_freq;
|
|
} else {
|
|
#if defined(__powerpc__)
|
|
if (radeon_read_OF(rinfo)) {
|
|
unsigned int tmp, Nx, M, ref_div, xclk;
|
|
|
|
tmp = INPLL(M_SPLL_REF_FB_DIV);
|
|
ref_div = INPLL(PPLL_REF_DIV) & 0x3ff;
|
|
|
|
Nx = (tmp & 0xff00) >> 8;
|
|
M = (tmp & 0xff);
|
|
xclk = ((((2 * Nx * rinfo->pll.ref_clk) + (M)) /
|
|
(2 * M)));
|
|
|
|
rinfo->pll.xclk = xclk;
|
|
rinfo->pll.ref_div = ref_div;
|
|
rinfo->pll.ppll_min = 12000;
|
|
rinfo->pll.ppll_max = 35000;
|
|
|
|
printk("radeonfb: ref_clk=%d, ref_div=%d, xclk=%d from OF\n",
|
|
rinfo->pll.ref_clk, rinfo->pll.ref_div, rinfo->pll.xclk);
|
|
|
|
return;
|
|
}
|
|
#endif
|
|
/* no BIOS or BIOS not found, use defaults */
|
|
|
|
switch (rinfo->chipset) {
|
|
case PCI_DEVICE_ID_RV200_QW:
|
|
rinfo->pll.ppll_max = 35000;
|
|
rinfo->pll.ppll_min = 12000;
|
|
rinfo->pll.xclk = 23000;
|
|
rinfo->pll.ref_div = 12;
|
|
rinfo->pll.ref_clk = 2700;
|
|
break;
|
|
case PCI_DEVICE_ID_R200_QL:
|
|
rinfo->pll.ppll_max = 35000;
|
|
rinfo->pll.ppll_min = 12000;
|
|
rinfo->pll.xclk = 27500;
|
|
rinfo->pll.ref_div = 12;
|
|
rinfo->pll.ref_clk = 2700;
|
|
break;
|
|
case PCI_DEVICE_ID_RADEON_QD:
|
|
case PCI_DEVICE_ID_RADEON_QE:
|
|
case PCI_DEVICE_ID_RADEON_QF:
|
|
case PCI_DEVICE_ID_RADEON_QG:
|
|
default:
|
|
rinfo->pll.ppll_max = 35000;
|
|
rinfo->pll.ppll_min = 12000;
|
|
rinfo->pll.xclk = 16600;
|
|
rinfo->pll.ref_div = 67;
|
|
rinfo->pll.ref_clk = 2700;
|
|
};
|
|
}
|
|
}
|
|
|
|
static void radeon_init_common_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_init_common_regs is called\n");
|
|
save->ovr_clr = 0;
|
|
save->ovr_wid_left_right= 0;
|
|
save->ovr_wid_top_bottom= 0;
|
|
save->ov0_scale_cntl = 0;
|
|
save->mpp_tb_config = 0;
|
|
save->mpp_gp_config = 0;
|
|
save->subpic_cntl = 0;
|
|
save->i2c_cntl_1 = 0;
|
|
save->rbbm_soft_reset = 0;
|
|
save->cap0_trig_cntl = 0;
|
|
save->cap1_trig_cntl = 0;
|
|
save->bus_cntl = rinfo->BusCntl;
|
|
/*
|
|
* If bursts are enabled, turn on discards
|
|
* Radeon doesn't have write bursts
|
|
*/
|
|
if (save->bus_cntl & (BUS_READ_BURST))
|
|
save->bus_cntl |= BUS_RD_DISCARD_EN;
|
|
}
|
|
|
|
static int radeon_init_crtc_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
int hTotal, vTotal, hSyncStart, hSyncEnd,
|
|
vSyncStart, vSyncEnd, cSync;
|
|
u8 hsync_adj_tab[] = {0, 0x12, 9, 9, 6, 5};
|
|
u8 hsync_fudge_fp[] = { 2, 2, 0, 0, 5, 5 };
|
|
u32 sync;
|
|
int format = 0;
|
|
int hsync_start, hsync_fudge, bytpp, hsync_wid, vsync_wid;
|
|
int prim_mon;
|
|
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
|
|
rinfo->xres = mode->xres;
|
|
rinfo->yres = mode->yres;
|
|
rinfo->pixclock = mode->pixclock;
|
|
|
|
hSyncStart = mode->xres + mode->right_margin;
|
|
hSyncEnd = hSyncStart + mode->hsync_len;
|
|
hTotal = hSyncEnd + mode->left_margin;
|
|
|
|
vSyncStart = mode->yres + mode->lower_margin;
|
|
vSyncEnd = vSyncStart + mode->vsync_len;
|
|
vTotal = vSyncEnd + mode->upper_margin;
|
|
|
|
if(((prim_mon == MT_DFP) || (prim_mon == MT_LCD)))
|
|
{
|
|
if(rinfo->PanelXRes < mode->xres)
|
|
rinfo->xres = mode->xres = rinfo->PanelXRes;
|
|
if(rinfo->PanelYRes < mode->yres)
|
|
rinfo->yres = mode->yres = rinfo->PanelYRes;
|
|
hTotal = mode->xres + rinfo->HBlank + mode->left_margin;
|
|
hSyncStart = mode->xres + rinfo->HOverPlus + mode->right_margin;
|
|
hSyncEnd = hSyncStart + rinfo->HSyncWidth + mode->hsync_len;
|
|
vTotal = mode->yres + rinfo->VBlank + mode->upper_margin;
|
|
vSyncStart = mode->yres + rinfo->VOverPlus + mode->lower_margin;
|
|
vSyncEnd = vSyncStart + rinfo->VSyncWidth + mode->vsync_len;
|
|
}
|
|
|
|
sync = mode->sync;
|
|
|
|
RTRACE("hStart = %d, hEnd = %d, hTotal = %d\n",
|
|
hSyncStart, hSyncEnd, hTotal);
|
|
RTRACE("vStart = %d, vEnd = %d, vTotal = %d\n",
|
|
vSyncStart, vSyncEnd, vTotal);
|
|
|
|
hsync_wid = (hSyncEnd - hSyncStart) / 8;
|
|
vsync_wid = vSyncEnd - vSyncStart;
|
|
if (hsync_wid == 0)
|
|
hsync_wid = 1;
|
|
else if (hsync_wid > 0x3f) /* max */
|
|
hsync_wid = 0x3f;
|
|
vsync_wid = mode->vsync_len;
|
|
if (vsync_wid == 0)
|
|
vsync_wid = 1;
|
|
else if (vsync_wid > 0x1f) /* max */
|
|
vsync_wid = 0x1f;
|
|
|
|
cSync = mode->sync & FB_SYNC_COMP_HIGH_ACT ? (1 << 4) : 0;
|
|
|
|
switch (mode->bits_per_pixel) {
|
|
case 8:
|
|
format = DST_8BPP;
|
|
bytpp = 1;
|
|
break;
|
|
case 16:
|
|
format = DST_16BPP;
|
|
bytpp = 2;
|
|
break;
|
|
case 24:
|
|
format = DST_24BPP;
|
|
bytpp = 3;
|
|
break;
|
|
case 32:
|
|
format = DST_32BPP;
|
|
bytpp = 4;
|
|
break;
|
|
default:
|
|
printk("radeonfb: Unsupported pixel depth (%d)\n", mode->bits_per_pixel);
|
|
return 0;
|
|
}
|
|
|
|
if ((prim_mon == MT_DFP) || (prim_mon == MT_LCD))
|
|
hsync_fudge = hsync_fudge_fp[format-1];
|
|
else
|
|
hsync_fudge = hsync_adj_tab[format-1];
|
|
|
|
hsync_start = hSyncStart - 8 + hsync_fudge;
|
|
save->crtc_gen_cntl = (CRTC_EXT_DISP_EN
|
|
| CRTC_EN
|
|
| (format << 8)
|
|
/* | CRTC_DBL_SCAN_EN*/);
|
|
|
|
if((prim_mon == MT_DFP) || (prim_mon == MT_LCD)) {
|
|
save->crtc_ext_cntl = VGA_ATI_LINEAR |
|
|
XCRT_CNT_EN;
|
|
save->crtc_gen_cntl &= ~(CRTC_DBL_SCAN_EN |
|
|
CRTC_INTERLACE_EN);
|
|
}
|
|
else
|
|
save->crtc_ext_cntl = VGA_ATI_LINEAR |
|
|
XCRT_CNT_EN |
|
|
CRTC_CRT_ON;
|
|
|
|
save->dac_cntl = (DAC_MASK_ALL
|
|
| DAC_VGA_ADR_EN
|
|
| DAC_8BIT_EN);
|
|
|
|
save->crtc_h_total_disp = ((((hTotal / 8) - 1) & 0x3ff) |
|
|
((((mode->xres / 8) - 1) & 0x1ff) << 16));
|
|
|
|
save->crtc_v_total_disp = ((vTotal - 1) & 0xffff) |
|
|
((mode->yres - 1) << 16);
|
|
|
|
save->crtc_h_sync_strt_wid = ((hsync_start & 0x1fff)
|
|
| (hsync_wid << 16)
|
|
| (mode->sync & FB_SYNC_HOR_HIGH_ACT ? 0
|
|
: CRTC_H_SYNC_POL));
|
|
|
|
save->crtc_v_sync_strt_wid = (((vSyncStart - 1) & 0xfff)
|
|
| (vsync_wid << 16)
|
|
| (mode->sync & FB_SYNC_VERT_HIGH_ACT ? 0
|
|
: CRTC_V_SYNC_POL));
|
|
|
|
save->crtc_pitch = ((mode->xres * bytpp) +
|
|
((mode->bits_per_pixel) - 1)) /
|
|
(mode->bits_per_pixel);
|
|
save->crtc_pitch |= save->crtc_pitch<<16;
|
|
|
|
#if defined(__BIG_ENDIAN)
|
|
save->surface_cntl = SURF_TRANSLATION_DIS;
|
|
switch (mode->bits_per_pixel) {
|
|
case 16:
|
|
save->surface_cntl |= NONSURF_AP0_SWP_16BPP;
|
|
break;
|
|
case 24:
|
|
case 32:
|
|
save->surface_cntl |= NONSURF_AP0_SWP_32BPP;
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
rinfo->pitch = ((mode->xres * ((mode->bits_per_pixel + 1) / 8) + 0x3f)
|
|
& ~(0x3f)) / 64;
|
|
|
|
RTRACE("h_total_disp = 0x%x\t hsync_strt_wid = 0x%x\n",
|
|
save->crtc_h_total_disp, save->crtc_h_sync_strt_wid);
|
|
RTRACE("v_total_disp = 0x%x\t vsync_strt_wid = 0x%x\n",
|
|
save->crtc_v_total_disp, save->crtc_v_sync_strt_wid);
|
|
|
|
save->xres = mode->xres;
|
|
save->yres = mode->yres;
|
|
|
|
save->crtc_offset = 0;
|
|
save->crtc_offset_cntl = 0;
|
|
|
|
rinfo->bpp = mode->bits_per_pixel;
|
|
return 1;
|
|
}
|
|
|
|
static int radeon_init_crtc2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
int format;
|
|
int hsync_start;
|
|
int hsync_wid;
|
|
int hsync_fudge;
|
|
int vsync_wid;
|
|
int bytpp;
|
|
int hsync_fudge_default[] = { 0x00, 0x12, 0x09, 0x09, 0x06, 0x05 };
|
|
int hTotal, vTotal, hSyncStart, hSyncEnd;
|
|
int vSyncStart, vSyncEnd;
|
|
RTRACE("radeonfb: radeon_init_crtc2_regs is called\n");
|
|
|
|
switch (mode->bits_per_pixel) {
|
|
case 8: format = 2; bytpp = 1; break;
|
|
case 16: format = 4; bytpp = 2; break; /* 565 */
|
|
case 24: format = 5; bytpp = 3; break; /* RGB */
|
|
case 32: format = 6; bytpp = 4; break; /* xRGB */
|
|
default:
|
|
printk("radeonfb: Unsupported pixel depth (%d)\n", mode->bits_per_pixel);
|
|
return 0;
|
|
}
|
|
|
|
hsync_fudge = hsync_fudge_default[format-1];
|
|
|
|
save->crtc2_gen_cntl = (CRTC2_EN
|
|
| CRTC2_CRT2_ON
|
|
| (format << 8)
|
|
/*| CRTC2_DBL_SCAN_EN*/);
|
|
|
|
if(!rinfo->isM7)
|
|
save->dac2_cntl = rinfo->init_state.dac2_cntl
|
|
/*| DAC2_DAC2_CLK_SEL*/
|
|
| DAC2_DAC_CLK_SEL;
|
|
else
|
|
{
|
|
save->disp_output_cntl =
|
|
((rinfo->init_state.disp_output_cntl &
|
|
(u32)~DISP_DAC_SOURCE_MASK)
|
|
| DISP_DAC_SOURCE_CRTC2);
|
|
}
|
|
|
|
hSyncStart = mode->xres + mode->right_margin;
|
|
hSyncEnd = hSyncStart + mode->hsync_len;
|
|
hTotal = hSyncEnd + mode->left_margin;
|
|
|
|
vSyncStart = mode->yres + mode->lower_margin;
|
|
vSyncEnd = vSyncStart + mode->vsync_len;
|
|
vTotal = vSyncEnd + mode->upper_margin;
|
|
|
|
save->crtc2_h_total_disp = ((((hTotal / 8) - 1) & 0x3ff)
|
|
| ((((mode->xres / 8) - 1) & 0x1ff) << 16));
|
|
|
|
hsync_wid = (hSyncEnd - hSyncStart) / 8;
|
|
if (!hsync_wid) hsync_wid = 1;
|
|
if (hsync_wid > 0x3f) hsync_wid = 0x3f;
|
|
hsync_start = hSyncStart - 8 + hsync_fudge;
|
|
|
|
save->crtc2_h_sync_strt_wid = ((hsync_start & 0x1fff)
|
|
| (hsync_wid << 16)
|
|
| ((mode->sync & FB_SYNC_HOR_HIGH_ACT)
|
|
? 0
|
|
: CRTC_H_SYNC_POL));
|
|
|
|
/* This works for double scan mode. */
|
|
save->crtc2_v_total_disp = (((vTotal - 1) & 0xffff)
|
|
| ((mode->yres - 1) << 16));
|
|
|
|
vsync_wid = vSyncEnd - vSyncStart;
|
|
if (!vsync_wid) vsync_wid = 1;
|
|
if (vsync_wid > 0x1f) vsync_wid = 0x1f;
|
|
|
|
save->crtc2_v_sync_strt_wid = (((vSyncStart - 1) & 0xfff)
|
|
| (vsync_wid << 16)
|
|
| ((mode->sync & FB_SYNC_VERT_HIGH_ACT)
|
|
? 0
|
|
: CRTC2_V_SYNC_POL));
|
|
|
|
save->crtc2_offset = 0;
|
|
save->crtc2_offset_cntl = 0;
|
|
|
|
save->crtc2_pitch = ((mode->xres * bytpp) +
|
|
((mode->bits_per_pixel) -1)) /
|
|
(mode->bits_per_pixel);
|
|
save->crtc2_pitch |= save->crtc2_pitch << 16;
|
|
|
|
RTRACE("radeonfb: radeon_init_crtc2_regs returns SUCCESS\n");
|
|
return 1;
|
|
}
|
|
|
|
static void radeon_init_fp_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
float Hratio, Vratio;
|
|
int prim_mon;
|
|
RTRACE("radeonfb: radeon_init_fp_regs is called\n");
|
|
if(rinfo->PanelXRes == 0 || rinfo->PanelYRes == 0)
|
|
{
|
|
Hratio = 1;
|
|
Vratio = 1;
|
|
}
|
|
else
|
|
{
|
|
if (mode->xres > rinfo->PanelXRes) mode->xres = rinfo->PanelXRes;
|
|
if (mode->yres > rinfo->PanelYRes) mode->yres = rinfo->PanelYRes;
|
|
|
|
Hratio = (float)mode->xres/(float)rinfo->PanelXRes;
|
|
Vratio = (float)mode->yres/(float)rinfo->PanelYRes;
|
|
}
|
|
|
|
if (Hratio == 1.0)
|
|
{
|
|
save->fp_horz_stretch = rinfo->init_state.fp_horz_stretch;
|
|
save->fp_horz_stretch &= ~(HORZ_STRETCH_BLEND |
|
|
HORZ_STRETCH_ENABLE);
|
|
}
|
|
else
|
|
{
|
|
save->fp_horz_stretch =
|
|
((((unsigned long)(Hratio * HORZ_STRETCH_RATIO_MAX +
|
|
0.5)) & HORZ_STRETCH_RATIO_MASK)) |
|
|
(rinfo->init_state.fp_horz_stretch & (HORZ_PANEL_SIZE |
|
|
HORZ_FP_LOOP_STRETCH |
|
|
HORZ_AUTO_RATIO_INC));
|
|
save->fp_horz_stretch |= (HORZ_STRETCH_BLEND |
|
|
HORZ_STRETCH_ENABLE);
|
|
}
|
|
save->fp_horz_stretch &= ~HORZ_AUTO_RATIO;
|
|
|
|
if (Vratio == 1.0)
|
|
{
|
|
save->fp_vert_stretch = rinfo->init_state.fp_vert_stretch;
|
|
save->fp_vert_stretch &= ~(VERT_STRETCH_ENABLE|
|
|
VERT_STRETCH_BLEND);
|
|
}
|
|
else
|
|
{
|
|
save->fp_vert_stretch =
|
|
(((((unsigned long)(Vratio * VERT_STRETCH_RATIO_MAX +
|
|
0.5)) & VERT_STRETCH_RATIO_MASK)) |
|
|
(rinfo->init_state.fp_vert_stretch & (VERT_PANEL_SIZE |
|
|
VERT_STRETCH_RESERVED)));
|
|
save->fp_vert_stretch |= (VERT_STRETCH_ENABLE |
|
|
VERT_STRETCH_BLEND);
|
|
}
|
|
save->fp_vert_stretch &= ~VERT_AUTO_RATIO_EN;
|
|
|
|
save->fp_gen_cntl = (rinfo->init_state.fp_gen_cntl & (u32)
|
|
~(FP_SEL_CRTC2 |
|
|
FP_RMX_HVSYNC_CONTROL_EN |
|
|
FP_DFP_SYNC_SEL |
|
|
FP_CRT_SYNC_SEL |
|
|
FP_CRTC_LOCK_8DOT |
|
|
FP_USE_SHADOW_EN |
|
|
FP_CRTC_USE_SHADOW_VEND |
|
|
FP_CRT_SYNC_ALT));
|
|
save->fp_gen_cntl |= (FP_CRTC_DONT_SHADOW_VPAR |
|
|
FP_CRTC_DONT_SHADOW_HEND );
|
|
|
|
save->lvds_gen_cntl = rinfo->init_state.lvds_gen_cntl;
|
|
save->lvds_pll_cntl = rinfo->init_state.lvds_pll_cntl;
|
|
save->tmds_crc = rinfo->init_state.tmds_crc;
|
|
|
|
/* Disable CRT output by disabling CRT output for DFP*/
|
|
save->crtc_ext_cntl &= ~CRTC_CRT_ON;
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
if(prim_mon == MT_LCD)
|
|
{
|
|
save->lvds_gen_cntl |= (LVDS_ON | LVDS_BLON);
|
|
save->fp_gen_cntl &= ~(FP_FPON | FP_TMDS_EN);
|
|
}
|
|
else if(prim_mon == MT_DFP)
|
|
save->fp_gen_cntl |= (FP_FPON | FP_TMDS_EN);
|
|
|
|
save->fp_crtc_h_total_disp = rinfo->init_state.fp_crtc_h_total_disp;
|
|
save->fp_crtc_v_total_disp = rinfo->init_state.fp_crtc_v_total_disp;
|
|
save->fp_h_sync_strt_wid = rinfo->init_state.fp_h_sync_strt_wid;
|
|
save->fp_v_sync_strt_wid = rinfo->init_state.fp_v_sync_strt_wid;
|
|
}
|
|
|
|
static void radeon_init_pll_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
u32 dot_clock = 1000000000 / mode->pixclock;
|
|
u32 freq = dot_clock / 10; /* x 100 */
|
|
struct {
|
|
int divider;
|
|
int bitvalue;
|
|
} *post_div, post_divs[] = {
|
|
{ 1, 0 },
|
|
{ 2, 1 },
|
|
{ 4, 2 },
|
|
{ 8, 3 },
|
|
{ 3, 4 },
|
|
{ 16, 5 },
|
|
{ 6, 6 },
|
|
{ 12, 7 },
|
|
{ 0, 0 },
|
|
};
|
|
if (freq > rinfo->pll.ppll_max) freq = rinfo->pll.ppll_max;
|
|
if (freq*12 < rinfo->pll.ppll_min) freq = rinfo->pll.ppll_min / 12;
|
|
|
|
for (post_div = &post_divs[0]; post_div->divider; ++post_div) {
|
|
rinfo->pll_output_freq = post_div->divider * freq;
|
|
if (rinfo->pll_output_freq >= rinfo->pll.ppll_min &&
|
|
rinfo->pll_output_freq <= rinfo->pll.ppll_max) break;
|
|
}
|
|
|
|
rinfo->post_div = post_div->divider;
|
|
rinfo->fb_div = round_div(rinfo->pll.ref_div*rinfo->pll_output_freq,
|
|
rinfo->pll.ref_clk);
|
|
save->ppll_ref_div = rinfo->pll.ref_div;
|
|
save->ppll_div_3 = rinfo->fb_div | (post_div->bitvalue << 16);
|
|
save->htotal_cntl = 0;
|
|
|
|
RTRACE("post div = 0x%x\n", rinfo->post_div);
|
|
RTRACE("fb_div = 0x%x\n", rinfo->fb_div);
|
|
RTRACE("ppll_div_3 = 0x%x\n", save->ppll_div_3);
|
|
}
|
|
|
|
static void radeon_init_pll2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
u32 dot_clock = 1000000000 / mode->pixclock;
|
|
u32 freq = dot_clock * 100;
|
|
struct {
|
|
int divider;
|
|
int bitvalue;
|
|
} *post_div,
|
|
post_divs[] = {
|
|
/* From RAGE 128 VR/RAGE 128 GL Register
|
|
Reference Manual (Technical Reference
|
|
Manual P/N RRG-G04100-C Rev. 0.04), page
|
|
3-17 (PLL_DIV_[3:0]). */
|
|
{ 1, 0 }, /* VCLK_SRC */
|
|
{ 2, 1 }, /* VCLK_SRC/2 */
|
|
{ 4, 2 }, /* VCLK_SRC/4 */
|
|
{ 8, 3 }, /* VCLK_SRC/8 */
|
|
{ 3, 4 }, /* VCLK_SRC/3 */
|
|
{ 16, 5 }, /* VCLK_SRC/16 */
|
|
{ 6, 6 }, /* VCLK_SRC/6 */
|
|
{ 12, 7 }, /* VCLK_SRC/12 */
|
|
{ 0, 0 }
|
|
};
|
|
RTRACE("radeonfb: radeon_init_pll2_regs is called\n");
|
|
|
|
if (freq > rinfo->pll.ppll_max) freq = rinfo->pll.ppll_max;
|
|
if (freq*12 < rinfo->pll.ppll_min) freq = rinfo->pll.ppll_min/12;
|
|
|
|
for (post_div = &post_divs[0]; post_div->divider; ++post_div) {
|
|
save->pll_output_freq_2 = post_div->divider * freq;
|
|
if (save->pll_output_freq_2 >= rinfo->pll.ppll_min
|
|
&& save->pll_output_freq_2 <= rinfo->pll.ppll_max) break;
|
|
}
|
|
|
|
save->dot_clock_freq_2 = freq;
|
|
save->feedback_div_2 = round_div(rinfo->pll.ref_div
|
|
* save->pll_output_freq_2,
|
|
rinfo->pll.ref_clk);
|
|
save->post_div_2 = post_div->divider;
|
|
|
|
save->p2pll_ref_div = rinfo->pll.ref_div;
|
|
save->p2pll_div_0 = (save->feedback_div_2 | (post_div->bitvalue<<16));
|
|
save->htotal_cntl2 = 0;
|
|
}
|
|
|
|
static int radeon_init_dda_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
int xclk_freq, vclk_freq, xclk_per_trans, xclk_per_trans_precise;
|
|
int useable_precision, roff, ron;
|
|
int min_bits;
|
|
const int DispFifoWidth=128,DispFifoDepth=32;
|
|
/* DDA */
|
|
vclk_freq = round_div(rinfo->pll.ref_clk * rinfo->fb_div,
|
|
rinfo->pll.ref_div * rinfo->post_div);
|
|
xclk_freq = rinfo->pll.xclk;
|
|
|
|
xclk_per_trans = round_div(xclk_freq * DispFifoWidth,
|
|
vclk_freq * mode->bits_per_pixel);
|
|
|
|
min_bits = min_bits_req(xclk_per_trans);
|
|
useable_precision = min_bits + 1;
|
|
|
|
xclk_per_trans_precise = round_div((xclk_freq * DispFifoWidth)
|
|
<< (11 - useable_precision),
|
|
vclk_freq * mode->bits_per_pixel);
|
|
|
|
ron = (4 * rinfo->ram.mb +
|
|
3 * _max(rinfo->ram.trcd - 2, 0) +
|
|
2 * rinfo->ram.trp +
|
|
rinfo->ram.twr +
|
|
rinfo->ram.cl +
|
|
rinfo->ram.tr2w +
|
|
xclk_per_trans) << (11 - useable_precision);
|
|
roff = xclk_per_trans_precise * (DispFifoDepth - 4);
|
|
|
|
RTRACE("ron = %d, roff = %d\n", ron, roff);
|
|
RTRACE("vclk_freq = %d, per = %d\n", vclk_freq, xclk_per_trans_precise);
|
|
|
|
if ((ron + rinfo->ram.rloop) >= roff) {
|
|
printk("radeonfb: error ron out of range\n");
|
|
return -1;
|
|
}
|
|
|
|
save->dda_config = (xclk_per_trans_precise |
|
|
(useable_precision << 16) |
|
|
(rinfo->ram.rloop << 20));
|
|
save->dda_on_off = (ron << 16) | roff;
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
static void radeon_init_palette(struct radeon_regs *save)
|
|
{
|
|
save->palette_valid = 0;
|
|
}
|
|
*/
|
|
|
|
static int radeon_init_mode(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
int prim_mon;
|
|
RTRACE("radeonfb: radeon_init_mode is called\n");
|
|
if(DUAL_MONITOR(rinfo))
|
|
{
|
|
if (!radeon_init_crtc2_regs(rinfo, save, mode))
|
|
return 0;
|
|
radeon_init_pll2_regs(rinfo, save, mode);
|
|
}
|
|
radeon_init_common_regs(rinfo, save);
|
|
if(!radeon_init_crtc_regs(rinfo, save, mode))
|
|
return 0;
|
|
if(mode->pixclock)
|
|
{
|
|
radeon_init_pll_regs(rinfo, save, mode);
|
|
if (!radeon_init_dda_regs(rinfo, save, mode))
|
|
return 0;
|
|
}
|
|
else
|
|
{
|
|
save->ppll_ref_div = rinfo->init_state.ppll_ref_div;
|
|
save->ppll_div_3 = rinfo->init_state.ppll_div_3;
|
|
save->htotal_cntl = rinfo->init_state.htotal_cntl;
|
|
save->dda_config = rinfo->init_state.dda_config;
|
|
save->dda_on_off = rinfo->init_state.dda_on_off;
|
|
}
|
|
/* radeon_init_palete here */
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
if (((prim_mon == MT_DFP) || (prim_mon == MT_LCD)))
|
|
{
|
|
radeon_init_fp_regs(rinfo, save, mode);
|
|
}
|
|
|
|
RTRACE("radeonfb: radeon_init_mode returns SUCCESS\n");
|
|
return 1;
|
|
}
|
|
|
|
static void radeon_engine_init (struct radeonfb_info *rinfo)
|
|
{
|
|
u32 temp;
|
|
|
|
/* disable 3D engine */
|
|
OUTREG(RB3D_CNTL, 0);
|
|
|
|
radeon_engine_reset ();
|
|
|
|
radeon_fifo_wait (1);
|
|
OUTREG(DSTCACHE_MODE, 0);
|
|
|
|
/* XXX */
|
|
rinfo->pitch = ((rinfo->xres * (rinfo->depth / 8) + 0x3f)) >> 6;
|
|
|
|
radeon_fifo_wait (1);
|
|
temp = INREG(DEFAULT_PITCH_OFFSET);
|
|
OUTREG(DEFAULT_PITCH_OFFSET, ((temp & 0xc0000000) |
|
|
(rinfo->pitch << 0x16)));
|
|
|
|
radeon_fifo_wait (1);
|
|
OUTREGP(DP_DATATYPE, 0, ~HOST_BIG_ENDIAN_EN);
|
|
|
|
radeon_fifo_wait (1);
|
|
OUTREG(DEFAULT_SC_BOTTOM_RIGHT, (DEFAULT_SC_RIGHT_MAX |
|
|
DEFAULT_SC_BOTTOM_MAX));
|
|
|
|
temp = radeon_get_dstbpp(rinfo->depth);
|
|
rinfo->dp_gui_master_cntl = ((temp << 8) | GMC_CLR_CMP_CNTL_DIS);
|
|
radeon_fifo_wait (1);
|
|
OUTREG(DP_GUI_MASTER_CNTL, (rinfo->dp_gui_master_cntl |
|
|
GMC_BRUSH_SOLID_COLOR |
|
|
GMC_SRC_DATATYPE_COLOR));
|
|
|
|
radeon_fifo_wait (7);
|
|
|
|
/* clear line drawing regs */
|
|
OUTREG(DST_LINE_START, 0);
|
|
OUTREG(DST_LINE_END, 0);
|
|
|
|
/* set brush color regs */
|
|
OUTREG(DP_BRUSH_FRGD_CLR, 0xffffffff);
|
|
OUTREG(DP_BRUSH_BKGD_CLR, 0x00000000);
|
|
|
|
/* set source color regs */
|
|
OUTREG(DP_SRC_FRGD_CLR, 0xffffffff);
|
|
OUTREG(DP_SRC_BKGD_CLR, 0x00000000);
|
|
|
|
/* default write mask */
|
|
OUTREG(DP_WRITE_MSK, 0xffffffff);
|
|
|
|
radeon_engine_idle ();
|
|
}
|
|
|
|
|
|
|
|
static int __devinit radeon_set_fbinfo (struct radeonfb_info *rinfo)
|
|
{
|
|
struct fb_info *info;
|
|
|
|
info = &rinfo->info;
|
|
|
|
strcpy (info->modename, rinfo->name);
|
|
info->node = -1;
|
|
info->flags = FBINFO_FLAG_DEFAULT;
|
|
info->fbops = &radeon_fb_ops;
|
|
info->display_fg = NULL;
|
|
strncpy (info->fontname, fontname, sizeof (info->fontname));
|
|
info->fontname[sizeof (info->fontname) - 1] = 0;
|
|
info->changevar = NULL;
|
|
info->switch_con = radeonfb_switch;
|
|
info->updatevar = radeonfb_updatevar;
|
|
info->blank = radeonfb_blank;
|
|
|
|
if (radeon_init_disp (rinfo) < 0)
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int __devinit radeon_init_disp (struct radeonfb_info *rinfo)
|
|
{
|
|
struct fb_info *info;
|
|
struct display *disp;
|
|
|
|
info = &rinfo->info;
|
|
disp = &rinfo->disp;
|
|
|
|
disp->var = radeonfb_default_var;
|
|
info->disp = disp;
|
|
|
|
radeon_set_dispsw (rinfo, disp);
|
|
|
|
if (noaccel)
|
|
disp->scrollmode = SCROLL_YREDRAW;
|
|
else
|
|
disp->scrollmode = 0;
|
|
|
|
rinfo->currcon_display = disp;
|
|
|
|
if ((radeon_init_disp_var (rinfo)) < 0)
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeon_init_disp_var (struct radeonfb_info *rinfo)
|
|
{
|
|
#ifndef MODULE
|
|
if (mode_option)
|
|
fb_find_mode (&rinfo->disp.var, &rinfo->info, mode_option,
|
|
NULL, 0, NULL, 8);
|
|
else
|
|
#endif
|
|
fb_find_mode (&rinfo->disp.var, &rinfo->info, "640x480-8@60",
|
|
NULL, 0, NULL, 0);
|
|
|
|
if (noaccel)
|
|
rinfo->disp.var.accel_flags &= ~FB_ACCELF_TEXT;
|
|
else
|
|
rinfo->disp.var.accel_flags |= FB_ACCELF_TEXT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void radeon_set_dispsw (struct radeonfb_info *rinfo, struct display *disp)
|
|
{
|
|
int accel;
|
|
|
|
accel = disp->var.accel_flags & FB_ACCELF_TEXT;
|
|
|
|
disp->dispsw_data = NULL;
|
|
|
|
disp->screen_base = (char*)rinfo->fb_base;
|
|
disp->type = FB_TYPE_PACKED_PIXELS;
|
|
disp->type_aux = 0;
|
|
disp->ypanstep = 1;
|
|
disp->ywrapstep = 0;
|
|
disp->can_soft_blank = 1;
|
|
disp->inverse = 0;
|
|
|
|
rinfo->depth = disp->var.bits_per_pixel;
|
|
switch (disp->var.bits_per_pixel) {
|
|
#ifdef FBCON_HAS_CFB8
|
|
case 8:
|
|
disp->dispsw = &fbcon_cfb8;
|
|
disp->visual = FB_VISUAL_PSEUDOCOLOR;
|
|
disp->line_length = disp->var.xres_virtual;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB16
|
|
case 16:
|
|
disp->dispsw = &fbcon_cfb16;
|
|
disp->dispsw_data = &rinfo->con_cmap.cfb16;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
disp->line_length = disp->var.xres_virtual * 2;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB24
|
|
case 24:
|
|
disp->dispsw = &fbcon_cfb24;
|
|
disp->dispsw_data = &rinfo->con_cmap.cfb24;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
disp->line_length = disp->var.xres_virtual * 4;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB32
|
|
case 32:
|
|
disp->dispsw = &fbcon_cfb32;
|
|
disp->dispsw_data = &rinfo->con_cmap.cfb32;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
disp->line_length = disp->var.xres_virtual * 4;
|
|
break;
|
|
#endif
|
|
default:
|
|
printk ("radeonfb: setting fbcon_dummy renderer\n");
|
|
disp->dispsw = &fbcon_dummy;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* fb ops
|
|
*/
|
|
|
|
static int radeonfb_get_fix (struct fb_fix_screeninfo *fix, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
struct display *disp;
|
|
|
|
disp = (con < 0) ? rinfo->info.disp : &fb_display[con];
|
|
|
|
memset (fix, 0, sizeof (struct fb_fix_screeninfo));
|
|
strcpy (fix->id, rinfo->name);
|
|
|
|
fix->smem_start = rinfo->fb_base_phys;
|
|
fix->smem_len = rinfo->video_ram;
|
|
|
|
fix->type = disp->type;
|
|
fix->type_aux = disp->type_aux;
|
|
fix->visual = disp->visual;
|
|
|
|
fix->xpanstep = 1;
|
|
fix->ypanstep = 1;
|
|
fix->ywrapstep = 0;
|
|
|
|
fix->line_length = disp->line_length;
|
|
|
|
fix->mmio_start = rinfo->mmio_base_phys;
|
|
fix->mmio_len = RADEON_REGSIZE;
|
|
if (noaccel)
|
|
fix->accel = FB_ACCEL_NONE;
|
|
else
|
|
fix->accel = 40; /* XXX */
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_get_var (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
|
|
*var = (con < 0) ? rinfo->disp.var : fb_display[con].var;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_set_var (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
struct display *disp;
|
|
struct fb_var_screeninfo v;
|
|
int nom, den, accel, err;
|
|
unsigned chgvar = 0;
|
|
|
|
disp = (con < 0) ? rinfo->info.disp : &fb_display[con];
|
|
|
|
accel = var->accel_flags & FB_ACCELF_TEXT;
|
|
|
|
if (con >= 0) {
|
|
chgvar = ((disp->var.xres != var->xres) ||
|
|
(disp->var.yres != var->yres) ||
|
|
(disp->var.xres_virtual != var->xres_virtual) ||
|
|
(disp->var.yres_virtual != var->yres_virtual) ||
|
|
(disp->var.bits_per_pixel != var->bits_per_pixel) ||
|
|
memcmp (&disp->var.red, &var->red, sizeof (var->red)) ||
|
|
memcmp (&disp->var.green, &var->green, sizeof (var->green)) ||
|
|
memcmp (&disp->var.blue, &var->blue, sizeof (var->blue)));
|
|
}
|
|
|
|
memcpy (&v, var, sizeof (v));
|
|
|
|
switch (v.bits_per_pixel) {
|
|
#ifdef FBCON_HAS_CFB8
|
|
case 8:
|
|
nom = den = 1;
|
|
disp->line_length = v.xres_virtual;
|
|
disp->visual = FB_VISUAL_PSEUDOCOLOR;
|
|
v.red.offset = v.green.offset = v.blue.offset = 0;
|
|
v.red.length = v.green.length = v.blue.length = 8;
|
|
v.transp.offset = v.transp.length = 0;
|
|
break;
|
|
#endif
|
|
|
|
#ifdef FBCON_HAS_CFB16
|
|
case 16:
|
|
nom = 2;
|
|
den = 1;
|
|
disp->line_length = v.xres_virtual * 2;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
v.red.offset = 11;
|
|
v.green.offset = 5;
|
|
v.blue.offset = 0;
|
|
v.red.length = 5;
|
|
v.green.length = 6;
|
|
v.blue.length = 5;
|
|
v.transp.offset = v.transp.length = 0;
|
|
break;
|
|
#endif
|
|
|
|
#ifdef FBCON_HAS_CFB24
|
|
case 24:
|
|
nom = 4;
|
|
den = 1;
|
|
disp->line_length = v.xres_virtual * 3;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
v.red.offset = 16;
|
|
v.green.offset = 8;
|
|
v.blue.offset = 0;
|
|
v.red.length = v.blue.length = v.green.length = 8;
|
|
v.transp.offset = v.transp.length = 0;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB32
|
|
case 32:
|
|
nom = 4;
|
|
den = 1;
|
|
disp->line_length = v.xres_virtual * 4;
|
|
disp->visual = FB_VISUAL_DIRECTCOLOR;
|
|
v.red.offset = 16;
|
|
v.green.offset = 8;
|
|
v.blue.offset = 0;
|
|
v.red.length = v.blue.length = v.green.length = 8;
|
|
v.transp.offset = 24;
|
|
v.transp.length = 8;
|
|
break;
|
|
#endif
|
|
default:
|
|
printk ("radeonfb: mode %dx%dx%d rejected, color depth invalid\n",
|
|
var->xres, var->yres, var->bits_per_pixel);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (radeonfb_do_maximize(rinfo, var, &v, nom, den) < 0)
|
|
return -EINVAL;
|
|
|
|
if (v.xoffset < 0)
|
|
v.xoffset = 0;
|
|
if (v.yoffset < 0)
|
|
v.yoffset = 0;
|
|
|
|
if (v.xoffset > v.xres_virtual - v.xres)
|
|
v.xoffset = v.xres_virtual - v.xres - 1;
|
|
|
|
if (v.yoffset > v.yres_virtual - v.yres)
|
|
v.yoffset = v.yres_virtual - v.yres - 1;
|
|
|
|
v.red.msb_right = v.green.msb_right = v.blue.msb_right =
|
|
v.transp.offset = v.transp.length =
|
|
v.transp.msb_right = 0;
|
|
|
|
switch (v.activate & FB_ACTIVATE_MASK) {
|
|
case FB_ACTIVATE_TEST:
|
|
return 0;
|
|
case FB_ACTIVATE_NXTOPEN:
|
|
case FB_ACTIVATE_NOW:
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
memcpy (&disp->var, &v, sizeof (v));
|
|
|
|
if (chgvar) {
|
|
radeon_set_dispsw(rinfo, disp);
|
|
|
|
if (noaccel)
|
|
disp->scrollmode = SCROLL_YREDRAW;
|
|
else
|
|
disp->scrollmode = 0;
|
|
|
|
if (info && info->changevar)
|
|
info->changevar(con);
|
|
}
|
|
|
|
err = radeon_load_video_mode (rinfo, &v);
|
|
if(err) return err;
|
|
do_install_cmap(con, info);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_get_cmap (struct fb_cmap *cmap, int kspc, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
struct display *disp;
|
|
|
|
disp = (con < 0) ? rinfo->info.disp : &fb_display[con];
|
|
|
|
if (con == rinfo->currcon) {
|
|
int rc = fb_get_cmap (cmap, kspc, radeon_getcolreg, info);
|
|
return rc;
|
|
} else if (disp->cmap.len)
|
|
fb_copy_cmap (&disp->cmap, cmap, kspc ? 0 : 2);
|
|
else
|
|
fb_copy_cmap (fb_default_cmap (radeon_get_cmap_len (&disp->var)),
|
|
cmap, kspc ? 0 : 2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_set_cmap (struct fb_cmap *cmap, int kspc, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
struct display *disp;
|
|
unsigned int cmap_len;
|
|
|
|
disp = (con < 0) ? rinfo->info.disp : &fb_display[con];
|
|
|
|
cmap_len = radeon_get_cmap_len (&disp->var);
|
|
if (disp->cmap.len != cmap_len) {
|
|
int err = fb_alloc_cmap (&disp->cmap, cmap_len, 0);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
if (con == rinfo->currcon) {
|
|
int rc = fb_set_cmap (cmap, kspc, radeon_setcolreg, info);
|
|
return rc;
|
|
} else
|
|
fb_copy_cmap (cmap, &disp->cmap, kspc ? 0 : 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_pan_display (struct fb_var_screeninfo *var, int con,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
u32 offset, xoffset, yoffset;
|
|
|
|
xoffset = (var->xoffset + 7) & ~7;
|
|
yoffset = var->yoffset;
|
|
|
|
if ((xoffset + var->xres > var->xres_virtual) || (yoffset+var->yres >
|
|
var->yres_virtual))
|
|
return -EINVAL;
|
|
|
|
offset = ((yoffset * var->xres + xoffset) * var->bits_per_pixel) >> 6;
|
|
|
|
OUTREG(CRTC_OFFSET, offset);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static void do_install_cmap(int con, struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
|
|
if (con != rinfo->currcon)
|
|
return;
|
|
|
|
if (fb_display[con].cmap.len)
|
|
fb_set_cmap(&fb_display[con].cmap, 1, radeon_setcolreg, info);
|
|
else {
|
|
int size = fb_display[con].var.bits_per_pixel == 8 ? 256 : 32;
|
|
fb_set_cmap(fb_default_cmap(size), 1, radeon_setcolreg, info);
|
|
}
|
|
}
|
|
|
|
|
|
static int radeonfb_do_maximize(struct radeonfb_info *rinfo,
|
|
struct fb_var_screeninfo *var,
|
|
struct fb_var_screeninfo *v,
|
|
int nom, int den)
|
|
{
|
|
static struct {
|
|
int xres, yres;
|
|
} modes[] = {
|
|
{1600, 1280},
|
|
{1280, 1024},
|
|
{1024, 768},
|
|
{800, 600},
|
|
{640, 480},
|
|
{-1, -1}
|
|
};
|
|
int i;
|
|
|
|
/* use highest possible virtual resolution */
|
|
if (v->xres_virtual == -1 && v->yres_virtual == -1) {
|
|
printk("radeonfb: using max availabe virtual resolution\n");
|
|
for (i=0; modes[i].xres != -1; i++) {
|
|
if (modes[i].xres * nom / den * modes[i].yres <
|
|
rinfo->video_ram / 2)
|
|
break;
|
|
}
|
|
if (modes[i].xres == -1) {
|
|
printk("radeonfb: could not find virtual resolution that fits into video memory!\n");
|
|
return -EINVAL;
|
|
}
|
|
v->xres_virtual = modes[i].xres;
|
|
v->yres_virtual = modes[i].yres;
|
|
|
|
printk("radeonfb: virtual resolution set to max of %dx%d\n",
|
|
v->xres_virtual, v->yres_virtual);
|
|
} else if (v->xres_virtual == -1) {
|
|
v->xres_virtual = (rinfo->video_ram * den /
|
|
(nom * v->yres_virtual * 2)) & ~15;
|
|
} else if (v->yres_virtual == -1) {
|
|
v->xres_virtual = (v->xres_virtual + 15) & ~15;
|
|
v->yres_virtual = rinfo->video_ram * den /
|
|
(nom * v->xres_virtual *2);
|
|
} else {
|
|
if (v->xres_virtual * nom / den * v->yres_virtual >
|
|
rinfo->video_ram) {
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
if (v->xres_virtual * nom / den >= 8192) {
|
|
v->xres_virtual = 8192 * den / nom - 16;
|
|
}
|
|
|
|
if (v->xres_virtual < v->xres)
|
|
return -EINVAL;
|
|
|
|
if (v->yres_virtual < v->yres)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int radeonfb_ioctl (struct inode *inode, struct file *file, unsigned int cmd,
|
|
unsigned long arg, int con, struct fb_info *info)
|
|
{
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_switch (int con, struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
struct display *disp;
|
|
struct fb_cmap *cmap;
|
|
int switchcon = 0;
|
|
|
|
disp = (con < 0) ? rinfo->info.disp : &fb_display[con];
|
|
|
|
if (rinfo->currcon >= 0) {
|
|
cmap = &(rinfo->currcon_display->cmap);
|
|
if (cmap->len)
|
|
fb_get_cmap (cmap, 1, radeon_getcolreg, info);
|
|
}
|
|
|
|
if ((disp->var.xres != rinfo->xres) ||
|
|
(disp->var.yres != rinfo->yres) ||
|
|
(disp->var.pixclock != rinfo->pixclock) ||
|
|
(disp->var.bits_per_pixel != rinfo->depth))
|
|
switchcon = 1;
|
|
|
|
if (switchcon) {
|
|
rinfo->currcon = con;
|
|
rinfo->currcon_display = disp;
|
|
disp->var.activate = FB_ACTIVATE_NOW;
|
|
|
|
radeonfb_set_var (&disp->var, con, info);
|
|
radeon_set_dispsw (rinfo, disp);
|
|
do_install_cmap(con, info);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeonfb_updatevar (int con, struct fb_info *info)
|
|
{
|
|
int rc;
|
|
|
|
rc = (con < 0) ? -EINVAL : radeonfb_pan_display (&fb_display[con].var,
|
|
con, info);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static void radeonfb_blank (int blank, struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
u32 val = INREG(CRTC_EXT_CNTL);
|
|
|
|
/* reset it */
|
|
val &= ~(CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS |
|
|
CRTC_VSYNC_DIS);
|
|
|
|
switch (blank) {
|
|
case VESA_NO_BLANKING:
|
|
if(DUAL_MONITOR(rinfo)) {
|
|
OUTREGP(CRTC2_GEN_CNTL,
|
|
0,
|
|
~(CRTC2_DISP_DIS |
|
|
CRTC2_VSYNC_DIS |
|
|
CRTC2_HSYNC_DIS));
|
|
}
|
|
switch(PRIMARY_MONITOR(rinfo)) {
|
|
case MT_LCD:
|
|
OUTREGP(LVDS_GEN_CNTL, 0,
|
|
~LVDS_DISPLAY_DIS);
|
|
case MT_CRT:
|
|
case MT_DFP:
|
|
OUTREGP(CRTC_EXT_CNTL,
|
|
CRTC_CRT_ON,
|
|
~(CRTC_DISPLAY_DIS |
|
|
CRTC_VSYNC_DIS |
|
|
CRTC_HSYNC_DIS));
|
|
break;
|
|
case MT_NONE:
|
|
default:
|
|
break;
|
|
|
|
}
|
|
break;
|
|
case VESA_VSYNC_SUSPEND:
|
|
val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS);
|
|
break;
|
|
case VESA_HSYNC_SUSPEND:
|
|
val |= (CRTC_DISPLAY_DIS | CRTC_HSYNC_DIS);
|
|
break;
|
|
case VESA_POWERDOWN:
|
|
val |= (CRTC_DISPLAY_DIS | CRTC_VSYNC_DIS |
|
|
CRTC_HSYNC_DIS);
|
|
break;
|
|
}
|
|
if(blank != VESA_NO_BLANKING) OUTREG(CRTC_EXT_CNTL, val);
|
|
}
|
|
|
|
|
|
|
|
static int radeon_get_cmap_len (const struct fb_var_screeninfo *var)
|
|
{
|
|
int rc = 16; /* reasonable default */
|
|
|
|
switch (var->bits_per_pixel) {
|
|
case 8:
|
|
rc = 256;
|
|
break;
|
|
case 16:
|
|
rc = 64;
|
|
break;
|
|
default:
|
|
rc = 32;
|
|
break;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
|
|
|
|
static int radeon_getcolreg (unsigned regno, unsigned *red, unsigned *green,
|
|
unsigned *blue, unsigned *transp,
|
|
struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
|
|
if (regno > 255)
|
|
return 1;
|
|
|
|
*red = (rinfo->palette[regno].red<<8) | rinfo->palette[regno].red;
|
|
*green = (rinfo->palette[regno].green<<8) | rinfo->palette[regno].green;
|
|
*blue = (rinfo->palette[regno].blue<<8) | rinfo->palette[regno].blue;
|
|
*transp = 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
static int radeon_setcolreg (unsigned regno, unsigned red, unsigned green,
|
|
unsigned blue, unsigned transp, struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *) info;
|
|
u32 pindex;
|
|
|
|
if (regno > 255)
|
|
return 1;
|
|
|
|
red >>= 8;
|
|
green >>= 8;
|
|
blue >>= 8;
|
|
rinfo->palette[regno].red = red;
|
|
rinfo->palette[regno].green = green;
|
|
rinfo->palette[regno].blue = blue;
|
|
|
|
/* init gamma for hicolor */
|
|
if ((rinfo->depth > 8) && (regno == 0)) {
|
|
int i;
|
|
|
|
for (i=0; i<255; i++) {
|
|
OUTREG(PALETTE_INDEX, i);
|
|
OUTREG(PALETTE_DATA, (i << 16) | (i << 8) | i);
|
|
}
|
|
}
|
|
|
|
/* default */
|
|
pindex = regno;
|
|
|
|
/* XXX actually bpp, fixme */
|
|
if (rinfo->depth == 16)
|
|
pindex = regno * 8;
|
|
|
|
if (rinfo->depth == 16) {
|
|
OUTREG(PALETTE_INDEX, pindex/2);
|
|
OUTREG(PALETTE_DATA, (rinfo->palette[regno/2].red << 16) |
|
|
(green << 8) | (rinfo->palette[regno/2].blue));
|
|
green = rinfo->palette[regno/2].green;
|
|
}
|
|
|
|
if ((rinfo->depth == 8) || (regno < 32)) {
|
|
OUTREG(PALETTE_INDEX, pindex);
|
|
OUTREG(PALETTE_DATA, (red << 16) | (green << 8) | blue);
|
|
}
|
|
|
|
#if defined(FBCON_HAS_CFB16) || defined(FBCON_HAS_CFB32)
|
|
if (regno < 32) {
|
|
switch (rinfo->depth) {
|
|
#ifdef FBCON_HAS_CFB16
|
|
case 16:
|
|
rinfo->con_cmap.cfb16[regno] = (regno << 11) | (regno << 5) |
|
|
regno;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB24
|
|
case 24:
|
|
rinfo->con_cmap.cfb24[regno] = (regno << 16) | (regno << 8) | regno;
|
|
break;
|
|
#endif
|
|
#ifdef FBCON_HAS_CFB32
|
|
case 32: {
|
|
u32 i;
|
|
|
|
i = (regno << 8) | regno;
|
|
rinfo->con_cmap.cfb32[regno] = (i << 16) | i;
|
|
break;
|
|
}
|
|
#endif
|
|
}
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static void radeon_save_common_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_common_regs is called\n");
|
|
save->ovr_clr = INREG(OVR_CLR);
|
|
save->ovr_wid_left_right= INREG(OVR_WID_LEFT_RIGHT);
|
|
save->ovr_wid_top_bottom= INREG(OVR_WID_TOP_BOTTOM);
|
|
save->ov0_scale_cntl = INREG(OV0_SCALE_CNTL);
|
|
save->mpp_tb_config = INREG(MPP_TB_CONFIG);
|
|
save->mpp_gp_config = INREG(MPP_GP_CONFIG);
|
|
save->subpic_cntl = INREG(SUBPIC_CNTL);
|
|
save->i2c_cntl_1 = INREG(I2C_CNTL_1);
|
|
save->gen_int_cntl = INREG(GEN_INT_CNTL);
|
|
save->cap0_trig_cntl = INREG(CAP0_TRIG_CNTL);
|
|
save->cap1_trig_cntl = INREG(CAP1_TRIG_CNTL);
|
|
save->bus_cntl = INREG(BUS_CNTL);
|
|
}
|
|
|
|
static void radeon_save_crtc_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_crtc_regs is called\n");
|
|
save->crtc_gen_cntl = INREG(CRTC_GEN_CNTL);
|
|
save->crtc_ext_cntl = INREG(CRTC_EXT_CNTL);
|
|
save->dac_cntl = INREG(DAC_CNTL);
|
|
save->crtc_h_total_disp = INREG(CRTC_H_TOTAL_DISP);
|
|
save->crtc_h_sync_strt_wid = INREG(CRTC_H_SYNC_STRT_WID);
|
|
save->crtc_v_total_disp = INREG(CRTC_V_TOTAL_DISP);
|
|
save->crtc_v_sync_strt_wid = INREG(CRTC_V_SYNC_STRT_WID);
|
|
save->crtc_offset = INREG(CRTC_OFFSET);
|
|
save->crtc_offset_cntl = INREG(CRTC_OFFSET_CNTL);
|
|
save->crtc_pitch = INREG(CRTC_PITCH);
|
|
}
|
|
|
|
static void radeon_save_crtc2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_crtc2_regs is called\n");
|
|
save->dac2_cntl = INREG(DAC_CNTL2);
|
|
save->disp_output_cntl = INREG(DISP_OUTPUT_CNTL);
|
|
|
|
save->crtc2_gen_cntl = INREG(CRTC2_GEN_CNTL);
|
|
save->crtc2_h_total_disp = INREG(CRTC2_H_TOTAL_DISP);
|
|
save->crtc2_h_sync_strt_wid = INREG(CRTC2_H_SYNC_STRT_WID);
|
|
save->crtc2_v_total_disp = INREG(CRTC2_V_TOTAL_DISP);
|
|
save->crtc2_v_sync_strt_wid = INREG(CRTC2_V_SYNC_STRT_WID);
|
|
save->crtc2_offset = INREG(CRTC2_OFFSET);
|
|
save->crtc2_offset_cntl = INREG(CRTC2_OFFSET_CNTL);
|
|
save->crtc2_pitch = INREG(CRTC2_PITCH);
|
|
}
|
|
|
|
static void radeon_save_fp_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_fp_regs is called\n");
|
|
save->fp_crtc_h_total_disp = INREG(FP_CRTC_H_TOTAL_DISP);
|
|
save->fp_crtc_v_total_disp = INREG(FP_CRTC_V_TOTAL_DISP);
|
|
save->fp_gen_cntl = INREG(FP_GEN_CNTL);
|
|
save->fp_h_sync_strt_wid = INREG(FP_H_SYNC_STRT_WID);
|
|
save->fp_horz_stretch = INREG(FP_HORZ_STRETCH);
|
|
save->fp_v_sync_strt_wid = INREG(FP_V_SYNC_STRT_WID);
|
|
save->fp_vert_stretch = INREG(FP_VERT_STRETCH);
|
|
save->lvds_gen_cntl = INREG(LVDS_GEN_CNTL);
|
|
save->lvds_pll_cntl = INREG(LVDS_PLL_CNTL);
|
|
save->tmds_crc = INREG(TMDS_CRC);
|
|
}
|
|
|
|
static void radeon_save_pll_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_pll_regs is called\n");
|
|
save->ppll_ref_div = INPLL(PPLL_REF_DIV);
|
|
save->ppll_div_3 = INPLL(PPLL_DIV_3);
|
|
save->htotal_cntl = INPLL(HTOTAL_CNTL);
|
|
}
|
|
|
|
static void radeon_save_pll2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_pll2_regs is called\n");
|
|
save->p2pll_ref_div = INPLL(P2PLL_REF_DIV);
|
|
save->p2pll_div_0 = INPLL(P2PLL_DIV_0);
|
|
save->htotal_cntl2 = INPLL(HTOTAL2_CNTL);
|
|
}
|
|
|
|
static void radeon_save_dda_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_dda_regs is called\n");
|
|
save->dda_config = INREG(DDA_CONFIG);
|
|
save->dda_on_off = INREG(DDA_ON_OFF);
|
|
}
|
|
|
|
static void radeon_write_common_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_common_regs is called\n");
|
|
OUTREG(OVR_CLR, restore->ovr_clr);
|
|
OUTREG(OVR_WID_LEFT_RIGHT, restore->ovr_wid_left_right);
|
|
OUTREG(OVR_WID_TOP_BOTTOM, restore->ovr_wid_top_bottom);
|
|
OUTREG(OV0_SCALE_CNTL, restore->ov0_scale_cntl);
|
|
OUTREG(MPP_TB_CONFIG, restore->mpp_tb_config );
|
|
OUTREG(MPP_GP_CONFIG, restore->mpp_gp_config );
|
|
OUTREG(SUBPIC_CNTL, restore->subpic_cntl);
|
|
OUTREG(I2C_CNTL_1, restore->i2c_cntl_1);
|
|
OUTREG(GEN_INT_CNTL, restore->gen_int_cntl);
|
|
OUTREG(CAP0_TRIG_CNTL, restore->cap0_trig_cntl);
|
|
OUTREG(CAP1_TRIG_CNTL, restore->cap1_trig_cntl);
|
|
OUTREG(BUS_CNTL, restore->bus_cntl);
|
|
}
|
|
|
|
static void radeon_write_crtc_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_crtc_regs is called\n");
|
|
OUTREG(CRTC_GEN_CNTL, restore->crtc_gen_cntl);
|
|
|
|
OUTREGP(CRTC_EXT_CNTL, restore->crtc_ext_cntl,
|
|
CRTC_VSYNC_DIS |
|
|
CRTC_HSYNC_DIS |
|
|
CRTC_DISPLAY_DIS);
|
|
|
|
OUTREGP(DAC_CNTL, restore->dac_cntl,
|
|
DAC_RANGE_CNTL |
|
|
DAC_BLANKING);
|
|
|
|
OUTREG(CRTC_H_TOTAL_DISP, restore->crtc_h_total_disp);
|
|
OUTREG(CRTC_H_SYNC_STRT_WID, restore->crtc_h_sync_strt_wid);
|
|
OUTREG(CRTC_V_TOTAL_DISP, restore->crtc_v_total_disp);
|
|
OUTREG(CRTC_V_SYNC_STRT_WID, restore->crtc_v_sync_strt_wid);
|
|
OUTREG(CRTC_OFFSET, restore->crtc_offset);
|
|
OUTREG(CRTC_OFFSET_CNTL, restore->crtc_offset_cntl);
|
|
OUTREG(CRTC_PITCH, restore->crtc_pitch);
|
|
}
|
|
|
|
static void radeon_write_crtc2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_crtc2_regs is called\n");
|
|
/* OUTREG(CRTC2_GEN_CNTL, restore->crtc2_gen_cntl);*/
|
|
OUTREGP(CRTC2_GEN_CNTL, restore->crtc2_gen_cntl,
|
|
CRTC2_VSYNC_DIS |
|
|
CRTC2_HSYNC_DIS |
|
|
CRTC2_DISP_DIS);
|
|
|
|
OUTREG(DAC_CNTL2, restore->dac2_cntl);
|
|
OUTREG(DISP_OUTPUT_CNTL, restore->disp_output_cntl);
|
|
|
|
OUTREG(CRTC2_H_TOTAL_DISP, restore->crtc2_h_total_disp);
|
|
OUTREG(CRTC2_H_SYNC_STRT_WID, restore->crtc2_h_sync_strt_wid);
|
|
OUTREG(CRTC2_V_TOTAL_DISP, restore->crtc2_v_total_disp);
|
|
OUTREG(CRTC2_V_SYNC_STRT_WID, restore->crtc2_v_sync_strt_wid);
|
|
OUTREG(CRTC2_OFFSET, restore->crtc2_offset);
|
|
OUTREG(CRTC2_OFFSET_CNTL, restore->crtc2_offset_cntl);
|
|
OUTREG(CRTC2_PITCH, restore->crtc2_pitch);
|
|
}
|
|
|
|
static void radeon_write_fp_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
int prim_mon;
|
|
u32 tmp;
|
|
RTRACE("radeonfb: radeon_write_fp_regs is called\n");
|
|
OUTREG(FP_CRTC_H_TOTAL_DISP, restore->fp_crtc_h_total_disp);
|
|
OUTREG(FP_CRTC_V_TOTAL_DISP, restore->fp_crtc_v_total_disp);
|
|
OUTREG(FP_H_SYNC_STRT_WID, restore->fp_h_sync_strt_wid);
|
|
OUTREG(FP_V_SYNC_STRT_WID, restore->fp_v_sync_strt_wid);
|
|
OUTREG(TMDS_CRC, restore->tmds_crc);
|
|
OUTREG(FP_HORZ_STRETCH, restore->fp_horz_stretch);
|
|
OUTREG(FP_VERT_STRETCH, restore->fp_vert_stretch);
|
|
OUTREG(FP_GEN_CNTL, restore->fp_gen_cntl);
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
if(prim_mon == MT_LCD) {
|
|
tmp = INREG(LVDS_GEN_CNTL);
|
|
if((tmp & (LVDS_ON | LVDS_BLON)) ==
|
|
(restore->lvds_gen_cntl & (LVDS_ON | LVDS_BLON))) {
|
|
OUTREG(LVDS_GEN_CNTL, restore->lvds_gen_cntl);
|
|
}
|
|
}
|
|
else {
|
|
if (restore->lvds_gen_cntl & (LVDS_ON | LVDS_BLON)) {
|
|
udelay(rinfo->PanelPwrDly * 1000);
|
|
OUTREG(LVDS_GEN_CNTL, restore->lvds_gen_cntl);
|
|
}
|
|
else {
|
|
OUTREG(LVDS_GEN_CNTL,
|
|
restore->lvds_gen_cntl | LVDS_BLON);
|
|
udelay(rinfo->PanelPwrDly * 1000);
|
|
OUTREG(LVDS_GEN_CNTL, restore->lvds_gen_cntl);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void radeon_write_pll_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_pll_regs is called\n");
|
|
OUTPLLP(0x08, 0x00, ~(0x03));
|
|
while ( (INREG(CLOCK_CNTL_INDEX) & PLL_DIV_SEL) != PLL_DIV_SEL) {
|
|
OUTREGP(CLOCK_CNTL_INDEX, PLL_DIV_SEL, 0xffff);
|
|
}
|
|
OUTPLLP(PPLL_CNTL, PPLL_RESET, 0xffff);
|
|
while ( (INPLL(PPLL_REF_DIV) & PPLL_REF_DIV_MASK) !=
|
|
(restore->ppll_ref_div & PPLL_REF_DIV_MASK)) {
|
|
OUTPLLP(PPLL_REF_DIV,
|
|
restore->ppll_ref_div, ~PPLL_REF_DIV_MASK);
|
|
}
|
|
while ( (INPLL(PPLL_DIV_3) & PPLL_FB3_DIV_MASK) !=
|
|
(restore->ppll_div_3 & PPLL_FB3_DIV_MASK)) {
|
|
OUTPLLP(PPLL_DIV_3,restore->ppll_div_3, ~PPLL_FB3_DIV_MASK);
|
|
}
|
|
while ( (INPLL(PPLL_DIV_3) & PPLL_POST3_DIV_MASK) !=
|
|
(restore->ppll_div_3 & PPLL_POST3_DIV_MASK)) {
|
|
OUTPLLP(PPLL_DIV_3,restore->ppll_div_3, ~PPLL_POST3_DIV_MASK);
|
|
}
|
|
OUTPLL(HTOTAL_CNTL, restore->htotal_cntl);
|
|
OUTPLLP(PPLL_CNTL, 0, ~PPLL_RESET);
|
|
OUTPLLP(0x08, 0x03, ~(0x03));
|
|
}
|
|
|
|
|
|
static void radeon_write_pll2_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_pll2_regs is called\n");
|
|
OUTPLLP(0x2d, 0x00, ~(0x03));
|
|
while (INREG(CLOCK_CNTL_INDEX) & ~(PLL2_DIV_SEL_MASK)) {
|
|
OUTREGP(CLOCK_CNTL_INDEX, 0, PLL2_DIV_SEL_MASK);
|
|
}
|
|
OUTPLLP(P2PLL_CNTL,P2PLL_RESET,0xffff);
|
|
while ( (INPLL(P2PLL_REF_DIV) & P2PLL_REF_DIV_MASK) !=
|
|
(restore->p2pll_ref_div & P2PLL_REF_DIV_MASK)) {
|
|
OUTPLLP(P2PLL_REF_DIV, restore->p2pll_ref_div, ~P2PLL_REF_DIV_MASK);
|
|
}
|
|
while ( (INPLL(P2PLL_DIV_0) & P2PLL_FB0_DIV_MASK) !=
|
|
(restore->p2pll_div_0 & P2PLL_FB0_DIV_MASK)) {
|
|
OUTPLLP(P2PLL_DIV_0, restore->p2pll_div_0, ~P2PLL_FB0_DIV_MASK);
|
|
}
|
|
while ( (INPLL(P2PLL_DIV_0) & P2PLL_POST0_DIV_MASK) !=
|
|
(restore->p2pll_div_0 & P2PLL_POST0_DIV_MASK)) {
|
|
OUTPLLP(P2PLL_DIV_0,restore->p2pll_div_0, ~P2PLL_POST0_DIV_MASK);
|
|
}
|
|
OUTPLL(HTOTAL2_CNTL, restore->htotal_cntl2);
|
|
OUTPLLP(P2PLL_CNTL, 0, ~(P2PLL_RESET | P2PLL_SLEEP));
|
|
OUTPLLP(0x2d, 0x03, ~(0x03));
|
|
}
|
|
|
|
static void radeon_write_dda_regs(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_dda_regs is called\n");
|
|
OUTREG(DDA_CONFIG, restore->dda_config);
|
|
OUTREG(DDA_ON_OFF, restore->dda_on_off);
|
|
}
|
|
|
|
static void radeon_save_mode (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
int prim_mon;
|
|
RTRACE("radeonfb: radeon_save_mode is called\n");
|
|
if(DUAL_MONITOR(rinfo)) {
|
|
radeon_save_crtc2_regs(rinfo,save);
|
|
radeon_save_pll2_regs(rinfo,save);
|
|
}
|
|
radeon_save_common_regs(rinfo,save);
|
|
radeon_save_crtc_regs(rinfo,save);
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
if(prim_mon == MT_LCD || prim_mon == MT_DFP) radeon_save_fp_regs(rinfo,save);
|
|
radeon_save_pll_regs(rinfo,save);
|
|
radeon_save_dda_regs(rinfo,save);
|
|
/*radeon_save_palette(rinfo,save);*/
|
|
}
|
|
|
|
static void radeon_save_state(struct radeonfb_info *rinfo,
|
|
struct radeon_regs *save)
|
|
{
|
|
RTRACE("radeonfb: radeon_save_state is called\n");
|
|
save->dp_datatype = INREG(DP_DATATYPE);
|
|
save->rbbm_soft_reset = INREG(RBBM_SOFT_RESET);
|
|
save->clock_cntl_index = INREG(CLOCK_CNTL_INDEX);
|
|
save->amcgpio_en_reg = INREG(AMCGPIO_EN_REG);
|
|
save->amcgpio_mask = INREG(AMCGPIO_MASK);
|
|
radeon_save_mode(rinfo,save);
|
|
}
|
|
|
|
static int radeon_load_video_mode (struct radeonfb_info *rinfo,
|
|
struct fb_var_screeninfo *mode)
|
|
{
|
|
|
|
struct radeon_regs newmode;
|
|
|
|
RTRACE("radeonfb: radeon_load_video_mode is called\n");
|
|
if(!radeon_init_mode(rinfo, &newmode, mode)) return -1;
|
|
|
|
radeonfb_blank(VESA_POWERDOWN,&rinfo->info);
|
|
radeon_write_mode(rinfo, &newmode);
|
|
radeonfb_blank(VESA_NO_BLANKING,&rinfo->info);
|
|
return 0;
|
|
}
|
|
|
|
static void radeon_write_mode (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *mode)
|
|
{
|
|
/*****
|
|
When changing mode with Dual-head card (VE/M6), care must
|
|
be taken for the special order in setting registers. CRTC2 has
|
|
to be set before changing CRTC_EXT register.
|
|
Otherwise we may get a blank screen.
|
|
*****/
|
|
int prim_mon;
|
|
RTRACE("radeonfb: radeon_write_mode is called\n");
|
|
if(DUAL_MONITOR(rinfo)) {
|
|
radeon_write_crtc2_regs(rinfo,mode);
|
|
radeon_write_pll2_regs(rinfo,mode);
|
|
}
|
|
radeon_write_common_regs(rinfo,mode);
|
|
radeon_write_dda_regs(rinfo,mode);
|
|
radeon_write_crtc_regs(rinfo,mode);
|
|
prim_mon = PRIMARY_MONITOR(rinfo);
|
|
if(prim_mon == MT_DFP || prim_mon == MT_LCD) {
|
|
radeon_write_fp_regs(rinfo,mode);
|
|
}
|
|
radeon_write_pll_regs(rinfo,mode);
|
|
}
|
|
|
|
static void radeon_write_state (struct radeonfb_info *rinfo,
|
|
struct radeon_regs *restore)
|
|
{
|
|
RTRACE("radeonfb: radeon_write_state is called\n");
|
|
radeonfb_blank(VESA_POWERDOWN,&rinfo->info);
|
|
OUTREG(AMCGPIO_MASK, restore->amcgpio_mask);
|
|
OUTREG(AMCGPIO_EN_REG, restore->amcgpio_en_reg);
|
|
OUTREG(CLOCK_CNTL_INDEX,restore->clock_cntl_index);
|
|
OUTREG(RBBM_SOFT_RESET, restore->rbbm_soft_reset);
|
|
OUTREG(DP_DATATYPE, restore->dp_datatype);
|
|
/* M6 card has trouble restoring text mode for its CRT.
|
|
Needs this workaround.*/
|
|
if(rinfo->isM6) OUTREG(DAC_CNTL2, restore->dac2_cntl);
|
|
radeon_write_mode(rinfo,restore);
|
|
radeonfb_blank(VESA_NO_BLANKING,&rinfo->info);
|
|
}
|
|
|
|
#if 0
|
|
/*
|
|
* text console acceleration
|
|
*/
|
|
|
|
|
|
static void fbcon_radeon_bmove(struct display *p, int srcy, int srcx,
|
|
int dsty, int dstx, int height, int width)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *)(p->fb_info);
|
|
u32 dp_cntl = DST_LAST_PEL;
|
|
|
|
srcx *= fontwidth(p);
|
|
srcy *= fontheight(p);
|
|
dstx *= fontwidth(p);
|
|
dsty *= fontheight(p);
|
|
width *= fontwidth(p);
|
|
height *= fontheight(p);
|
|
|
|
if (srcy < dsty) {
|
|
srcy += height - 1;
|
|
dsty += height - 1;
|
|
} else
|
|
dp_cntl |= DST_Y_TOP_TO_BOTTOM;
|
|
|
|
if (srcx < dstx) {
|
|
srcx += width - 1;
|
|
dstx += width - 1;
|
|
} else
|
|
dp_cntl |= DST_X_LEFT_TO_RIGHT;
|
|
|
|
radeon_fifo_wait(6);
|
|
OUTREG(DP_GUI_MASTER_CNTL, (rinfo->dp_gui_master_cntl |
|
|
GMC_BRUSH_NONE |
|
|
GMC_SRC_DATATYPE_COLOR |
|
|
ROP3_S |
|
|
DP_SRC_SOURCE_MEMORY));
|
|
OUTREG(DP_WRITE_MSK, 0xffffffff);
|
|
OUTREG(DP_CNTL, dp_cntl);
|
|
OUTREG(SRC_Y_X, (srcy << 16) | srcx);
|
|
OUTREG(DST_Y_X, (dsty << 16) | dstx);
|
|
OUTREG(DST_HEIGHT_WIDTH, (height << 16) | width);
|
|
}
|
|
|
|
static void fbcon_radeon_clear(struct vc_data *conp, struct display *p,
|
|
int srcy, int srcx, int height, int width)
|
|
{
|
|
struct radeonfb_info *rinfo = (struct radeonfb_info *)(p->fb_info);
|
|
u32 clr;
|
|
|
|
clr = attr_bgcol_ec(p, conp);
|
|
clr |= (clr << 8);
|
|
clr |= (clr << 16);
|
|
|
|
srcx *= fontwidth(p);
|
|
srcy *= fontheight(p);
|
|
width *= fontwidth(p);
|
|
height *= fontheight(p);
|
|
|
|
radeon_fifo_wait(6);
|
|
OUTREG(DP_GUI_MASTER_CNTL, (rinfo->dp_gui_master_cntl |
|
|
GMC_BRUSH_SOLID_COLOR |
|
|
GMC_SRC_DATATYPE_COLOR |
|
|
ROP3_P));
|
|
OUTREG(DP_BRUSH_FRGD_CLR, clr);
|
|
OUTREG(DP_WRITE_MSK, 0xffffffff);
|
|
OUTREG(DP_CNTL, (DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM));
|
|
OUTREG(DST_Y_X, (srcy << 16) | srcx);
|
|
OUTREG(DST_WIDTH_HEIGHT, (width << 16) | height);
|
|
}
|
|
|
|
#ifdef FBCON_HAS_CFB8
|
|
static struct display_switch fbcon_radeon8 = {
|
|
setup: fbcon_cfb8_setup,
|
|
bmove: fbcon_radeon_bmove,
|
|
clear: fbcon_radeon_clear,
|
|
putc: fbcon_cfb8_putc,
|
|
putcs: fbcon_cfb8_putcs,
|
|
revc: fbcon_cfb8_revc,
|
|
clear_margins: fbcon_cfb8_clear_margins,
|
|
fontwidthmask: FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
|
|
};
|
|
#endif
|
|
#endif
|