[linux-2.6-block.git] / drivers / video / fbdev / hitfb.c

/*
 * linux/drivers/video/hitfb.c -- Hitachi LCD frame buffer device
 *
 * (C) 1999 Mihai Spatar
 * (C) 2000 YAEGASHI Takeshi
 * (C) 2003, 2004 Paul Mundt
 * (C) 2003, 2004, 2006 Andriy Skulysh
 *
 *  This file is subject to the terms and conditions of the GNU General Public
 *  License. See the file COPYING in the main directory of this archive for
 *  more details.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/fb.h>

#include <asm/machvec.h>
#include <linux/uaccess.h>
#include <asm/io.h>
#include <asm/hd64461.h>
#include <cpu/dac.h>

#define	WIDTH 640

static struct fb_var_screeninfo hitfb_var = {
	.activate	= FB_ACTIVATE_NOW,
	.height		= -1,
	.width		= -1,
	.vmode		= FB_VMODE_NONINTERLACED,
};

static struct fb_fix_screeninfo hitfb_fix = {
	.id		= "Hitachi HD64461",
	.type		= FB_TYPE_PACKED_PIXELS,
	.accel		= FB_ACCEL_NONE,
};

static volatile void __iomem *hitfb_offset_to_addr(unsigned int offset)
{
	return (__force volatile void __iomem *)(uintptr_t)offset;
}

static u16 hitfb_readw(unsigned int offset)
{
	return fb_readw(hitfb_offset_to_addr(offset));
}

static void hitfb_writew(u16 value, unsigned int offset)
{
	fb_writew(value, hitfb_offset_to_addr(offset));
}

static inline void hitfb_accel_wait(void)
{
	while (hitfb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS)
		;
}

static inline void hitfb_accel_start(int truecolor)
{
	if (truecolor) {
		hitfb_writew(6, HD64461_GRCFGR);
	} else {
		hitfb_writew(7, HD64461_GRCFGR);
	}
}

static inline void hitfb_accel_set_dest(int truecolor, u16 dx, u16 dy,
					u16 width, u16 height)
{
	u32 saddr = WIDTH * dy + dx;
	if (truecolor)
		saddr <<= 1;

	hitfb_writew(width-1, HD64461_BBTDWR);
	hitfb_writew(height-1, HD64461_BBTDHR);

	hitfb_writew(saddr & 0xffff, HD64461_BBTDSARL);
	hitfb_writew(saddr >> 16, HD64461_BBTDSARH);

}

static inline void hitfb_accel_bitblt(int truecolor, u16 sx, u16 sy, u16 dx,
				      u16 dy, u16 width, u16 height, u16 rop,
				      u32 mask_addr)
{
	u32 saddr, daddr;
	u32 maddr = 0;

	height--;
	width--;
	hitfb_writew(rop, HD64461_BBTROPR);
	if ((sy < dy) || ((sy == dy) && (sx <= dx))) {
		saddr = WIDTH * (sy + height) + sx + width;
		daddr = WIDTH * (dy + height) + dx + width;
		if (mask_addr) {
			if (truecolor)
				maddr = ((width >> 3) + 1) * (height + 1) - 1;
			else
				maddr =
				    (((width >> 4) + 1) * (height + 1) - 1) * 2;

			hitfb_writew((1 << 5) | 1, HD64461_BBTMDR);
		} else
			hitfb_writew(1, HD64461_BBTMDR);
	} else {
		saddr = WIDTH * sy + sx;
		daddr = WIDTH * dy + dx;
		if (mask_addr) {
			hitfb_writew((1 << 5), HD64461_BBTMDR);
		} else {
			hitfb_writew(0, HD64461_BBTMDR);
		}
	}
	if (truecolor) {
		saddr <<= 1;
		daddr <<= 1;
	}
	hitfb_writew(width, HD64461_BBTDWR);
	hitfb_writew(height, HD64461_BBTDHR);
	hitfb_writew(saddr & 0xffff, HD64461_BBTSSARL);
	hitfb_writew(saddr >> 16, HD64461_BBTSSARH);
	hitfb_writew(daddr & 0xffff, HD64461_BBTDSARL);
	hitfb_writew(daddr >> 16, HD64461_BBTDSARH);
	if (mask_addr) {
		maddr += mask_addr;
		hitfb_writew(maddr & 0xffff, HD64461_BBTMARL);
		hitfb_writew(maddr >> 16, HD64461_BBTMARH);
	}
	hitfb_accel_start(truecolor);
}

static void hitfb_fillrect(struct fb_info *p, const struct fb_fillrect *rect)
{
	if (rect->rop != ROP_COPY)
		cfb_fillrect(p, rect);
	else {
		hitfb_accel_wait();
		hitfb_writew(0x00f0, HD64461_BBTROPR);
		hitfb_writew(16, HD64461_BBTMDR);

		if (p->var.bits_per_pixel == 16) {
			hitfb_writew(((u32 *) (p->pseudo_palette))[rect->color],
				  HD64461_GRSCR);
			hitfb_accel_set_dest(1, rect->dx, rect->dy, rect->width,
					     rect->height);
			hitfb_accel_start(1);
		} else {
			hitfb_writew(rect->color, HD64461_GRSCR);
			hitfb_accel_set_dest(0, rect->dx, rect->dy, rect->width,
					     rect->height);
			hitfb_accel_start(0);
		}
	}
}

static void hitfb_copyarea(struct fb_info *p, const struct fb_copyarea *area)
{
	hitfb_accel_wait();
	hitfb_accel_bitblt(p->var.bits_per_pixel == 16, area->sx, area->sy,
			   area->dx, area->dy, area->width, area->height,
			   0x00cc, 0);
}

static int hitfb_pan_display(struct fb_var_screeninfo *var,
			     struct fb_info *info)
{
	int xoffset = var->xoffset;
	int yoffset = var->yoffset;

	if (xoffset != 0)
		return -EINVAL;

	hitfb_writew((yoffset*info->fix.line_length)>>10, HD64461_LCDCBAR);

	return 0;
}

static int hitfb_blank(int blank_mode, struct fb_info *info)
{
	unsigned short v;

	if (blank_mode) {
		v = hitfb_readw(HD64461_LDR1);
		v &= ~HD64461_LDR1_DON;
		hitfb_writew(v, HD64461_LDR1);

		v = hitfb_readw(HD64461_LCDCCR);
		v |= HD64461_LCDCCR_MOFF;
		hitfb_writew(v, HD64461_LCDCCR);

		v = hitfb_readw(HD64461_STBCR);
		v |= HD64461_STBCR_SLCDST;
		hitfb_writew(v, HD64461_STBCR);
	} else {
		v = hitfb_readw(HD64461_STBCR);
		v &= ~HD64461_STBCR_SLCDST;
		hitfb_writew(v, HD64461_STBCR);

		v = hitfb_readw(HD64461_LCDCCR);
		v &= ~(HD64461_LCDCCR_MOFF | HD64461_LCDCCR_STREQ);
		hitfb_writew(v, HD64461_LCDCCR);

		do {
		    v = hitfb_readw(HD64461_LCDCCR);
		} while(v&HD64461_LCDCCR_STBACK);

		v = hitfb_readw(HD64461_LDR1);
		v |= HD64461_LDR1_DON;
		hitfb_writew(v, HD64461_LDR1);
	}
	return 0;
}

static int hitfb_setcolreg(unsigned regno, unsigned red, unsigned green,
			   unsigned blue, unsigned transp, struct fb_info *info)
{
	if (regno >= 256)
		return 1;

	switch (info->var.bits_per_pixel) {
	case 8:
		hitfb_writew(regno << 8, HD64461_CPTWAR);
		hitfb_writew(red >> 10, HD64461_CPTWDR);
		hitfb_writew(green >> 10, HD64461_CPTWDR);
		hitfb_writew(blue >> 10, HD64461_CPTWDR);
		break;
	case 16:
		if (regno >= 16)
			return 1;
		((u32 *) (info->pseudo_palette))[regno] =
		    ((red & 0xf800)) |
		    ((green & 0xfc00) >> 5) | ((blue & 0xf800) >> 11);
		break;
	}
	return 0;
}

static int hitfb_sync(struct fb_info *info)
{
	hitfb_accel_wait();

	return 0;
}

static int hitfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
{
	int maxy;

	var->xres = info->var.xres;
	var->xres_virtual = info->var.xres;
	var->yres = info->var.yres;

	if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16))
		var->bits_per_pixel = info->var.bits_per_pixel;

	if (var->yres_virtual < var->yres)
		var->yres_virtual = var->yres;

	maxy = info->fix.smem_len / var->xres;

	if (var->bits_per_pixel == 16)
		maxy /= 2;

	if (var->yres_virtual > maxy)
		var->yres_virtual = maxy;

	var->xoffset = 0;
	var->yoffset = 0;

	switch (var->bits_per_pixel) {
	case 8:
		var->red.offset = 0;
		var->red.length = 8;
		var->green.offset = 0;
		var->green.length = 8;
		var->blue.offset = 0;
		var->blue.length = 8;
		var->transp.offset = 0;
		var->transp.length = 0;
		break;
	case 16:		/* RGB 565 */
		var->red.offset = 11;
		var->red.length = 5;
		var->green.offset = 5;
		var->green.length = 6;
		var->blue.offset = 0;
		var->blue.length = 5;
		var->transp.offset = 0;
		var->transp.length = 0;
		break;
	}

	return 0;
}

