[linux-block.git] / drivers / video / leo.c

/* leo.c: LEO frame buffer driver
 *
 * Copyright (C) 2003 David S. Miller (davem@redhat.com)
 * 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/slab.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/fb.h>
#include <linux/mm.h>

#include <asm/io.h>
#include <asm/sbus.h>
#include <asm/oplib.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];
	volatile u32	cur_type;
	volatile u32	cur_misc;
	volatile u32	cur_cursxy;
	volatile 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 {
	volatile u32	krn_type;
	volatile u32	krn_csr;
	volatile u32	krn_value;
};

struct leo_lc_ss0_krn {
	volatile u32 	misc;
	u8		xxx0[0x800-4];
	volatile u32	rev;
};

struct leo_lc_ss0_usr {
	volatile u32	csr;
	volatile u32	addrspace;
	volatile u32 	fontmsk;
	volatile u32	fontt;
	volatile u32	extent;
	volatile u32	src;
	u32		dst;
	volatile u32	copy;
	volatile u32	fill;
};

struct leo_lc_ss1_krn {
	u8	unknown;
};

struct leo_lc_ss1_usr {
	u8	unknown;
};

struct leo_ld {
	u8		xxx0[0xe00];
	volatile u32	csr;
	volatile u32	wid;
	volatile u32	wmask;
	volatile u32	widclip;
	volatile u32	vclipmin;
	volatile u32	vclipmax;
	volatile u32	pickmin;	/* SS1 only */
	volatile u32	pickmax;	/* SS1 only */
	volatile u32	fg;
	volatile u32	bg;
	volatile u32	src;		/* Copy/Scroll (SS0 only) */
	volatile u32	dst;		/* Copy/Scroll/Fill (SS0 only) */
	volatile u32	extent;		/* Copy/Scroll/Fill size (SS0 only) */
	u32		xxx1[3];
	volatile u32	setsem;		/* SS1 only */
	volatile u32	clrsem;		/* SS1 only */
	volatile u32	clrpick;	/* SS1 only */
	volatile u32	clrdat;		/* SS1 only */
	volatile u32	alpha;		/* SS1 only */
	u8		xxx2[0x2c];
	volatile u32	winbg;
	volatile u32	planemask;
	volatile u32	rop;
	volatile u32	z;
	volatile u32	dczf;		/* SS1 only */
	volatile u32	dczb;		/* SS1 only */
	volatile u32	dcs;		/* SS1 only */
	volatile u32	dczs;		/* SS1 only */
	volatile u32	pickfb;		/* SS1 only */
	volatile u32	pickbb;		/* SS1 only */
	volatile u32	dcfc;		/* SS1 only */
	volatile u32	forcecol;	/* SS1 only */
	volatile u32	door[8];	/* SS1 only */
	volatile u32	pick[5];	/* SS1 only */
};

#define LEO_SS1_MISC_ENABLE	0x00000001
#define LEO_SS1_MISC_STEREO	0x00000002
struct leo_ld_ss1 {
	u8		xxx0[0xef4];
	volatile 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		physbase;
	unsigned long		fbsize;

	struct sbus_dev		*sdev;
};

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;
}

/**
 *      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,
				  par->physbase, par->fbsize,
				  par->sdev->reg_addrs[0].which_io,
				  vma);
}

static int leo_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg)
{
	struct leo_par *par = (struct leo_par *) info->par;

	return sbusfb_ioctl_helper(cmd, arg, info,
				   FBTYPE_SUNLEO, 32, par->fbsize);
}

/*
 *  Initialisation
 */

static void
leo_init_fix(struct fb_info *info)
{
	struct leo_par *par = (struct leo_par *)info->par;

	strlcpy(info->fix.id, par->sdev->prom_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_switch_from_graph(struct fb_info *info)
{
	struct leo_par *par = (struct leo_par *) info->par;
	struct leo_ld __iomem *ss = (struct leo_ld __iomem *) par->ld_ss0;
	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);

	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;
}

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;
}

struct all_info {
	struct fb_info info;
	struct leo_par par;
	struct list_head list;
};
static LIST_HEAD(leo_list);

