[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/slab.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 __initdata = {
	.activate	= FB_ACTIVATE_NOW,
	.height		= -1,
	.width		= -1,
	.vmode		= FB_VMODE_NONINTERLACED,
};

static struct fb_fix_screeninfo hitfb_fix __initdata = {
	.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 __init 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 __exit 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 struct dev_pm_ops hitfb_dev_pm_ops = {
	.suspend	= hitfb_suspend,
	.resume		= hitfb_resume,
};

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