static int hitfb_set_par(struct fb_info *info)
{
	unsigned short ldr3;

	switch (info->var.bits_per_pixel) {
	case 8:
		info->fix.line_length = info->var.xres;
		info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
		info->fix.ypanstep = 16;
		break;
	case 16:
		info->fix.line_length = info->var.xres*2;
		info->fix.visual = FB_VISUAL_TRUECOLOR;
		info->fix.ypanstep = 8;
		break;
	}

	hitfb_writew(info->fix.line_length, HD64461_LCDCLOR);
	ldr3 = hitfb_readw(HD64461_LDR3);
	ldr3 &= ~15;
	ldr3 |= (info->var.bits_per_pixel == 8) ? 4 : 8;
	hitfb_writew(ldr3, HD64461_LDR3);
	return 0;
}

static const struct fb_ops hitfb_ops = {
	.owner		= THIS_MODULE,
	__FB_DEFAULT_IOMEM_OPS_RDWR,
	.fb_check_var	= hitfb_check_var,
	.fb_set_par	= hitfb_set_par,
	.fb_setcolreg	= hitfb_setcolreg,
	.fb_blank	= hitfb_blank,
	.fb_sync	= hitfb_sync,
	.fb_pan_display = hitfb_pan_display,
	.fb_fillrect	= hitfb_fillrect,
	.fb_copyarea	= hitfb_copyarea,
	.fb_imageblit	= cfb_imageblit,
	__FB_DEFAULT_IOMEM_OPS_MMAP,
};