static void leo_init_one(struct sbus_dev *sdev)
{
	struct all_info *all;
	int linebytes;

	all = kmalloc(sizeof(*all), GFP_KERNEL);
	if (!all) {
		printk(KERN_ERR "leo: Cannot allocate memory.\n");
		return;
	}
	memset(all, 0, sizeof(*all));

	INIT_LIST_HEAD(&all->list);

	spin_lock_init(&all->par.lock);
	all->par.sdev = sdev;

	all->par.physbase = sdev->reg_addrs[0].phys_addr;

	sbusfb_fill_var(&all->info.var, sdev->prom_node, 32);
	leo_fixup_var_rgb(&all->info.var);

	linebytes = prom_getintdefault(sdev->prom_node, "linebytes",
				       all->info.var.xres);
	all->par.fbsize = PAGE_ALIGN(linebytes * all->info.var.yres);

#ifdef CONFIG_SPARC32
	all->info.screen_base = (char __iomem *)
		prom_getintdefault(sdev->prom_node, "address", 0);
#endif
	if (!all->info.screen_base)
		all->info.screen_base = 
			sbus_ioremap(&sdev->resource[0], LEO_OFF_SS0,
				     0x800000, "leo ram");

	all->par.lc_ss0_usr =
		sbus_ioremap(&sdev->resource[0], LEO_OFF_LC_SS0_USR,
			     0x1000, "leolc ss0usr");
	all->par.ld_ss0 =
		sbus_ioremap(&sdev->resource[0], LEO_OFF_LD_SS0,
			     0x1000, "leold ss0");
	all->par.ld_ss1 =
		sbus_ioremap(&sdev->resource[0], LEO_OFF_LD_SS1,
			     0x1000, "leold ss1");
	all->par.lx_krn =
		sbus_ioremap(&sdev->resource[0], LEO_OFF_LX_KRN,
			     0x1000, "leolx krn");
	all->par.cursor =
		sbus_ioremap(&sdev->resource[0], LEO_OFF_LX_CURSOR,
			     sizeof(struct leo_cursor), "leolx cursor");

	all->info.flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN;
	all->info.fbops = &leo_ops;
	all->info.par = &all->par;

	leo_init_wids(&all->info);
	leo_init_hw(&all->info);

	leo_blank(0, &all->info);

	if (fb_alloc_cmap(&all->info.cmap, 256, 0)) {
		printk(KERN_ERR "leo: Could not allocate color map.\n");
		kfree(all);
		return;
	}

	leo_init_fix(&all->info);

	if (register_framebuffer(&all->info) < 0) {
		printk(KERN_ERR "leo: Could not register framebuffer.\n");
		fb_dealloc_cmap(&all->info.cmap);
		kfree(all);
		return;
	}

	list_add(&all->list, &leo_list);

	printk("leo: %s at %lx:%lx\n",
	       sdev->prom_name,
	       (long) sdev->reg_addrs[0].which_io,
	       (long) sdev->reg_addrs[0].phys_addr);
}

int __init leo_init(void)
{
	struct sbus_bus *sbus;
	struct sbus_dev *sdev;

	if (fb_get_options("leofb", NULL))
		return -ENODEV;

	for_all_sbusdev(sdev, sbus) {
		if (!strcmp(sdev->prom_name, "leo"))
			leo_init_one(sdev);
	}

	return 0;
}

void __exit leo_exit(void)
{
	struct list_head *pos, *tmp;

	list_for_each_safe(pos, tmp, &leo_list) {
		struct all_info *all = list_entry(pos, typeof(*all), list);

		unregister_framebuffer(&all->info);
		fb_dealloc_cmap(&all->info.cmap);
		kfree(all);
	}
}

int __init
leo_setup(char *arg)
{
	/* No cmdline options yet... */
	return 0;
}

module_init(leo_init);
#ifdef MODULE
module_exit(leo_exit);
#endif

