![Jani Nikula](/assets/img/avatar_default.png)
Now that the fbops member of struct fb_info is const, we can start making the ops const as well. This does not cover all drivers; some actually modify the fbops struct, for example to adjust for different configurations, and others do more involved things that I'd rather not touch in practically obsolete drivers. Mostly this is the low hanging fruit where we can add "const" and be done with it. v3: - un-constify atyfb, mb862xx, nvidia and uvesabf (0day) v2: - fix typo (Christophe de Dinechin) - use "static const" instead of "const static" in mx3fb.c - also constify smscufx.c Cc: linux-fbdev@vger.kernel.org Reviewed-by: Daniel Vetter <daniel.vetter@ffwll.ch> Signed-off-by: Jani Nikula <jani.nikula@intel.com> Link: https://patchwork.freedesktop.org/patch/msgid/ce67f14435f3af498f2e8bf35ce4be11f7504132.1575390740.git.jani.nikula@intel.com
692 lines
15 KiB
C
692 lines
15 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* 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 const 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)
|
|
{
|
|
snprintf(info->fix.id, sizeof(info->fix.id), "%pOFn", dp);
|
|
|
|
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 platform_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 leo_probe(struct platform_device *op)
|
|
{
|
|
struct device_node *dp = op->dev.of_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 "%pOF: leo at %lx:%lx\n",
|
|
dp,
|
|
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 leo_remove(struct platform_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);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id leo_match[] = {
|
|
{
|
|
.name = "SUNW,leo",
|
|
},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, leo_match);
|
|
|
|
static struct platform_driver leo_driver = {
|
|
.driver = {
|
|
.name = "leo",
|
|
.of_match_table = leo_match,
|
|
},
|
|
.probe = leo_probe,
|
|
.remove = leo_remove,
|
|
};
|
|
|
|
static int __init leo_init(void)
|
|
{
|
|
if (fb_get_options("leofb", NULL))
|
|
return -ENODEV;
|
|
|
|
return platform_driver_register(&leo_driver);
|
|
}
|
|
|
|
static void __exit leo_exit(void)
|
|
{
|
|
platform_driver_unregister(&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");
|