static int hitfb_probe(struct platform_device *dev)
{
	unsigned short lcdclor, ldr3, ldvndr;
	struct fb_info *info;
	int ret;

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

	hitfb_fix.mmio_start = HD64461_IO_OFFSET(0x1000);
	hitfb_fix.mmio_len = 0x1000;
	hitfb_fix.smem_start = HD64461_IO_OFFSET(0x02000000);
	hitfb_fix.smem_len = 512 * 1024;

	lcdclor = hitfb_readw(HD64461_LCDCLOR);
	ldvndr = hitfb_readw(HD64461_LDVNDR);
	ldr3 = hitfb_readw(HD64461_LDR3);

	switch (ldr3 & 15) {
	default:
	case 4:
		hitfb_var.bits_per_pixel = 8;
		hitfb_var.xres = lcdclor;
		break;
	case 8:
		hitfb_var.bits_per_pixel = 16;
		hitfb_var.xres = lcdclor / 2;
		break;
	}
	hitfb_fix.line_length = lcdclor;
	hitfb_fix.visual = (hitfb_var.bits_per_pixel == 8) ?
	    FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
	hitfb_var.yres = ldvndr + 1;
	hitfb_var.xres_virtual = hitfb_var.xres;
	hitfb_var.yres_virtual = hitfb_fix.smem_len / lcdclor;
	switch (hitfb_var.bits_per_pixel) {
	case 8:
		hitfb_var.red.offset = 0;
		hitfb_var.red.length = 8;
		hitfb_var.green.offset = 0;
		hitfb_var.green.length = 8;
		hitfb_var.blue.offset = 0;
		hitfb_var.blue.length = 8;
		hitfb_var.transp.offset = 0;
		hitfb_var.transp.length = 0;
		break;
	case 16:		/* RGB 565 */
		hitfb_var.red.offset = 11;
		hitfb_var.red.length = 5;
		hitfb_var.green.offset = 5;
		hitfb_var.green.length = 6;
		hitfb_var.blue.offset = 0;
		hitfb_var.blue.length = 5;
		hitfb_var.transp.offset = 0;
		hitfb_var.transp.length = 0;
		break;
	}

	info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev);
	if (unlikely(!info))
		return -ENOMEM;

	info->fbops = &hitfb_ops;
	info->var = hitfb_var;
	info->fix = hitfb_fix;
	info->pseudo_palette = info->par;
	info->flags = FBINFO_HWACCEL_YPAN |
		FBINFO_HWACCEL_FILLRECT | FBINFO_HWACCEL_COPYAREA;

	info->screen_base = (char __iomem *)(uintptr_t)hitfb_fix.smem_start;

	ret = fb_alloc_cmap(&info->cmap, 256, 0);
	if (unlikely(ret < 0))
		goto err_fb;

	ret = register_framebuffer(info);
	if (unlikely(ret < 0))
		goto err;

	platform_set_drvdata(dev, info);

	fb_info(info, "%s frame buffer device\n", info->fix.id);

	return 0;

err:
	fb_dealloc_cmap(&info->cmap);
err_fb:
	framebuffer_release(info);
	return ret;
}

static void hitfb_remove(struct platform_device *dev)
{
	struct fb_info *info = platform_get_drvdata(dev);

	unregister_framebuffer(info);
	fb_dealloc_cmap(&info->cmap);
	framebuffer_release(info);
}