MODULE_DESCRIPTION("framebuffer driver for LEO chipsets");
MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	/* leo.c: LEO frame buffer driver
	2	*
	3	* Copyright (C) 2003 David S. Miller (davem@redhat.com)
	4	* Copyright (C) 1996-1999 Jakub Jelinek (jj@ultra.linux.cz)
	5	* Copyright (C) 1997 Michal Rehacek (Michal.Rehacek@st.mff.cuni.cz)
	6	*
	7	* Driver layout based loosely on tgafb.c, see that file for credits.
	8	*/
	9
	10	#include <linux/module.h>
	11	#include <linux/kernel.h>
	12	#include <linux/errno.h>
	13	#include <linux/string.h>
	14	#include <linux/slab.h>
	15	#include <linux/delay.h>
	16	#include <linux/init.h>
	17	#include <linux/fb.h>
	18	#include <linux/mm.h>
	19
	20	#include <asm/io.h>
	21	#include <asm/sbus.h>
	22	#include <asm/oplib.h>
	23	#include <asm/fbio.h>
	24
	25	#include "sbuslib.h"
	26
	27	/*
	28	* Local functions.
	29	*/
	30
	31	static int leo_setcolreg(unsigned, unsigned, unsigned, unsigned,
	32	unsigned, struct fb_info *);
	33	static int leo_blank(int, struct fb_info *);
	34
