5a0e3ad6af
percpu.h is included by sched.h and module.h and thus ends up being included when building most .c files. percpu.h includes slab.h which in turn includes gfp.h making everything defined by the two files universally available and complicating inclusion dependencies. percpu.h -> slab.h dependency is about to be removed. Prepare for this change by updating users of gfp and slab facilities include those headers directly instead of assuming availability. As this conversion needs to touch large number of source files, the following script is used as the basis of conversion. http://userweb.kernel.org/~tj/misc/slabh-sweep.py The script does the followings. * Scan files for gfp and slab usages and update includes such that only the necessary includes are there. ie. if only gfp is used, gfp.h, if slab is used, slab.h. * When the script inserts a new include, it looks at the include blocks and try to put the new include such that its order conforms to its surrounding. It's put in the include block which contains core kernel includes, in the same order that the rest are ordered - alphabetical, Christmas tree, rev-Xmas-tree or at the end if there doesn't seem to be any matching order. * If the script can't find a place to put a new include (mostly because the file doesn't have fitting include block), it prints out an error message indicating which .h file needs to be added to the file. The conversion was done in the following steps. 1. The initial automatic conversion of all .c files updated slightly over 4000 files, deleting around 700 includes and adding ~480 gfp.h and ~3000 slab.h inclusions. The script emitted errors for ~400 files. 2. Each error was manually checked. Some didn't need the inclusion, some needed manual addition while adding it to implementation .h or embedding .c file was more appropriate for others. This step added inclusions to around 150 files. 3. The script was run again and the output was compared to the edits from #2 to make sure no file was left behind. 4. Several build tests were done and a couple of problems were fixed. e.g. lib/decompress_*.c used malloc/free() wrappers around slab APIs requiring slab.h to be added manually. 5. The script was run on all .h files but without automatically editing them as sprinkling gfp.h and slab.h inclusions around .h files could easily lead to inclusion dependency hell. Most gfp.h inclusion directives were ignored as stuff from gfp.h was usually wildly available and often used in preprocessor macros. Each slab.h inclusion directive was examined and added manually as necessary. 6. percpu.h was updated not to include slab.h. 7. Build test were done on the following configurations and failures were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my distributed build env didn't work with gcov compiles) and a few more options had to be turned off depending on archs to make things build (like ipr on powerpc/64 which failed due to missing writeq). * x86 and x86_64 UP and SMP allmodconfig and a custom test config. * powerpc and powerpc64 SMP allmodconfig * sparc and sparc64 SMP allmodconfig * ia64 SMP allmodconfig * s390 SMP allmodconfig * alpha SMP allmodconfig * um on x86_64 SMP allmodconfig 8. percpu.h modifications were reverted so that it could be applied as a separate patch and serve as bisection point. Given the fact that I had only a couple of failures from tests on step 6, I'm fairly confident about the coverage of this conversion patch. If there is a breakage, it's likely to be something in one of the arch headers which should be easily discoverable easily on most builds of the specific arch. Signed-off-by: Tejun Heo <tj@kernel.org> Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org> Cc: Ingo Molnar <mingo@redhat.com> Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
692 lines
15 KiB
C
692 lines
15 KiB
C
/* leo.c: LEO frame buffer driver
|
|
*
|
|
* Copyright (C) 2003, 2006 David S. Miller (davem@davemloft.net)
|
|
* Copyright (C) 1996-1999 Jakub Jelinek (jj@ultra.linux.cz)
|
|
* Copyright (C) 1997 Michal Rehacek (Michal.Rehacek@st.mff.cuni.cz)
|
|
*
|
|
* Driver layout based loosely on tgafb.c, see that file for credits.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/string.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/init.h>
|
|
#include <linux/fb.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/io.h>
|
|
|
|
#include <asm/fbio.h>
|
|
|
|
#include "sbuslib.h"
|
|
|
|
/*
|
|
* Local functions.
|
|
*/
|
|
|
|
static int leo_setcolreg(unsigned, unsigned, unsigned, unsigned,
|
|
unsigned, struct fb_info *);
|
|
static int leo_blank(int, struct fb_info *);
|
|
|
|
static int leo_mmap(struct fb_info *, struct vm_area_struct *);
|
|
static int leo_ioctl(struct fb_info *, unsigned int, unsigned long);
|
|
static int leo_pan_display(struct fb_var_screeninfo *, struct fb_info *);
|
|
|
|
/*
|
|
* Frame buffer operations
|
|
*/
|
|
|
|
static struct fb_ops leo_ops = {
|
|
.owner = THIS_MODULE,
|
|
.fb_setcolreg = leo_setcolreg,
|
|
.fb_blank = leo_blank,
|
|
.fb_pan_display = leo_pan_display,
|
|
.fb_fillrect = cfb_fillrect,
|
|
.fb_copyarea = cfb_copyarea,
|
|
.fb_imageblit = cfb_imageblit,
|
|
.fb_mmap = leo_mmap,
|
|
.fb_ioctl = leo_ioctl,
|
|
#ifdef CONFIG_COMPAT
|
|
.fb_compat_ioctl = sbusfb_compat_ioctl,
|
|
#endif
|
|
};
|
|
|
|
#define LEO_OFF_LC_SS0_KRN 0x00200000UL
|
|
#define LEO_OFF_LC_SS0_USR 0x00201000UL
|
|
#define LEO_OFF_LC_SS1_KRN 0x01200000UL
|
|
#define LEO_OFF_LC_SS1_USR 0x01201000UL
|
|
#define LEO_OFF_LD_SS0 0x00400000UL
|
|
#define LEO_OFF_LD_SS1 0x01400000UL
|
|
#define LEO_OFF_LD_GBL 0x00401000UL
|
|
#define LEO_OFF_LX_KRN 0x00600000UL
|
|
#define LEO_OFF_LX_CURSOR 0x00601000UL
|
|
#define LEO_OFF_SS0 0x00800000UL
|
|
#define LEO_OFF_SS1 0x01800000UL
|
|
#define LEO_OFF_UNK 0x00602000UL
|
|
#define LEO_OFF_UNK2 0x00000000UL
|
|
|
|
#define LEO_CUR_ENABLE 0x00000080
|
|
#define LEO_CUR_UPDATE 0x00000030
|
|
#define LEO_CUR_PROGRESS 0x00000006
|
|
#define LEO_CUR_UPDATECMAP 0x00000003
|
|
|
|
#define LEO_CUR_TYPE_MASK 0x00000000
|
|
#define LEO_CUR_TYPE_IMAGE 0x00000020
|
|
#define LEO_CUR_TYPE_CMAP 0x00000050
|
|
|
|
struct leo_cursor {
|
|
u8 xxx0[16];
|
|
u32 cur_type;
|
|
u32 cur_misc;
|
|
u32 cur_cursxy;
|
|
u32 cur_data;
|
|
};
|
|
|
|
#define LEO_KRN_TYPE_CLUT0 0x00001000
|
|
#define LEO_KRN_TYPE_CLUT1 0x00001001
|
|
#define LEO_KRN_TYPE_CLUT2 0x00001002
|
|
#define LEO_KRN_TYPE_WID 0x00001003
|
|
#define LEO_KRN_TYPE_UNK 0x00001006
|
|
#define LEO_KRN_TYPE_VIDEO 0x00002003
|
|
#define LEO_KRN_TYPE_CLUTDATA 0x00004000
|
|
#define LEO_KRN_CSR_ENABLE 0x00000008
|
|
#define LEO_KRN_CSR_PROGRESS 0x00000004
|
|
#define LEO_KRN_CSR_UNK 0x00000002
|
|
#define LEO_KRN_CSR_UNK2 0x00000001
|
|
|
|
struct leo_lx_krn {
|
|
u32 krn_type;
|
|
u32 krn_csr;
|
|
u32 krn_value;
|
|
};
|
|
|
|
struct leo_lc_ss0_krn {
|
|
u32 misc;
|
|
u8 xxx0[0x800-4];
|
|
u32 rev;
|
|
};
|
|
|
|
struct leo_lc_ss0_usr {
|
|
u32 csr;
|
|
u32 addrspace;
|
|
u32 fontmsk;
|
|
u32 fontt;
|
|
u32 extent;
|
|
u32 src;
|
|
u32 dst;
|
|
u32 copy;
|
|
u32 fill;
|
|
};
|
|
|
|
struct leo_lc_ss1_krn {
|
|
u8 unknown;
|
|
};
|
|
|
|
struct leo_lc_ss1_usr {
|
|
u8 unknown;
|
|
};
|
|
|
|
struct leo_ld_ss0 {
|
|
u8 xxx0[0xe00];
|
|
u32 csr;
|
|
u32 wid;
|
|
u32 wmask;
|
|
u32 widclip;
|
|
u32 vclipmin;
|
|
u32 vclipmax;
|
|
u32 pickmin; /* SS1 only */
|
|
u32 pickmax; /* SS1 only */
|
|
u32 fg;
|
|
u32 bg;
|
|
u32 src; /* Copy/Scroll (SS0 only) */
|
|
u32 dst; /* Copy/Scroll/Fill (SS0 only) */
|
|
u32 extent; /* Copy/Scroll/Fill size (SS0 only) */
|
|
u32 xxx1[3];
|
|
u32 setsem; /* SS1 only */
|
|
u32 clrsem; /* SS1 only */
|
|
u32 clrpick; /* SS1 only */
|
|
u32 clrdat; /* SS1 only */
|
|
u32 alpha; /* SS1 only */
|
|
u8 xxx2[0x2c];
|
|
u32 winbg;
|
|
u32 planemask;
|
|
u32 rop;
|
|
u32 z;
|
|
u32 dczf; /* SS1 only */
|
|
u32 dczb; /* SS1 only */
|
|
u32 dcs; /* SS1 only */
|
|
u32 dczs; /* SS1 only */
|
|
u32 pickfb; /* SS1 only */
|
|
u32 pickbb; /* SS1 only */
|
|
u32 dcfc; /* SS1 only */
|
|
u32 forcecol; /* SS1 only */
|
|
u32 door[8]; /* SS1 only */
|
|
u32 pick[5]; /* SS1 only */
|
|
};
|
|
|
|
#define LEO_SS1_MISC_ENABLE 0x00000001
|
|
#define LEO_SS1_MISC_STEREO 0x00000002
|
|
struct leo_ld_ss1 {
|
|
u8 xxx0[0xef4];
|
|
u32 ss1_misc;
|
|
};
|
|
|
|
struct leo_ld_gbl {
|
|
u8 unknown;
|
|
};
|
|
|
|
struct leo_par {
|
|
spinlock_t lock;
|
|
struct leo_lx_krn __iomem *lx_krn;
|
|
struct leo_lc_ss0_usr __iomem *lc_ss0_usr;
|
|
struct leo_ld_ss0 __iomem *ld_ss0;
|
|
struct leo_ld_ss1 __iomem *ld_ss1;
|
|
struct leo_cursor __iomem *cursor;
|
|
u32 extent;
|
|
u32 clut_data[256];
|
|
|
|
u32 flags;
|
|
#define LEO_FLAG_BLANKED 0x00000001
|
|
|
|
unsigned long which_io;
|
|
};
|
|
|
|
static void leo_wait(struct leo_lx_krn __iomem *lx_krn)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0;
|
|
(sbus_readl(&lx_krn->krn_csr) & LEO_KRN_CSR_PROGRESS) &&
|
|
i < 300000;
|
|
i++)
|
|
udelay(1); /* Busy wait at most 0.3 sec */
|
|
return;
|
|
}
|
|
|
|
static void leo_switch_from_graph(struct fb_info *info)
|
|
{
|
|
struct leo_par *par = (struct leo_par *) info->par;
|
|
struct leo_ld_ss0 __iomem *ss = par->ld_ss0;
|
|
struct leo_cursor __iomem *cursor = par->cursor;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&par->lock, flags);
|
|
|
|
par->extent = ((info->var.xres - 1) |
|
|
((info->var.yres - 1) << 16));
|
|
|
|
sbus_writel(0xffffffff, &ss->wid);
|
|
sbus_writel(0xffff, &ss->wmask);
|
|
sbus_writel(0, &ss->vclipmin);
|
|
sbus_writel(par->extent, &ss->vclipmax);
|
|
sbus_writel(0, &ss->fg);
|
|
sbus_writel(0xff000000, &ss->planemask);
|
|
sbus_writel(0x310850, &ss->rop);
|
|
sbus_writel(0, &ss->widclip);
|
|
sbus_writel((info->var.xres-1) | ((info->var.yres-1) << 11),
|
|
&par->lc_ss0_usr->extent);
|
|
sbus_writel(4, &par->lc_ss0_usr->addrspace);
|
|
sbus_writel(0x80000000, &par->lc_ss0_usr->fill);
|
|
sbus_writel(0, &par->lc_ss0_usr->fontt);
|
|
do {
|
|
val = sbus_readl(&par->lc_ss0_usr->csr);
|
|
} while (val & 0x20000000);
|
|
|
|
/* setup screen buffer for cfb_* functions */
|
|
sbus_writel(1, &ss->wid);
|
|
sbus_writel(0x00ffffff, &ss->planemask);
|
|
sbus_writel(0x310b90, &ss->rop);
|
|
sbus_writel(0, &par->lc_ss0_usr->addrspace);
|
|
|
|
/* hide cursor */
|
|
sbus_writel(sbus_readl(&cursor->cur_misc) & ~LEO_CUR_ENABLE, &cursor->cur_misc);
|
|
|
|
spin_unlock_irqrestore(&par->lock, flags);
|
|
}
|
|
|
|
static int leo_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
|
|
{
|
|
/* We just use this to catch switches out of
|
|
* graphics mode.
|
|
*/
|
|
leo_switch_from_graph(info);
|
|
|
|
if (var->xoffset || var->yoffset || var->vmode)
|
|
return -EINVAL;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* leo_setcolreg - Optional function. Sets a color register.
|
|
* @regno: boolean, 0 copy local, 1 get_user() function
|
|
* @red: frame buffer colormap structure
|
|
* @green: The green value which can be up to 16 bits wide
|
|
* @blue: The blue value which can be up to 16 bits wide.
|
|
* @transp: If supported the alpha value which can be up to 16 bits wide.
|
|
* @info: frame buffer info structure
|
|
*/
|
|
static int leo_setcolreg(unsigned regno,
|
|
unsigned red, unsigned green, unsigned blue,
|
|
unsigned transp, struct fb_info *info)
|
|
{
|
|
struct leo_par *par = (struct leo_par *) info->par;
|
|
struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
|
|
unsigned long flags;
|
|
u32 val;
|
|
int i;
|
|
|
|
if (regno >= 256)
|
|
return 1;
|
|
|
|
red >>= 8;
|
|
green >>= 8;
|
|
blue >>= 8;
|
|
|
|
par->clut_data[regno] = red | (green << 8) | (blue << 16);
|
|
|
|
spin_lock_irqsave(&par->lock, flags);
|
|
|
|
leo_wait(lx_krn);
|
|
|
|
sbus_writel(LEO_KRN_TYPE_CLUTDATA, &lx_krn->krn_type);
|
|
for (i = 0; i < 256; i++)
|
|
sbus_writel(par->clut_data[i], &lx_krn->krn_value);
|
|
sbus_writel(LEO_KRN_TYPE_CLUT0, &lx_krn->krn_type);
|
|
|
|
val = sbus_readl(&lx_krn->krn_csr);
|
|
val |= (LEO_KRN_CSR_UNK | LEO_KRN_CSR_UNK2);
|
|
sbus_writel(val, &lx_krn->krn_csr);
|
|
|
|
spin_unlock_irqrestore(&par->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* leo_blank - Optional function. Blanks the display.
|
|
* @blank_mode: the blank mode we want.
|
|
* @info: frame buffer structure that represents a single frame buffer
|
|
*/
|
|
static int leo_blank(int blank, struct fb_info *info)
|
|
{
|
|
struct leo_par *par = (struct leo_par *) info->par;
|
|
struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
|
|
unsigned long flags;
|
|
u32 val;
|
|
|
|
spin_lock_irqsave(&par->lock, flags);
|
|
|
|
switch (blank) {
|
|
case FB_BLANK_UNBLANK: /* Unblanking */
|
|
val = sbus_readl(&lx_krn->krn_csr);
|
|
val |= LEO_KRN_CSR_ENABLE;
|
|
sbus_writel(val, &lx_krn->krn_csr);
|
|
par->flags &= ~LEO_FLAG_BLANKED;
|
|
break;
|
|
|
|
case FB_BLANK_NORMAL: /* Normal blanking */
|
|
case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */
|
|
case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */
|
|
case FB_BLANK_POWERDOWN: /* Poweroff */
|
|
val = sbus_readl(&lx_krn->krn_csr);
|
|
val &= ~LEO_KRN_CSR_ENABLE;
|
|
sbus_writel(val, &lx_krn->krn_csr);
|
|
par->flags |= LEO_FLAG_BLANKED;
|
|
break;
|
|
}
|
|
|
|
spin_unlock_irqrestore(&par->lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct sbus_mmap_map leo_mmap_map[] = {
|
|
{
|
|
.voff = LEO_SS0_MAP,
|
|
.poff = LEO_OFF_SS0,
|
|
.size = 0x800000
|
|
},
|
|
{
|
|
.voff = LEO_LC_SS0_USR_MAP,
|
|
.poff = LEO_OFF_LC_SS0_USR,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LD_SS0_MAP,
|
|
.poff = LEO_OFF_LD_SS0,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LX_CURSOR_MAP,
|
|
.poff = LEO_OFF_LX_CURSOR,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_SS1_MAP,
|
|
.poff = LEO_OFF_SS1,
|
|
.size = 0x800000
|
|
},
|
|
{
|
|
.voff = LEO_LC_SS1_USR_MAP,
|
|
.poff = LEO_OFF_LC_SS1_USR,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LD_SS1_MAP,
|
|
.poff = LEO_OFF_LD_SS1,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_UNK_MAP,
|
|
.poff = LEO_OFF_UNK,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LX_KRN_MAP,
|
|
.poff = LEO_OFF_LX_KRN,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LC_SS0_KRN_MAP,
|
|
.poff = LEO_OFF_LC_SS0_KRN,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LC_SS1_KRN_MAP,
|
|
.poff = LEO_OFF_LC_SS1_KRN,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_LD_GBL_MAP,
|
|
.poff = LEO_OFF_LD_GBL,
|
|
.size = 0x1000
|
|
},
|
|
{
|
|
.voff = LEO_UNK2_MAP,
|
|
.poff = LEO_OFF_UNK2,
|
|
.size = 0x100000
|
|
},
|
|
{ .size = 0 }
|
|
};
|
|
|
|
static int leo_mmap(struct fb_info *info, struct vm_area_struct *vma)
|
|
{
|
|
struct leo_par *par = (struct leo_par *)info->par;
|
|
|
|
return sbusfb_mmap_helper(leo_mmap_map,
|
|
info->fix.smem_start, info->fix.smem_len,
|
|
par->which_io, vma);
|
|
}
|
|
|
|
static int leo_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg)
|
|
{
|
|
return sbusfb_ioctl_helper(cmd, arg, info,
|
|
FBTYPE_SUNLEO, 32, info->fix.smem_len);
|
|
}
|
|
|
|
/*
|
|
* Initialisation
|
|
*/
|
|
|
|
static void
|
|
leo_init_fix(struct fb_info *info, struct device_node *dp)
|
|
{
|
|
strlcpy(info->fix.id, dp->name, sizeof(info->fix.id));
|
|
|
|
info->fix.type = FB_TYPE_PACKED_PIXELS;
|
|
info->fix.visual = FB_VISUAL_TRUECOLOR;
|
|
|
|
info->fix.line_length = 8192;
|
|
|
|
info->fix.accel = FB_ACCEL_SUN_LEO;
|
|
}
|
|
|
|
static void leo_wid_put(struct fb_info *info, struct fb_wid_list *wl)
|
|
{
|
|
struct leo_par *par = (struct leo_par *) info->par;
|
|
struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
|
|
struct fb_wid_item *wi;
|
|
unsigned long flags;
|
|
u32 val;
|
|
int i, j;
|
|
|
|
spin_lock_irqsave(&par->lock, flags);
|
|
|
|
leo_wait(lx_krn);
|
|
|
|
for (i = 0, wi = wl->wl_list; i < wl->wl_count; i++, wi++) {
|
|
switch (wi->wi_type) {
|
|
case FB_WID_DBL_8:
|
|
j = (wi->wi_index & 0xf) + 0x40;
|
|
break;
|
|
|
|
case FB_WID_DBL_24:
|
|
j = wi->wi_index & 0x3f;
|
|
break;
|
|
|
|
default:
|
|
continue;
|
|
};
|
|
sbus_writel(0x5800 + j, &lx_krn->krn_type);
|
|
sbus_writel(wi->wi_values[0], &lx_krn->krn_value);
|
|
}
|
|
sbus_writel(LEO_KRN_TYPE_WID, &lx_krn->krn_type);
|
|
|
|
val = sbus_readl(&lx_krn->krn_csr);
|
|
val |= (LEO_KRN_CSR_UNK | LEO_KRN_CSR_UNK2);
|
|
sbus_writel(val, &lx_krn->krn_csr);
|
|
|
|
spin_unlock_irqrestore(&par->lock, flags);
|
|
}
|
|
|
|
static void leo_init_wids(struct fb_info *info)
|
|
{
|
|
struct fb_wid_item wi;
|
|
struct fb_wid_list wl;
|
|
|
|
wl.wl_count = 1;
|
|
wl.wl_list = &wi;
|
|
wi.wi_type = FB_WID_DBL_8;
|
|
wi.wi_index = 0;
|
|
wi.wi_values [0] = 0x2c0;
|
|
leo_wid_put(info, &wl);
|
|
wi.wi_index = 1;
|
|
wi.wi_values [0] = 0x30;
|
|
leo_wid_put(info, &wl);
|
|
wi.wi_index = 2;
|
|
wi.wi_values [0] = 0x20;
|
|
leo_wid_put(info, &wl);
|
|
wi.wi_type = FB_WID_DBL_24;
|
|
wi.wi_index = 1;
|
|
wi.wi_values [0] = 0x30;
|
|
leo_wid_put(info, &wl);
|
|
}
|
|
|
|
static void leo_init_hw(struct fb_info *info)
|
|
{
|
|
struct leo_par *par = (struct leo_par *) info->par;
|
|
u32 val;
|
|
|
|
val = sbus_readl(&par->ld_ss1->ss1_misc);
|
|
val |= LEO_SS1_MISC_ENABLE;
|
|
sbus_writel(val, &par->ld_ss1->ss1_misc);
|
|
|
|
leo_switch_from_graph(info);
|
|
}
|
|
|
|
static void leo_fixup_var_rgb(struct fb_var_screeninfo *var)
|
|
{
|
|
var->red.offset = 0;
|
|
var->red.length = 8;
|
|
var->green.offset = 8;
|
|
var->green.length = 8;
|
|
var->blue.offset = 16;
|
|
var->blue.length = 8;
|
|
var->transp.offset = 0;
|
|
var->transp.length = 0;
|
|
}
|
|
|
|
static void leo_unmap_regs(struct of_device *op, struct fb_info *info,
|
|
struct leo_par *par)
|
|
{
|
|
if (par->lc_ss0_usr)
|
|
of_iounmap(&op->resource[0], par->lc_ss0_usr, 0x1000);
|
|
if (par->ld_ss0)
|
|
of_iounmap(&op->resource[0], par->ld_ss0, 0x1000);
|
|
if (par->ld_ss1)
|
|
of_iounmap(&op->resource[0], par->ld_ss1, 0x1000);
|
|
if (par->lx_krn)
|
|
of_iounmap(&op->resource[0], par->lx_krn, 0x1000);
|
|
if (par->cursor)
|
|
of_iounmap(&op->resource[0],
|
|
par->cursor, sizeof(struct leo_cursor));
|
|
if (info->screen_base)
|
|
of_iounmap(&op->resource[0], info->screen_base, 0x800000);
|
|
}
|
|
|
|
static int __devinit leo_probe(struct of_device *op,
|
|
const struct of_device_id *match)
|
|
{
|
|
struct device_node *dp = op->node;
|
|
struct fb_info *info;
|
|
struct leo_par *par;
|
|
int linebytes, err;
|
|
|
|
info = framebuffer_alloc(sizeof(struct leo_par), &op->dev);
|
|
|
|
err = -ENOMEM;
|
|
if (!info)
|
|
goto out_err;
|
|
par = info->par;
|
|
|
|
spin_lock_init(&par->lock);
|
|
|
|
info->fix.smem_start = op->resource[0].start;
|
|
par->which_io = op->resource[0].flags & IORESOURCE_BITS;
|
|
|
|
sbusfb_fill_var(&info->var, dp, 32);
|
|
leo_fixup_var_rgb(&info->var);
|
|
|
|
linebytes = of_getintprop_default(dp, "linebytes",
|
|
info->var.xres);
|
|
info->fix.smem_len = PAGE_ALIGN(linebytes * info->var.yres);
|
|
|
|
par->lc_ss0_usr =
|
|
of_ioremap(&op->resource[0], LEO_OFF_LC_SS0_USR,
|
|
0x1000, "leolc ss0usr");
|
|
par->ld_ss0 =
|
|
of_ioremap(&op->resource[0], LEO_OFF_LD_SS0,
|
|
0x1000, "leold ss0");
|
|
par->ld_ss1 =
|
|
of_ioremap(&op->resource[0], LEO_OFF_LD_SS1,
|
|
0x1000, "leold ss1");
|
|
par->lx_krn =
|
|
of_ioremap(&op->resource[0], LEO_OFF_LX_KRN,
|
|
0x1000, "leolx krn");
|
|
par->cursor =
|
|
of_ioremap(&op->resource[0], LEO_OFF_LX_CURSOR,
|
|
sizeof(struct leo_cursor), "leolx cursor");
|
|
info->screen_base =
|
|
of_ioremap(&op->resource[0], LEO_OFF_SS0,
|
|
0x800000, "leo ram");
|
|
if (!par->lc_ss0_usr ||
|
|
!par->ld_ss0 ||
|
|
!par->ld_ss1 ||
|
|
!par->lx_krn ||
|
|
!par->cursor ||
|
|
!info->screen_base)
|
|
goto out_unmap_regs;
|
|
|
|
info->flags = FBINFO_DEFAULT;
|
|
info->fbops = &leo_ops;
|
|
info->pseudo_palette = par->clut_data;
|
|
|
|
leo_init_wids(info);
|
|
leo_init_hw(info);
|
|
|
|
leo_blank(FB_BLANK_UNBLANK, info);
|
|
|
|
if (fb_alloc_cmap(&info->cmap, 256, 0))
|
|
goto out_unmap_regs;
|
|
|
|
leo_init_fix(info, dp);
|
|
|
|
err = register_framebuffer(info);
|
|
if (err < 0)
|
|
goto out_dealloc_cmap;
|
|
|
|
dev_set_drvdata(&op->dev, info);
|
|
|
|
printk(KERN_INFO "%s: leo at %lx:%lx\n",
|
|
dp->full_name,
|
|
par->which_io, info->fix.smem_start);
|
|
|
|
return 0;
|
|
|
|
out_dealloc_cmap:
|
|
fb_dealloc_cmap(&info->cmap);
|
|
|
|
out_unmap_regs:
|
|
leo_unmap_regs(op, info, par);
|
|
framebuffer_release(info);
|
|
|
|
out_err:
|
|
return err;
|
|
}
|
|
|
|
static int __devexit leo_remove(struct of_device *op)
|
|
{
|
|
struct fb_info *info = dev_get_drvdata(&op->dev);
|
|
struct leo_par *par = info->par;
|
|
|
|
unregister_framebuffer(info);
|
|
fb_dealloc_cmap(&info->cmap);
|
|
|
|
leo_unmap_regs(op, info, par);
|
|
|
|
framebuffer_release(info);
|
|
|
|
dev_set_drvdata(&op->dev, NULL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id leo_match[] = {
|
|
{
|
|
.name = "SUNW,leo",
|
|
},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, leo_match);
|
|
|
|
static struct of_platform_driver leo_driver = {
|
|
.name = "leo",
|
|
.match_table = leo_match,
|
|
.probe = leo_probe,
|
|
.remove = __devexit_p(leo_remove),
|
|
};
|
|
|
|
static int __init leo_init(void)
|
|
{
|
|
if (fb_get_options("leofb", NULL))
|
|
return -ENODEV;
|
|
|
|
return of_register_driver(&leo_driver, &of_bus_type);
|
|
}
|
|
|
|
static void __exit leo_exit(void)
|
|
{
|
|
of_unregister_driver(&leo_driver);
|
|
}
|
|
|
|
module_init(leo_init);
|
|
module_exit(leo_exit);
|
|
|
|
MODULE_DESCRIPTION("framebuffer driver for LEO chipsets");
|
|
MODULE_AUTHOR("David S. Miller <davem@davemloft.net>");
|
|
MODULE_VERSION("2.0");
|
|
MODULE_LICENSE("GPL");
|