static int hitfb_suspend(struct device *dev)
{
	u16 v;

	hitfb_blank(1, NULL);
	v = hitfb_readw(HD64461_STBCR);
	v |= HD64461_STBCR_SLCKE_IST;
	hitfb_writew(v, HD64461_STBCR);

	return 0;
}

static int hitfb_resume(struct device *dev)
{
	u16 v;

	v = hitfb_readw(HD64461_STBCR);
	v &= ~HD64461_STBCR_SLCKE_OST;
	msleep(100);
	v = hitfb_readw(HD64461_STBCR);
	v &= ~HD64461_STBCR_SLCKE_IST;
	hitfb_writew(v, HD64461_STBCR);
	hitfb_blank(0, NULL);

	return 0;
}

static const struct dev_pm_ops hitfb_dev_pm_ops = {
	.suspend	= hitfb_suspend,
	.resume		= hitfb_resume,
};

static struct platform_driver hitfb_driver = {
	.probe		= hitfb_probe,
	.remove_new	= hitfb_remove,
	.driver		= {
		.name	= "hitfb",
		.pm	= &hitfb_dev_pm_ops,
	},
};

static struct platform_device hitfb_device = {
	.name	= "hitfb",
	.id	= -1,
};

static int __init hitfb_init(void)
{
	int ret;

	ret = platform_driver_register(&hitfb_driver);
	if (!ret) {
		ret = platform_device_register(&hitfb_device);
		if (ret)
			platform_driver_unregister(&hitfb_driver);
	}
	return ret;
}


static void __exit hitfb_exit(void)
{
	platform_device_unregister(&hitfb_device);
	platform_driver_unregister(&hitfb_driver);
}

module_init(hitfb_init);
module_exit(hitfb_exit);

MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/drivers/video/hitfb.c -- Hitachi LCD frame buffer device
	3	*
	4	* (C) 1999 Mihai Spatar
	5	* (C) 2000 YAEGASHI Takeshi
	6	* (C) 2003, 2004 Paul Mundt
048839dc	7	* (C) 2003, 2004, 2006 Andriy Skulysh
1da177e4 LT	8	*
	9	* This file is subject to the terms and conditions of the GNU General Public
	10	* License. See the file COPYING in the main directory of this archive for
	11	* more details.
	12	*/
	13
1da177e4 LT	14	#include <linux/module.h>
1da177e4 LT	15	#include <linux/kernel.h>
1da177e4 LT	16	#include <linux/errno.h>
	17	#include <linux/string.h>
	18	#include <linux/mm.h>
1da177e4 LT	19	#include <linux/delay.h>
1da177e4 LT	20	#include <linux/init.h>
048839dc	21	#include <linux/platform_device.h>
1da177e4 LT	22	#include <linux/fb.h>
	23
	24	#include <asm/machvec.h>
7c0f6ba6	25	#include <linux/uaccess.h>
1da177e4	26	#include <asm/io.h>
048839dc	27	#include <asm/hd64461.h>
193f3c2f	28	#include <cpu/dac.h>
1da177e4 LT	29
	30	#define WIDTH 640
	31
48c68c4f	32	static struct fb_var_screeninfo hitfb_var = {
1da177e4 LT	33	.activate = FB_ACTIVATE_NOW,
	34	.height = -1,
	35	.width = -1,
	36	.vmode = FB_VMODE_NONINTERLACED,
	37	};
	38
48c68c4f	39	static struct fb_fix_screeninfo hitfb_fix = {
1da177e4 LT	40	.id = "Hitachi HD64461",
1da177e4 LT	41	.type = FB_TYPE_PACKED_PIXELS,
1da177e4 LT	42	.accel = FB_ACCEL_NONE,
	43	};
	44
bb47f218 TZ	45	static volatile void __iomem *hitfb_offset_to_addr(unsigned int offset)
	46	{
	47	return (__force volatile void __iomem *)(uintptr_t)offset;
	48	}
	49
	50	static u16 hitfb_readw(unsigned int offset)
	51	{
	52	return fb_readw(hitfb_offset_to_addr(offset));
	53	}
	54
	55	static void hitfb_writew(u16 value, unsigned int offset)
	56	{
	57	fb_writew(value, hitfb_offset_to_addr(offset));
	58	}
	59
1da177e4 LT	60	static inline void hitfb_accel_wait(void)
1da177e4 LT	61	{
bb47f218 TZ	62	while (hitfb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS)
bb47f218 TZ	63	;
1da177e4 LT	64	}
	65
	66	static inline void hitfb_accel_start(int truecolor)
	67	{
	68	if (truecolor) {
bb47f218	69	hitfb_writew(6, HD64461_GRCFGR);
1da177e4	70	} else {
bb47f218	71	hitfb_writew(7, HD64461_GRCFGR);
1da177e4 LT	72	}
	73	}
	74
	75	static inline void hitfb_accel_set_dest(int truecolor, u16 dx, u16 dy,
	76	u16 width, u16 height)
	77	{
	78	u32 saddr = WIDTH * dy + dx;
	79	if (truecolor)
	80	saddr <<= 1;
	81
bb47f218 TZ	82	hitfb_writew(width-1, HD64461_BBTDWR);
bb47f218 TZ	83	hitfb_writew(height-1, HD64461_BBTDHR);
1da177e4	84
bb47f218 TZ	85	hitfb_writew(saddr & 0xffff, HD64461_BBTDSARL);
bb47f218 TZ	86	hitfb_writew(saddr >> 16, HD64461_BBTDSARH);
1da177e4 LT	87
	88	}
	89