216d526c	35	static int leo_mmap(struct fb_info , struct vm_area_struct );
67a6680d	36	static int leo_ioctl(struct fb_info *, unsigned int, unsigned long);
1da177e4 LT	37	static int leo_pan_display(struct fb_var_screeninfo , struct fb_info );
	38
	39	/*
	40	* Frame buffer operations
	41	*/
	42
	43	static struct fb_ops leo_ops = {
	44	.owner = THIS_MODULE,
	45	.fb_setcolreg = leo_setcolreg,
	46	.fb_blank = leo_blank,
	47	.fb_pan_display = leo_pan_display,
	48	.fb_fillrect = cfb_fillrect,
	49	.fb_copyarea = cfb_copyarea,
	50	.fb_imageblit = cfb_imageblit,
	51	.fb_mmap = leo_mmap,
	52	.fb_ioctl = leo_ioctl,
9ffb83bc CH	53	#ifdef CONFIG_COMPAT
	54	.fb_compat_ioctl = sbusfb_compat_ioctl,
	55	#endif
1da177e4 LT	56	};
	57
	58	#define LEO_OFF_LC_SS0_KRN 0x00200000UL
	59	#define LEO_OFF_LC_SS0_USR 0x00201000UL
	60	#define LEO_OFF_LC_SS1_KRN 0x01200000UL
	61	#define LEO_OFF_LC_SS1_USR 0x01201000UL
	62	#define LEO_OFF_LD_SS0 0x00400000UL
	63	#define LEO_OFF_LD_SS1 0x01400000UL
	64	#define LEO_OFF_LD_GBL 0x00401000UL
	65	#define LEO_OFF_LX_KRN 0x00600000UL
	66	#define LEO_OFF_LX_CURSOR 0x00601000UL
	67	#define LEO_OFF_SS0 0x00800000UL
	68	#define LEO_OFF_SS1 0x01800000UL
	69	#define LEO_OFF_UNK 0x00602000UL
	70	#define LEO_OFF_UNK2 0x00000000UL
	71
	72	#define LEO_CUR_ENABLE 0x00000080
	73	#define LEO_CUR_UPDATE 0x00000030
	74	#define LEO_CUR_PROGRESS 0x00000006
	75	#define LEO_CUR_UPDATECMAP 0x00000003
	76
	77	#define LEO_CUR_TYPE_MASK 0x00000000
	78	#define LEO_CUR_TYPE_IMAGE 0x00000020
	79	#define LEO_CUR_TYPE_CMAP 0x00000050
	80
	81	struct leo_cursor {
	82	u8 xxx0[16];
	83	volatile u32 cur_type;
	84	volatile u32 cur_misc;
	85	volatile u32 cur_cursxy;
	86	volatile u32 cur_data;
	87	};
	88
	89	#define LEO_KRN_TYPE_CLUT0 0x00001000
	90	#define LEO_KRN_TYPE_CLUT1 0x00001001
	91	#define LEO_KRN_TYPE_CLUT2 0x00001002
	92	#define LEO_KRN_TYPE_WID 0x00001003
	93	#define LEO_KRN_TYPE_UNK 0x00001006
	94	#define LEO_KRN_TYPE_VIDEO 0x00002003
	95	#define LEO_KRN_TYPE_CLUTDATA 0x00004000
	96	#define LEO_KRN_CSR_ENABLE 0x00000008
	97	#define LEO_KRN_CSR_PROGRESS 0x00000004
	98	#define LEO_KRN_CSR_UNK 0x00000002
	99	#define LEO_KRN_CSR_UNK2 0x00000001
	100
	101	struct leo_lx_krn {
	102	volatile u32 krn_type;
	103	volatile u32 krn_csr;
	104	volatile u32 krn_value;
	105	};
	106
	107	struct leo_lc_ss0_krn {
	108	volatile u32 misc;
	109	u8 xxx0[0x800-4];
	110	volatile u32 rev;
	111	};
	112
	113	struct leo_lc_ss0_usr {
	114	volatile u32 csr;
	115	volatile u32 addrspace;
	116	volatile u32 fontmsk;
	117	volatile u32 fontt;
	118	volatile u32 extent;
	119	volatile u32 src;
120	u32 dst;
121	volatile u32 copy;
122	volatile u32 fill;
123	};
124
125	struct leo_lc_ss1_krn {
126	u8 unknown;
127	};
128
129	struct leo_lc_ss1_usr {
130	u8 unknown;
131	};
132
133	struct leo_ld {
134	u8 xxx0[0xe00];
135	volatile u32 csr;
136	volatile u32 wid;
137	volatile u32 wmask;
138	volatile u32 widclip;
139	volatile u32 vclipmin;
140	volatile u32 vclipmax;
141	volatile u32 pickmin; /* SS1 only */
142	volatile u32 pickmax; /* SS1 only */
143	volatile u32 fg;
144	volatile u32 bg;
145	volatile u32 src; /* Copy/Scroll (SS0 only) */
146	volatile u32 dst; /* Copy/Scroll/Fill (SS0 only) */
147	volatile u32 extent; /* Copy/Scroll/Fill size (SS0 only) */
148	u32 xxx1[3];
149	volatile u32 setsem; /* SS1 only */
150	volatile u32 clrsem; /* SS1 only */
151	volatile u32 clrpick; /* SS1 only */
152	volatile u32 clrdat; /* SS1 only */
153	volatile u32 alpha; /* SS1 only */
154	u8 xxx2[0x2c];
155	volatile u32 winbg;
156	volatile u32 planemask;
157	volatile u32 rop;
158	volatile u32 z;
159	volatile u32 dczf; /* SS1 only */
160	volatile u32 dczb; /* SS1 only */
161	volatile u32 dcs; /* SS1 only */
162	volatile u32 dczs; /* SS1 only */
163	volatile u32 pickfb; /* SS1 only */
164	volatile u32 pickbb; /* SS1 only */
165	volatile u32 dcfc; /* SS1 only */
166	volatile u32 forcecol; /* SS1 only */
167	volatile u32 door[8]; /* SS1 only */
168	volatile u32 pick[5]; /* SS1 only */
169	};
170
171	#define LEO_SS1_MISC_ENABLE 0x00000001
172	#define LEO_SS1_MISC_STEREO 0x00000002
173	struct leo_ld_ss1 {
174	u8 xxx0[0xef4];
175	volatile u32 ss1_misc;
176	};
177
178	struct leo_ld_gbl {
179	u8 unknown;
180	};
181
182	struct leo_par {
183	spinlock_t lock;
184	struct leo_lx_krn __iomem *lx_krn;
185	struct leo_lc_ss0_usr __iomem *lc_ss0_usr;
186	struct leo_ld_ss0 __iomem *ld_ss0;
187	struct leo_ld_ss1 __iomem *ld_ss1;
188	struct leo_cursor __iomem *cursor;
189	u32 extent;
190	u32 clut_data[256];
191
192	u32 flags;
193	#define LEO_FLAG_BLANKED 0x00000001
194
195	unsigned long physbase;
196	unsigned long fbsize;
197
198	struct sbus_dev *sdev;
1da177e4 LT	199	};
	200
	201	static void leo_wait(struct leo_lx_krn __iomem *lx_krn)
	202	{
	203	int i;
	204
	205	for (i = 0;
	206	(sbus_readl(&lx_krn->krn_csr) & LEO_KRN_CSR_PROGRESS) && i < 300000;
	207	i++)
	208	udelay (1); /* Busy wait at most 0.3 sec */
	209	return;
	210	}
	211
	212	/**
	213	* leo_setcolreg - Optional function. Sets a color register.
	214	* @regno: boolean, 0 copy local, 1 get_user() function
	215	* @red: frame buffer colormap structure
	216	* @green: The green value which can be up to 16 bits wide
	217	* @blue: The blue value which can be up to 16 bits wide.
	218	* @transp: If supported the alpha value which can be up to 16 bits wide.
	219	* @info: frame buffer info structure
	220	*/
	221	static int leo_setcolreg(unsigned regno,
	222	unsigned red, unsigned green, unsigned blue,
	223	unsigned transp, struct fb_info *info)
	224	{
	225	struct leo_par par = (struct leo_par ) info->par;
	226	struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
	227	unsigned long flags;
	228	u32 val;
	229	int i;
	230
	231	if (regno >= 256)
	232	return 1;
	233
	234	red >>= 8;
	235	green >>= 8;
	236	blue >>= 8;
	237
	238	par->clut_data[regno] = red \| (green << 8) \| (blue << 16);
	239
	240	spin_lock_irqsave(&par->lock, flags);
	241
	242	leo_wait(lx_krn);
	243
	244	sbus_writel(LEO_KRN_TYPE_CLUTDATA, &lx_krn->krn_type);
	245	for (i = 0; i < 256; i++)
	246	sbus_writel(par->clut_data[i], &lx_krn->krn_value);
	247	sbus_writel(LEO_KRN_TYPE_CLUT0, &lx_krn->krn_type);
	248
	249	val = sbus_readl(&lx_krn->krn_csr);
	250	val \|= (LEO_KRN_CSR_UNK \| LEO_KRN_CSR_UNK2);
	251	sbus_writel(val, &lx_krn->krn_csr);
	252
	253	spin_unlock_irqrestore(&par->lock, flags);
	254
	255	return 0;
	256	}
	257
	258	/**
	259	* leo_blank - Optional function. Blanks the display.
	260	* @blank_mode: the blank mode we want.
	261	* @info: frame buffer structure that represents a single frame buffer
	262	*/
