| /* p9100.c: P9100 frame buffer driver | 
 |  * | 
 |  * Copyright (C) 2003, 2006 David S. Miller (davem@davemloft.net) | 
 |  * Copyright 1999 Derrick J Brashear (shadow@dementia.org) | 
 |  * | 
 |  * 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 <asm/io.h> | 
 | #include <asm/fbio.h> | 
 |  | 
 | #include "sbuslib.h" | 
 |  | 
 | /* | 
 |  * Local functions. | 
 |  */ | 
 |  | 
 | static int p9100_setcolreg(unsigned, unsigned, unsigned, unsigned, | 
 | 			   unsigned, struct fb_info *); | 
 | static int p9100_blank(int, struct fb_info *); | 
 |  | 
 | static int p9100_mmap(struct fb_info *, struct vm_area_struct *); | 
 | static int p9100_ioctl(struct fb_info *, unsigned int, unsigned long); | 
 |  | 
 | /* | 
 |  *  Frame buffer operations | 
 |  */ | 
 |  | 
 | static struct fb_ops p9100_ops = { | 
 | 	.owner			= THIS_MODULE, | 
 | 	.fb_setcolreg		= p9100_setcolreg, | 
 | 	.fb_blank		= p9100_blank, | 
 | 	.fb_fillrect		= cfb_fillrect, | 
 | 	.fb_copyarea		= cfb_copyarea, | 
 | 	.fb_imageblit		= cfb_imageblit, | 
 | 	.fb_mmap		= p9100_mmap, | 
 | 	.fb_ioctl		= p9100_ioctl, | 
 | #ifdef CONFIG_COMPAT | 
 | 	.fb_compat_ioctl	= sbusfb_compat_ioctl, | 
 | #endif | 
 | }; | 
 |  | 
 | /* P9100 control registers */ | 
 | #define P9100_SYSCTL_OFF	0x0UL | 
 | #define P9100_VIDEOCTL_OFF	0x100UL | 
 | #define P9100_VRAMCTL_OFF 	0x180UL | 
 | #define P9100_RAMDAC_OFF 	0x200UL | 
 | #define P9100_VIDEOCOPROC_OFF 	0x400UL | 
 |  | 
 | /* P9100 command registers */ | 
 | #define P9100_CMD_OFF 0x0UL | 
 |  | 
 | /* P9100 framebuffer memory */ | 
 | #define P9100_FB_OFF 0x0UL | 
 |  | 
 | /* 3 bits: 2=8bpp 3=16bpp 5=32bpp 7=24bpp */ | 
 | #define SYS_CONFIG_PIXELSIZE_SHIFT 26  | 
 |  | 
 | #define SCREENPAINT_TIMECTL1_ENABLE_VIDEO 0x20 /* 0 = off, 1 = on */ | 
 |  | 
 | struct p9100_regs { | 
 | 	/* Registers for the system control */ | 
 | 	u32 sys_base; | 
 | 	u32 sys_config; | 
 | 	u32 sys_intr; | 
 | 	u32 sys_int_ena; | 
 | 	u32 sys_alt_rd; | 
 | 	u32 sys_alt_wr; | 
 | 	u32 sys_xxx[58]; | 
 |  | 
 | 	/* Registers for the video control */ | 
 | 	u32 vid_base; | 
 | 	u32 vid_hcnt; | 
 | 	u32 vid_htotal; | 
 | 	u32 vid_hsync_rise; | 
 | 	u32 vid_hblank_rise; | 
 | 	u32 vid_hblank_fall; | 
 | 	u32 vid_hcnt_preload; | 
 | 	u32 vid_vcnt; | 
 | 	u32 vid_vlen; | 
 | 	u32 vid_vsync_rise; | 
 | 	u32 vid_vblank_rise; | 
 | 	u32 vid_vblank_fall; | 
 | 	u32 vid_vcnt_preload; | 
 | 	u32 vid_screenpaint_addr; | 
 | 	u32 vid_screenpaint_timectl1; | 
 | 	u32 vid_screenpaint_qsfcnt; | 
 | 	u32 vid_screenpaint_timectl2; | 
 | 	u32 vid_xxx[15]; | 
 |  | 
 | 	/* Registers for the video control */ | 
 | 	u32 vram_base; | 
 | 	u32 vram_memcfg; | 
 | 	u32 vram_refresh_pd; | 
 | 	u32 vram_refresh_cnt; | 
 | 	u32 vram_raslo_max; | 
 | 	u32 vram_raslo_cur; | 
 | 	u32 pwrup_cfg; | 
 | 	u32 vram_xxx[25]; | 
 |  | 
 | 	/* Registers for IBM RGB528 Palette */ | 
 | 	u32 ramdac_cmap_wridx;  | 
 | 	u32 ramdac_palette_data; | 
 | 	u32 ramdac_pixel_mask; | 
 | 	u32 ramdac_palette_rdaddr; | 
 | 	u32 ramdac_idx_lo; | 
 | 	u32 ramdac_idx_hi; | 
 | 	u32 ramdac_idx_data; | 
 | 	u32 ramdac_idx_ctl; | 
 | 	u32 ramdac_xxx[1784]; | 
 | }; | 
 |  | 
 | struct p9100_cmd_parameng { | 
 | 	u32 parameng_status; | 
 | 	u32 parameng_bltcmd; | 
 | 	u32 parameng_quadcmd; | 
 | }; | 
 |  | 
 | struct p9100_par { | 
 | 	spinlock_t		lock; | 
 | 	struct p9100_regs	__iomem *regs; | 
 |  | 
 | 	u32			flags; | 
 | #define P9100_FLAG_BLANKED	0x00000001 | 
 |  | 
 | 	unsigned long		which_io; | 
 | }; | 
 |  | 
 | /** | 
 |  *      p9100_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 p9100_setcolreg(unsigned regno, | 
 | 			   unsigned red, unsigned green, unsigned blue, | 
 | 			   unsigned transp, struct fb_info *info) | 
 | { | 
 | 	struct p9100_par *par = (struct p9100_par *) info->par; | 
 | 	struct p9100_regs __iomem *regs = par->regs; | 
 | 	unsigned long flags; | 
 |  | 
 | 	if (regno >= 256) | 
 | 		return 1; | 
 |  | 
 | 	red >>= 8; | 
 | 	green >>= 8; | 
 | 	blue >>= 8; | 
 |  | 
 | 	spin_lock_irqsave(&par->lock, flags); | 
 |  | 
 | 	sbus_writel((regno << 16), ®s->ramdac_cmap_wridx); | 
 | 	sbus_writel((red << 16), ®s->ramdac_palette_data); | 
 | 	sbus_writel((green << 16), ®s->ramdac_palette_data); | 
 | 	sbus_writel((blue << 16), ®s->ramdac_palette_data); | 
 |  | 
 | 	spin_unlock_irqrestore(&par->lock, flags); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | /** | 
 |  *      p9100_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 | 
 | p9100_blank(int blank, struct fb_info *info) | 
 | { | 
 | 	struct p9100_par *par = (struct p9100_par *) info->par; | 
 | 	struct p9100_regs __iomem *regs = par->regs; | 
 | 	unsigned long flags; | 
 | 	u32 val; | 
 |  | 
 | 	spin_lock_irqsave(&par->lock, flags); | 
 |  | 
 | 	switch (blank) { | 
 | 	case FB_BLANK_UNBLANK: /* Unblanking */ | 
 | 		val = sbus_readl(®s->vid_screenpaint_timectl1); | 
 | 		val |= SCREENPAINT_TIMECTL1_ENABLE_VIDEO; | 
 | 		sbus_writel(val, ®s->vid_screenpaint_timectl1); | 
 | 		par->flags &= ~P9100_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(®s->vid_screenpaint_timectl1); | 
 | 		val &= ~SCREENPAINT_TIMECTL1_ENABLE_VIDEO; | 
 | 		sbus_writel(val, ®s->vid_screenpaint_timectl1); | 
 | 		par->flags |= P9100_FLAG_BLANKED; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	spin_unlock_irqrestore(&par->lock, flags); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct sbus_mmap_map p9100_mmap_map[] = { | 
 | 	{ CG3_MMAP_OFFSET,	0,		SBUS_MMAP_FBSIZE(1) }, | 
 | 	{ 0,			0,		0		    } | 
 | }; | 
 |  | 
 | static int p9100_mmap(struct fb_info *info, struct vm_area_struct *vma) | 
 | { | 
 | 	struct p9100_par *par = (struct p9100_par *)info->par; | 
 |  | 
 | 	return sbusfb_mmap_helper(p9100_mmap_map, | 
 | 				  info->fix.smem_start, info->fix.smem_len, | 
 | 				  par->which_io, vma); | 
 | } | 
 |  | 
 | static int p9100_ioctl(struct fb_info *info, unsigned int cmd, | 
 | 		       unsigned long arg) | 
 | { | 
 | 	/* Make it look like a cg3. */ | 
 | 	return sbusfb_ioctl_helper(cmd, arg, info, | 
 | 				   FBTYPE_SUN3COLOR, 8, info->fix.smem_len); | 
 | } | 
 |  | 
 | /* | 
 |  *  Initialisation | 
 |  */ | 
 |  | 
 | static void p9100_init_fix(struct fb_info *info, int linebytes, 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_PSEUDOCOLOR; | 
 |  | 
 | 	info->fix.line_length = linebytes; | 
 |  | 
 | 	info->fix.accel = FB_ACCEL_SUN_CGTHREE; | 
 | } | 
 |  | 
 | static int p9100_probe(struct platform_device *op) | 
 | { | 
 | 	struct device_node *dp = op->dev.of_node; | 
 | 	struct fb_info *info; | 
 | 	struct p9100_par *par; | 
 | 	int linebytes, err; | 
 |  | 
 | 	info = framebuffer_alloc(sizeof(struct p9100_par), &op->dev); | 
 |  | 
 | 	err = -ENOMEM; | 
 | 	if (!info) | 
 | 		goto out_err; | 
 | 	par = info->par; | 
 |  | 
 | 	spin_lock_init(&par->lock); | 
 |  | 
 | 	/* This is the framebuffer and the only resource apps can mmap.  */ | 
 | 	info->fix.smem_start = op->resource[2].start; | 
 | 	par->which_io = op->resource[2].flags & IORESOURCE_BITS; | 
 |  | 
 | 	sbusfb_fill_var(&info->var, dp, 8); | 
 | 	info->var.red.length = 8; | 
 | 	info->var.green.length = 8; | 
 | 	info->var.blue.length = 8; | 
 |  | 
 | 	linebytes = of_getintprop_default(dp, "linebytes", info->var.xres); | 
 | 	info->fix.smem_len = PAGE_ALIGN(linebytes * info->var.yres); | 
 |  | 
 | 	par->regs = of_ioremap(&op->resource[0], 0, | 
 | 			       sizeof(struct p9100_regs), "p9100 regs"); | 
 | 	if (!par->regs) | 
 | 		goto out_release_fb; | 
 |  | 
 | 	info->flags = FBINFO_DEFAULT; | 
 | 	info->fbops = &p9100_ops; | 
 | 	info->screen_base = of_ioremap(&op->resource[2], 0, | 
 | 				       info->fix.smem_len, "p9100 ram"); | 
 | 	if (!info->screen_base) | 
 | 		goto out_unmap_regs; | 
 |  | 
 | 	p9100_blank(FB_BLANK_UNBLANK, info); | 
 |  | 
 | 	if (fb_alloc_cmap(&info->cmap, 256, 0)) | 
 | 		goto out_unmap_screen; | 
 |  | 
 | 	p9100_init_fix(info, linebytes, dp); | 
 |  | 
 | 	err = register_framebuffer(info); | 
 | 	if (err < 0) | 
 | 		goto out_dealloc_cmap; | 
 |  | 
 | 	fb_set_cmap(&info->cmap, info); | 
 |  | 
 | 	dev_set_drvdata(&op->dev, info); | 
 |  | 
 | 	printk(KERN_INFO "%pOF: p9100 at %lx:%lx\n", | 
 | 	       dp, | 
 | 	       par->which_io, info->fix.smem_start); | 
 |  | 
 | 	return 0; | 
 |  | 
 | out_dealloc_cmap: | 
 | 	fb_dealloc_cmap(&info->cmap); | 
 |  | 
 | out_unmap_screen: | 
 | 	of_iounmap(&op->resource[2], info->screen_base, info->fix.smem_len); | 
 |  | 
 | out_unmap_regs: | 
 | 	of_iounmap(&op->resource[0], par->regs, sizeof(struct p9100_regs)); | 
 |  | 
 | out_release_fb: | 
 | 	framebuffer_release(info); | 
 |  | 
 | out_err: | 
 | 	return err; | 
 | } | 
 |  | 
 | static int p9100_remove(struct platform_device *op) | 
 | { | 
 | 	struct fb_info *info = dev_get_drvdata(&op->dev); | 
 | 	struct p9100_par *par = info->par; | 
 |  | 
 | 	unregister_framebuffer(info); | 
 | 	fb_dealloc_cmap(&info->cmap); | 
 |  | 
 | 	of_iounmap(&op->resource[0], par->regs, sizeof(struct p9100_regs)); | 
 | 	of_iounmap(&op->resource[2], info->screen_base, info->fix.smem_len); | 
 |  | 
 | 	framebuffer_release(info); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static const struct of_device_id p9100_match[] = { | 
 | 	{ | 
 | 		.name = "p9100", | 
 | 	}, | 
 | 	{}, | 
 | }; | 
 | MODULE_DEVICE_TABLE(of, p9100_match); | 
 |  | 
 | static struct platform_driver p9100_driver = { | 
 | 	.driver = { | 
 | 		.name = "p9100", | 
 | 		.of_match_table = p9100_match, | 
 | 	}, | 
 | 	.probe		= p9100_probe, | 
 | 	.remove		= p9100_remove, | 
 | }; | 
 |  | 
 | static int __init p9100_init(void) | 
 | { | 
 | 	if (fb_get_options("p9100fb", NULL)) | 
 | 		return -ENODEV; | 
 |  | 
 | 	return platform_driver_register(&p9100_driver); | 
 | } | 
 |  | 
 | static void __exit p9100_exit(void) | 
 | { | 
 | 	platform_driver_unregister(&p9100_driver); | 
 | } | 
 |  | 
 | module_init(p9100_init); | 
 | module_exit(p9100_exit); | 
 |  | 
 | MODULE_DESCRIPTION("framebuffer driver for P9100 chipsets"); | 
 | MODULE_AUTHOR("David S. Miller <davem@davemloft.net>"); | 
 | MODULE_VERSION("2.0"); | 
 | MODULE_LICENSE("GPL"); |