1da177e4 LT	90	static inline void hitfb_accel_bitblt(int truecolor, u16 sx, u16 sy, u16 dx,
	91	u16 dy, u16 width, u16 height, u16 rop,
	92	u32 mask_addr)
	93	{
	94	u32 saddr, daddr;
	95	u32 maddr = 0;
	96
048839dc AS	97	height--;
048839dc AS	98	width--;
bb47f218	99	hitfb_writew(rop, HD64461_BBTROPR);
1da177e4 LT	100	if ((sy < dy) \|\| ((sy == dy) && (sx <= dx))) {
	101	saddr = WIDTH * (sy + height) + sx + width;
	102	daddr = WIDTH * (dy + height) + dx + width;
	103	if (mask_addr) {
	104	if (truecolor)
	105	maddr = ((width >> 3) + 1) * (height + 1) - 1;
	106	else
	107	maddr =
	108	(((width >> 4) + 1) * (height + 1) - 1) * 2;
	109
bb47f218	110	hitfb_writew((1 << 5) \| 1, HD64461_BBTMDR);
1da177e4	111	} else
bb47f218	112	hitfb_writew(1, HD64461_BBTMDR);
1da177e4 LT	113	} else {
	114	saddr = WIDTH * sy + sx;
	115	daddr = WIDTH * dy + dx;
	116	if (mask_addr) {
bb47f218	117	hitfb_writew((1 << 5), HD64461_BBTMDR);
1da177e4	118	} else {
bb47f218	119	hitfb_writew(0, HD64461_BBTMDR);
1da177e4 LT	120	}
	121	}
	122	if (truecolor) {
	123	saddr <<= 1;
	124	daddr <<= 1;
	125	}
bb47f218 TZ	126	hitfb_writew(width, HD64461_BBTDWR);
	127	hitfb_writew(height, HD64461_BBTDHR);
	128	hitfb_writew(saddr & 0xffff, HD64461_BBTSSARL);
	129	hitfb_writew(saddr >> 16, HD64461_BBTSSARH);
	130	hitfb_writew(daddr & 0xffff, HD64461_BBTDSARL);
	131	hitfb_writew(daddr >> 16, HD64461_BBTDSARH);
1da177e4 LT	132	if (mask_addr) {
1da177e4 LT	133	maddr += mask_addr;
bb47f218 TZ	134	hitfb_writew(maddr & 0xffff, HD64461_BBTMARL);
bb47f218 TZ	135	hitfb_writew(maddr >> 16, HD64461_BBTMARH);
1da177e4 LT	136	}
	137	hitfb_accel_start(truecolor);
	138	}
	139
	140	static void hitfb_fillrect(struct fb_info p, const struct fb_fillrect rect)
	141	{
	142	if (rect->rop != ROP_COPY)
	143	cfb_fillrect(p, rect);
	144	else {
048839dc	145	hitfb_accel_wait();
bb47f218 TZ	146	hitfb_writew(0x00f0, HD64461_BBTROPR);
bb47f218 TZ	147	hitfb_writew(16, HD64461_BBTMDR);
1da177e4 LT	148
1da177e4 LT	149	if (p->var.bits_per_pixel == 16) {
bb47f218	150	hitfb_writew(((u32 *) (p->pseudo_palette))[rect->color],
1da177e4 LT	151	HD64461_GRSCR);
	152	hitfb_accel_set_dest(1, rect->dx, rect->dy, rect->width,
	153	rect->height);
	154	hitfb_accel_start(1);
	155	} else {
bb47f218	156	hitfb_writew(rect->color, HD64461_GRSCR);
1da177e4 LT	157	hitfb_accel_set_dest(0, rect->dx, rect->dy, rect->width,
	158	rect->height);
	159	hitfb_accel_start(0);
	160	}
1da177e4 LT	161	}
	162	}
	163
	164	static void hitfb_copyarea(struct fb_info p, const struct fb_copyarea area)
	165	{
048839dc	166	hitfb_accel_wait();
1da177e4 LT	167	hitfb_accel_bitblt(p->var.bits_per_pixel == 16, area->sx, area->sy,
	168	area->dx, area->dy, area->width, area->height,
	169	0x00cc, 0);
1da177e4 LT	170	}
	171
	172	static int hitfb_pan_display(struct fb_var_screeninfo *var,
	173	struct fb_info *info)
	174	{
	175	int xoffset = var->xoffset;
	176	int yoffset = var->yoffset;
	177
	178	if (xoffset != 0)
	179	return -EINVAL;
	180
bb47f218	181	hitfb_writew((yoffset*info->fix.line_length)>>10, HD64461_LCDCBAR);
1da177e4 LT	182
	183	return 0;
	184	}
	185