263	static int leo_blank(int blank, struct fb_info *info)
264	{
265	struct leo_par par = (struct leo_par ) info->par;
266	struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
267	unsigned long flags;
268	u32 val;
269
270	spin_lock_irqsave(&par->lock, flags);
271
272	switch (blank) {
273	case FB_BLANK_UNBLANK: /* Unblanking */
274	val = sbus_readl(&lx_krn->krn_csr);
275	val \|= LEO_KRN_CSR_ENABLE;
276	sbus_writel(val, &lx_krn->krn_csr);
277	par->flags &= ~LEO_FLAG_BLANKED;
278	break;
279
280	case FB_BLANK_NORMAL: /* Normal blanking */
281	case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */
282	case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */
283	case FB_BLANK_POWERDOWN: /* Poweroff */
284	val = sbus_readl(&lx_krn->krn_csr);
285	val &= ~LEO_KRN_CSR_ENABLE;
286	sbus_writel(val, &lx_krn->krn_csr);
287	par->flags \|= LEO_FLAG_BLANKED;
288	break;
289	}
290
291	spin_unlock_irqrestore(&par->lock, flags);
292
293	return 0;
294	}
295
296	static struct sbus_mmap_map leo_mmap_map[] = {
297	{
298	.voff = LEO_SS0_MAP,
299	.poff = LEO_OFF_SS0,
300	.size = 0x800000
301	},
302	{
303	.voff = LEO_LC_SS0_USR_MAP,
304	.poff = LEO_OFF_LC_SS0_USR,
305	.size = 0x1000
306	},
307	{
308	.voff = LEO_LD_SS0_MAP,
309	.poff = LEO_OFF_LD_SS0,
310	.size = 0x1000
311	},
312	{
313	.voff = LEO_LX_CURSOR_MAP,
314	.poff = LEO_OFF_LX_CURSOR,
315	.size = 0x1000
316	},
317	{
318	.voff = LEO_SS1_MAP,
319	.poff = LEO_OFF_SS1,
320	.size = 0x800000
321	},
322	{
323	.voff = LEO_LC_SS1_USR_MAP,
324	.poff = LEO_OFF_LC_SS1_USR,
325	.size = 0x1000
326	},
327	{
328	.voff = LEO_LD_SS1_MAP,
329	.poff = LEO_OFF_LD_SS1,
330	.size = 0x1000
331	},
332	{
333	.voff = LEO_UNK_MAP,
334	.poff = LEO_OFF_UNK,
335	.size = 0x1000
336	},
337	{
338	.voff = LEO_LX_KRN_MAP,
339	.poff = LEO_OFF_LX_KRN,
340	.size = 0x1000
341	},
342	{
343	.voff = LEO_LC_SS0_KRN_MAP,
344	.poff = LEO_OFF_LC_SS0_KRN,
345	.size = 0x1000
346	},
347	{
348	.voff = LEO_LC_SS1_KRN_MAP,
349	.poff = LEO_OFF_LC_SS1_KRN,
350	.size = 0x1000
351	},
352	{
353	.voff = LEO_LD_GBL_MAP,
354	.poff = LEO_OFF_LD_GBL,
355	.size = 0x1000
356	},
357	{
358	.voff = LEO_UNK2_MAP,
359	.poff = LEO_OFF_UNK2,
360	.size = 0x100000
361	},
362	{ .size = 0 }
363	};
364
216d526c	365	static int leo_mmap(struct fb_info info, struct vm_area_struct vma)
1da177e4 LT	366	{
	367	struct leo_par par = (struct leo_par )info->par;
	368
	369	return sbusfb_mmap_helper(leo_mmap_map,
	370	par->physbase, par->fbsize,
	371	par->sdev->reg_addrs[0].which_io,
	372	vma);
	373	}
	374
