[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / video / 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 <asm/uaccess.h>
#include <asm/pgtable.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 inline void hitfb_accel_wait(void)
{
	while (fb_readw(HD64461_GRCFGR) & HD64461_GRCFGR_ACCSTATUS) ;
}

static inline void hitfb_accel_start(int truecolor)
{
	if (truecolor) {
		fb_writew(6, HD64461_GRCFGR);
	} else {
		fb_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;

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

	fb_writew(saddr & 0xffff, HD64461_BBTDSARL);
	fb_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--;
	fb_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;

			fb_writew((1 << 5) | 1, HD64461_BBTMDR);
		} else
			fb_writew(1, HD64461_BBTMDR);
	} else {
		saddr = WIDTH * sy + sx;
		daddr = WIDTH * dy + dx;
		if (mask_addr) {
			fb_writew((1 << 5), HD64461_BBTMDR);
		} else {
			fb_writew(0, HD64461_BBTMDR);
		}
	}
	if (truecolor) {
		saddr <<= 1;
		daddr <<= 1;
	}
	fb_writew(width, HD64461_BBTDWR);
	fb_writew(height, HD64461_BBTDHR);
	fb_writew(saddr & 0xffff, HD64461_BBTSSARL);
	fb_writew(saddr >> 16, HD64461_BBTSSARH);
	fb_writew(daddr & 0xffff, HD64461_BBTDSARL);
	fb_writew(daddr >> 16, HD64461_BBTDSARH);
	if (mask_addr) {
		maddr += mask_addr;
		fb_writew(maddr & 0xffff, HD64461_BBTMARL);
		fb_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();
		fb_writew(0x00f0, HD64461_BBTROPR);
		fb_writew(16, HD64461_BBTMDR);

		if (p->var.bits_per_pixel == 16) {
			fb_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 {
			fb_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;

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

	return 0;
}

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

	if (blank_mode) {
		v = fb_readw(HD64461_LDR1);
		v &= ~HD64461_LDR1_DON;
		fb_writew(v, HD64461_LDR1);

		v = fb_readw(HD64461_LCDCCR);
		v |= HD64461_LCDCCR_MOFF;
		fb_writew(v, HD64461_LCDCCR);

		v = fb_readw(HD64461_STBCR);
		v |= HD64461_STBCR_SLCDST;
		fb_writew(v, HD64461_STBCR);
	} else {
		v = fb_readw(HD64461_STBCR);
		v &= ~HD64461_STBCR_SLCDST;
		fb_writew(v, HD64461_STBCR);

		v = fb_readw(HD64461_LCDCCR);
		v &= ~(HD64461_LCDCCR_MOFF | HD64461_LCDCCR_STREQ);
		fb_writew(v, HD64461_LCDCCR);

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

		v = fb_readw(HD64461_LDR1);
		v |= HD64461_LDR1_DON;
		fb_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:
		fb_writew(regno << 8, HD64461_CPTWAR);
		fb_writew(red >> 10, HD64461_CPTWDR);
		fb_writew(green >> 10, HD64461_CPTWDR);
		fb_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;
	}

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

static struct fb_ops hitfb_ops = {
	.owner		= THIS_MODULE,
	.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,
};

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 = fb_readw(HD64461_LCDCLOR);
	ldvndr = fb_readw(HD64461_LDVNDR);
	ldr3 = fb_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_DEFAULT | FBINFO_HWACCEL_YPAN |
		FBINFO_HWACCEL_FILLRECT | FBINFO_HWACCEL_COPYAREA;

	info->screen_base = (void *)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);

	printk(KERN_INFO "fb%d: %s frame buffer device\n",
	       info->node, info->fix.id);

	return 0;

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

static int 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);

	return 0;
}

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

	hitfb_blank(1,0);
	v = fb_readw(HD64461_STBCR);
	v |= HD64461_STBCR_SLCKE_IST;
	fb_writew(v, HD64461_STBCR);

	return 0;
}

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

	v = fb_readw(HD64461_STBCR);
	v &= ~HD64461_STBCR_SLCKE_OST;
	msleep(100);
	v = fb_readw(HD64461_STBCR);
	v &= ~HD64461_STBCR_SLCKE_IST;
	fb_writew(v, HD64461_STBCR);
	hitfb_blank(0,0);

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