0f104470	186	static int hitfb_blank(int blank_mode, struct fb_info *info)
1da177e4 LT	187	{
	188	unsigned short v;
	189
	190	if (blank_mode) {
bb47f218	191	v = hitfb_readw(HD64461_LDR1);
1da177e4	192	v &= ~HD64461_LDR1_DON;
bb47f218	193	hitfb_writew(v, HD64461_LDR1);
1da177e4	194
bb47f218	195	v = hitfb_readw(HD64461_LCDCCR);
1da177e4	196	v \|= HD64461_LCDCCR_MOFF;
bb47f218	197	hitfb_writew(v, HD64461_LCDCCR);
1da177e4	198
bb47f218	199	v = hitfb_readw(HD64461_STBCR);
1da177e4	200	v \|= HD64461_STBCR_SLCDST;
bb47f218	201	hitfb_writew(v, HD64461_STBCR);
1da177e4	202	} else {
bb47f218	203	v = hitfb_readw(HD64461_STBCR);
1da177e4	204	v &= ~HD64461_STBCR_SLCDST;
bb47f218	205	hitfb_writew(v, HD64461_STBCR);
4bcac20a	206
bb47f218	207	v = hitfb_readw(HD64461_LCDCCR);
048839dc	208	v &= ~(HD64461_LCDCCR_MOFF \| HD64461_LCDCCR_STREQ);
bb47f218	209	hitfb_writew(v, HD64461_LCDCCR);
048839dc AS	210
048839dc AS	211	do {
bb47f218	212	v = hitfb_readw(HD64461_LCDCCR);
048839dc AS	213	} while(v&HD64461_LCDCCR_STBACK);
048839dc AS	214
bb47f218	215	v = hitfb_readw(HD64461_LDR1);
1da177e4	216	v \|= HD64461_LDR1_DON;
bb47f218	217	hitfb_writew(v, HD64461_LDR1);
1da177e4 LT	218	}
	219	return 0;
	220	}
	221
	222	static int hitfb_setcolreg(unsigned regno, unsigned red, unsigned green,
	223	unsigned blue, unsigned transp, struct fb_info *info)
	224	{
048839dc	225	if (regno >= 256)
1da177e4 LT	226	return 1;
	227
	228	switch (info->var.bits_per_pixel) {
	229	case 8:
bb47f218 TZ	230	hitfb_writew(regno << 8, HD64461_CPTWAR);
	231	hitfb_writew(red >> 10, HD64461_CPTWDR);
	232	hitfb_writew(green >> 10, HD64461_CPTWDR);
	233	hitfb_writew(blue >> 10, HD64461_CPTWDR);
1da177e4 LT	234	break;
1da177e4 LT	235	case 16:
048839dc AS	236	if (regno >= 16)
048839dc AS	237	return 1;
1da177e4 LT	238	((u32 *) (info->pseudo_palette))[regno] =
	239	((red & 0xf800)) \|
	240	((green & 0xfc00) >> 5) \| ((blue & 0xf800) >> 11);
	241	break;
	242	}
	243	return 0;
	244	}
	245