67a6680d	375	static int leo_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg)
1da177e4 LT	376	{
	377	struct leo_par par = (struct leo_par ) info->par;
	378
	379	return sbusfb_ioctl_helper(cmd, arg, info,
	380	FBTYPE_SUNLEO, 32, par->fbsize);
	381	}
	382
	383	/*
	384	* Initialisation
	385	*/
	386
	387	static void
	388	leo_init_fix(struct fb_info *info)
	389	{
	390	struct leo_par par = (struct leo_par )info->par;
	391
	392	strlcpy(info->fix.id, par->sdev->prom_name, sizeof(info->fix.id));
	393
	394	info->fix.type = FB_TYPE_PACKED_PIXELS;
	395	info->fix.visual = FB_VISUAL_TRUECOLOR;
	396
	397	info->fix.line_length = 8192;
	398
	399	info->fix.accel = FB_ACCEL_SUN_LEO;
	400	}
	401
	402	static void leo_wid_put(struct fb_info info, struct fb_wid_list wl)
	403	{
	404	struct leo_par par = (struct leo_par ) info->par;
	405	struct leo_lx_krn __iomem *lx_krn = par->lx_krn;
	406	struct fb_wid_item *wi;
	407	unsigned long flags;
	408	u32 val;
	409	int i, j;
	410
	411	spin_lock_irqsave(&par->lock, flags);
	412
	413	leo_wait(lx_krn);
	414
	415	for (i = 0, wi = wl->wl_list; i < wl->wl_count; i++, wi++) {
	416	switch(wi->wi_type) {
	417	case FB_WID_DBL_8:
	418	j = (wi->wi_index & 0xf) + 0x40;
	419	break;
	420
	421	case FB_WID_DBL_24:
	422	j = wi->wi_index & 0x3f;
	423	break;
	424
	425	default:
	426	continue;
	427	};
	428	sbus_writel(0x5800 + j, &lx_krn->krn_type);
	429	sbus_writel(wi->wi_values[0], &lx_krn->krn_value);
	430	}
	431	sbus_writel(LEO_KRN_TYPE_WID, &lx_krn->krn_type);
	432
	433	val = sbus_readl(&lx_krn->krn_csr);
	434	val \|= (LEO_KRN_CSR_UNK \| LEO_KRN_CSR_UNK2);
	435	sbus_writel(val, &lx_krn->krn_csr);
	436
	437	spin_unlock_irqrestore(&par->lock, flags);
	438	}
	439