048839dc AS	246	static int hitfb_sync(struct fb_info *info)
	247	{
	248	hitfb_accel_wait();
	249
	250	return 0;
	251	}
	252
	253	static int hitfb_check_var(struct fb_var_screeninfo var, struct fb_info info)
	254	{
	255	int maxy;
	256
	257	var->xres = info->var.xres;
	258	var->xres_virtual = info->var.xres;
	259	var->yres = info->var.yres;
	260
	261	if ((var->bits_per_pixel != 8) && (var->bits_per_pixel != 16))
	262	var->bits_per_pixel = info->var.bits_per_pixel;
	263
	264	if (var->yres_virtual < var->yres)
	265	var->yres_virtual = var->yres;
	266
	267	maxy = info->fix.smem_len / var->xres;
	268
	269	if (var->bits_per_pixel == 16)
	270	maxy /= 2;
	271
	272	if (var->yres_virtual > maxy)
	273	var->yres_virtual = maxy;
	274
	275	var->xoffset = 0;
	276	var->yoffset = 0;
	277
	278	switch (var->bits_per_pixel) {
	279	case 8:
	280	var->red.offset = 0;
	281	var->red.length = 8;
	282	var->green.offset = 0;
	283	var->green.length = 8;
	284	var->blue.offset = 0;
	285	var->blue.length = 8;
	286	var->transp.offset = 0;
	287	var->transp.length = 0;
	288	break;
	289	case 16: /* RGB 565 */
	290	var->red.offset = 11;
	291	var->red.length = 5;
	292	var->green.offset = 5;
	293	var->green.length = 6;
	294	var->blue.offset = 0;
	295	var->blue.length = 5;
	296	var->transp.offset = 0;
	297	var->transp.length = 0;
	298	break;
	299	}
	300
	301	return 0;
	302	}
	303
	304	static int hitfb_set_par(struct fb_info *info)
	305	{
	306	unsigned short ldr3;
	307
	308	switch (info->var.bits_per_pixel) {
	309	case 8:
310	info->fix.line_length = info->var.xres;
311	info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
312	info->fix.ypanstep = 16;
313	break;
314	case 16:
315	info->fix.line_length = info->var.xres*2;
316	info->fix.visual = FB_VISUAL_TRUECOLOR;
317	info->fix.ypanstep = 8;
318	break;
319	}
320
bb47f218 TZ	321	hitfb_writew(info->fix.line_length, HD64461_LCDCLOR);
bb47f218 TZ	322	ldr3 = hitfb_readw(HD64461_LDR3);
048839dc AS	323	ldr3 &= ~15;
048839dc AS	324	ldr3 \|= (info->var.bits_per_pixel == 8) ? 4 : 8;
bb47f218	325	hitfb_writew(ldr3, HD64461_LDR3);
048839dc AS	326	return 0;
	327	}
	328
8a48ac33	329	static const struct fb_ops hitfb_ops = {
1da177e4	330	.owner = THIS_MODULE,
a1a1c3fa	331	__FB_DEFAULT_IOMEM_OPS_RDWR,
048839dc	332	.fb_check_var = hitfb_check_var,
a1a1c3fa	333	.fb_set_par = hitfb_set_par,
1da177e4 LT	334	.fb_setcolreg = hitfb_setcolreg,
1da177e4 LT	335	.fb_blank = hitfb_blank,
048839dc	336	.fb_sync = hitfb_sync,
1da177e4 LT	337	.fb_pan_display = hitfb_pan_display,
	338	.fb_fillrect = hitfb_fillrect,
	339	.fb_copyarea = hitfb_copyarea,
	340	.fb_imageblit = cfb_imageblit,
a1a1c3fa	341	__FB_DEFAULT_IOMEM_OPS_MMAP,
1da177e4 LT	342	};
1da177e4 LT	343
48c68c4f	344	static int hitfb_probe(struct platform_device *dev)
1da177e4 LT	345	{
1da177e4 LT	346	unsigned short lcdclor, ldr3, ldvndr;
684dcd05 PM	347	struct fb_info *info;
684dcd05 PM	348	int ret;
1da177e4 LT	349
	350	if (fb_get_options("hitfb", NULL))
	351	return -ENODEV;
	352
62669e61	353	hitfb_fix.mmio_start = HD64461_IO_OFFSET(0x1000);
048839dc	354	hitfb_fix.mmio_len = 0x1000;
62669e61	355	hitfb_fix.smem_start = HD64461_IO_OFFSET(0x02000000);
048839dc	356	hitfb_fix.smem_len = 512 * 1024;
1da177e4	357
bb47f218 TZ	358	lcdclor = hitfb_readw(HD64461_LCDCLOR);
	359	ldvndr = hitfb_readw(HD64461_LDVNDR);
	360	ldr3 = hitfb_readw(HD64461_LDR3);
1da177e4 LT	361
	362	switch (ldr3 & 15) {
	363	default:
	364	case 4:
	365	hitfb_var.bits_per_pixel = 8;
	366	hitfb_var.xres = lcdclor;
	367	break;
	368	case 8:
	369	hitfb_var.bits_per_pixel = 16;
	370	hitfb_var.xres = lcdclor / 2;
	371	break;
	372	}
	373	hitfb_fix.line_length = lcdclor;
	374	hitfb_fix.visual = (hitfb_var.bits_per_pixel == 8) ?
	375	FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
	376	hitfb_var.yres = ldvndr + 1;
	377	hitfb_var.xres_virtual = hitfb_var.xres;
	378	hitfb_var.yres_virtual = hitfb_fix.smem_len / lcdclor;
	379	switch (hitfb_var.bits_per_pixel) {
	380	case 8:
	381	hitfb_var.red.offset = 0;
	382	hitfb_var.red.length = 8;
	383	hitfb_var.green.offset = 0;
	384	hitfb_var.green.length = 8;
	385	hitfb_var.blue.offset = 0;
	386	hitfb_var.blue.length = 8;
	387	hitfb_var.transp.offset = 0;
	388	hitfb_var.transp.length = 0;
	389	break;
	390	case 16: /* RGB 565 */
	391	hitfb_var.red.offset = 11;
	392	hitfb_var.red.length = 5;
	393	hitfb_var.green.offset = 5;
	394	hitfb_var.green.length = 6;
	395	hitfb_var.blue.offset = 0;
	396	hitfb_var.blue.length = 5;
	397	hitfb_var.transp.offset = 0;
	398	hitfb_var.transp.length = 0;
	399	break;
	400	}
	401
684dcd05 PM	402	info = framebuffer_alloc(sizeof(u32) * 16, &dev->dev);
	403	if (unlikely(!info))
	404	return -ENOMEM;
	405
	406	info->fbops = &hitfb_ops;
	407	info->var = hitfb_var;
	408	info->fix = hitfb_fix;
	409	info->pseudo_palette = info->par;
b3e148d7	410	info->flags = FBINFO_HWACCEL_YPAN \|
048839dc	411	FBINFO_HWACCEL_FILLRECT \| FBINFO_HWACCEL_COPYAREA;
1da177e4	412
73eb77e7	413	info->screen_base = (char __iomem *)(uintptr_t)hitfb_fix.smem_start;
1da177e4	414
684dcd05 PM	415	ret = fb_alloc_cmap(&info->cmap, 256, 0);
	416	if (unlikely(ret < 0))
	417	goto err_fb;
1da177e4	418
684dcd05 PM	419	ret = register_framebuffer(info);
	420	if (unlikely(ret < 0))
	421	goto err;
	422
	423	platform_set_drvdata(dev, info);
1da177e4	424
31b6780c	425	fb_info(info, "%s frame buffer device\n", info->fix.id);
684dcd05	426
1da177e4	427	return 0;
684dcd05 PM	428
	429	err:
	430	fb_dealloc_cmap(&info->cmap);
	431	err_fb:
	432	framebuffer_release(info);
	433	return ret;
1da177e4 LT	434	}
1da177e4 LT	435
a1bb5368	436	static void hitfb_remove(struct platform_device *dev)
048839dc	437	{
684dcd05 PM	438	struct fb_info *info = platform_get_drvdata(dev);
	439
	440	unregister_framebuffer(info);
	441	fb_dealloc_cmap(&info->cmap);
	442	framebuffer_release(info);
048839dc AS	443	}
048839dc AS	444
2dbc8a23	445	static int hitfb_suspend(struct device *dev)
048839dc AS	446	{
	447	u16 v;
	448
dadeeffb	449	hitfb_blank(1, NULL);
bb47f218	450	v = hitfb_readw(HD64461_STBCR);
048839dc	451	v \|= HD64461_STBCR_SLCKE_IST;
bb47f218	452	hitfb_writew(v, HD64461_STBCR);
048839dc AS	453
	454	return 0;
	455	}
	456
2dbc8a23	457	static int hitfb_resume(struct device *dev)
048839dc AS	458	{
	459	u16 v;
	460
bb47f218	461	v = hitfb_readw(HD64461_STBCR);
048839dc AS	462	v &= ~HD64461_STBCR_SLCKE_OST;
048839dc AS	463	msleep(100);
bb47f218	464	v = hitfb_readw(HD64461_STBCR);
048839dc	465	v &= ~HD64461_STBCR_SLCKE_IST;
bb47f218	466	hitfb_writew(v, HD64461_STBCR);
dadeeffb	467	hitfb_blank(0, NULL);
048839dc AS	468
	469	return 0;
	470	}
2dbc8a23	471
47145210	472	static const struct dev_pm_ops hitfb_dev_pm_ops = {
2dbc8a23 PM	473	.suspend = hitfb_suspend,
	474	.resume = hitfb_resume,
	475	};
048839dc AS	476
	477	static struct platform_driver hitfb_driver = {
	478	.probe = hitfb_probe,
a1bb5368	479	.remove_new = hitfb_remove,
048839dc AS	480	.driver = {
048839dc AS	481	.name = "hitfb",
2dbc8a23	482	.pm = &hitfb_dev_pm_ops,
048839dc AS	483	},
	484	};
	485
	486	static struct platform_device hitfb_device = {
	487	.name = "hitfb",
	488	.id = -1,
	489	};
	490
	491	static int __init hitfb_init(void)
	492	{
	493	int ret;
	494
	495	ret = platform_driver_register(&hitfb_driver);
	496	if (!ret) {
	497	ret = platform_device_register(&hitfb_device);
	498	if (ret)
	499	platform_driver_unregister(&hitfb_driver);
	500	}
	501	return ret;
	502	}
	503
	504
1da177e4 LT	505	static void __exit hitfb_exit(void)
1da177e4 LT	506	{
048839dc AS	507	platform_device_unregister(&hitfb_device);
048839dc AS	508	platform_driver_unregister(&hitfb_driver);
1da177e4 LT	509	}
	510
	511	module_init(hitfb_init);
	512	module_exit(hitfb_exit);
	513
	514	MODULE_LICENSE("GPL");