440	static void leo_init_wids(struct fb_info *info)
441	{
442	struct fb_wid_item wi;
443	struct fb_wid_list wl;
444
445	wl.wl_count = 1;
446	wl.wl_list = &wi;
447	wi.wi_type = FB_WID_DBL_8;
448	wi.wi_index = 0;
449	wi.wi_values [0] = 0x2c0;
450	leo_wid_put(info, &wl);
451	wi.wi_index = 1;
452	wi.wi_values [0] = 0x30;
453	leo_wid_put(info, &wl);
454	wi.wi_index = 2;
455	wi.wi_values [0] = 0x20;
456	leo_wid_put(info, &wl);
457	wi.wi_type = FB_WID_DBL_24;
458	wi.wi_index = 1;
459	wi.wi_values [0] = 0x30;
460	leo_wid_put(info, &wl);
461
462	}
463
464	static void leo_switch_from_graph(struct fb_info *info)
465	{
466	struct leo_par par = (struct leo_par ) info->par;
467	struct leo_ld __iomem ss = (struct leo_ld __iomem ) par->ld_ss0;
468	unsigned long flags;
469	u32 val;
470
471	spin_lock_irqsave(&par->lock, flags);
472
473	par->extent = ((info->var.xres - 1) \|
474	((info->var.yres - 1) << 16));
475
476	sbus_writel(0xffffffff, &ss->wid);
477	sbus_writel(0xffff, &ss->wmask);
478	sbus_writel(0, &ss->vclipmin);
479	sbus_writel(par->extent, &ss->vclipmax);
480	sbus_writel(0, &ss->fg);
481	sbus_writel(0xff000000, &ss->planemask);
482	sbus_writel(0x310850, &ss->rop);
483	sbus_writel(0, &ss->widclip);
484	sbus_writel((info->var.xres-1) \| ((info->var.yres-1) << 11),
485	&par->lc_ss0_usr->extent);
486	sbus_writel(4, &par->lc_ss0_usr->addrspace);
487	sbus_writel(0x80000000, &par->lc_ss0_usr->fill);
488	sbus_writel(0, &par->lc_ss0_usr->fontt);
489	do {
490	val = sbus_readl(&par->lc_ss0_usr->csr);
491	} while (val & 0x20000000);
492
493	spin_unlock_irqrestore(&par->lock, flags);
494	}
495
496	static int leo_pan_display(struct fb_var_screeninfo var, struct fb_info info)
497	{
498	/* We just use this to catch switches out of
499	* graphics mode.
500	*/
501	leo_switch_from_graph(info);
502
503	if (var->xoffset \|\| var->yoffset \|\| var->vmode)
504	return -EINVAL;
505	return 0;
506	}
507
508	static void leo_init_hw(struct fb_info *info)
509	{
510	struct leo_par par = (struct leo_par ) info->par;
511	u32 val;
512
513	val = sbus_readl(&par->ld_ss1->ss1_misc);
514	val \|= LEO_SS1_MISC_ENABLE;
515	sbus_writel(val, &par->ld_ss1->ss1_misc);
516
517	leo_switch_from_graph(info);
518	}
519
520	static void leo_fixup_var_rgb(struct fb_var_screeninfo *var)
521	{
522	var->red.offset = 0;
523	var->red.length = 8;
524	var->green.offset = 8;
525	var->green.length = 8;
526	var->blue.offset = 16;
527	var->blue.length = 8;
528	var->transp.offset = 0;
529	var->transp.length = 0;
530	}
531
532	struct all_info {
533	struct fb_info info;
534	struct leo_par par;
535	struct list_head list;
536	};
537	static LIST_HEAD(leo_list);
538
539	static void leo_init_one(struct sbus_dev *sdev)
540	{
541	struct all_info *all;
542	int linebytes;
543
544	all = kmalloc(sizeof(*all), GFP_KERNEL);
545	if (!all) {
546	printk(KERN_ERR "leo: Cannot allocate memory.\n");
547	return;
548	}
549	memset(all, 0, sizeof(*all));
550
551	INIT_LIST_HEAD(&all->list);
552
553	spin_lock_init(&all->par.lock);
554	all->par.sdev = sdev;
555
556	all->par.physbase = sdev->reg_addrs[0].phys_addr;
557
558	sbusfb_fill_var(&all->info.var, sdev->prom_node, 32);
559	leo_fixup_var_rgb(&all->info.var);
560
561	linebytes = prom_getintdefault(sdev->prom_node, "linebytes",
562	all->info.var.xres);
563	all->par.fbsize = PAGE_ALIGN(linebytes * all->info.var.yres);
564
565	#ifdef CONFIG_SPARC32
566	all->info.screen_base = (char __iomem *)
567	prom_getintdefault(sdev->prom_node, "address", 0);
568	#endif
569	if (!all->info.screen_base)
570	all->info.screen_base =
571	sbus_ioremap(&sdev->resource[0], LEO_OFF_SS0,
572	0x800000, "leo ram");
573
574	all->par.lc_ss0_usr =
575	sbus_ioremap(&sdev->resource[0], LEO_OFF_LC_SS0_USR,
576	0x1000, "leolc ss0usr");
577	all->par.ld_ss0 =
578	sbus_ioremap(&sdev->resource[0], LEO_OFF_LD_SS0,
579	0x1000, "leold ss0");
580	all->par.ld_ss1 =
581	sbus_ioremap(&sdev->resource[0], LEO_OFF_LD_SS1,
582	0x1000, "leold ss1");
583	all->par.lx_krn =
584	sbus_ioremap(&sdev->resource[0], LEO_OFF_LX_KRN,
585	0x1000, "leolx krn");
586	all->par.cursor =
587	sbus_ioremap(&sdev->resource[0], LEO_OFF_LX_CURSOR,
588	sizeof(struct leo_cursor), "leolx cursor");
589
590	all->info.flags = FBINFO_DEFAULT \| FBINFO_HWACCEL_YPAN;
591	all->info.fbops = &leo_ops;
592	all->info.par = &all->par;
593
594	leo_init_wids(&all->info);
595	leo_init_hw(&all->info);
596
597	leo_blank(0, &all->info);
598
599	if (fb_alloc_cmap(&all->info.cmap, 256, 0)) {
600	printk(KERN_ERR "leo: Could not allocate color map.\n");
601	kfree(all);
602	return;
603	}
604
605	leo_init_fix(&all->info);
606
607	if (register_framebuffer(&all->info) < 0) {
608	printk(KERN_ERR "leo: Could not register framebuffer.\n");
609	fb_dealloc_cmap(&all->info.cmap);
610	kfree(all);
611	return;
612	}
613
614	list_add(&all->list, &leo_list);
615
616	printk("leo: %s at %lx:%lx\n",
617	sdev->prom_name,
618	(long) sdev->reg_addrs[0].which_io,
619	(long) sdev->reg_addrs[0].phys_addr);
620	}
621
622	int __init leo_init(void)
623	{
624	struct sbus_bus *sbus;
625	struct sbus_dev *sdev;
626
627	if (fb_get_options("leofb", NULL))
628	return -ENODEV;
629
630	for_all_sbusdev(sdev, sbus) {
631	if (!strcmp(sdev->prom_name, "leo"))
632	leo_init_one(sdev);
633	}
634
635	return 0;
636	}
637
638	void __exit leo_exit(void)
639	{
640	struct list_head pos, tmp;
641
642	list_for_each_safe(pos, tmp, &leo_list) {
643	struct all_info all = list_entry(pos, typeof(all), list);
644
645	unregister_framebuffer(&all->info);
646	fb_dealloc_cmap(&all->info.cmap);
647	kfree(all);
648	}
649	}
650
651	int __init
652	leo_setup(char *arg)
653	{
654	/* No cmdline options yet... */
655	return 0;
656	}
657
658	module_init(leo_init);
659	#ifdef MODULE
660	module_exit(leo_exit);
661	#endif
662
663	MODULE_DESCRIPTION("framebuffer driver for LEO chipsets");
664	MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
665	MODULE_LICENSE("GPL");