[mirror_ubuntu-artful-kernel.git] / drivers / staging / sm750fb / sm750_cursor.c

#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/fb.h>
#include<linux/ioport.h>
#include<linux/init.h>
#include<linux/pci.h>
#include<linux/vmalloc.h>
#include<linux/pagemap.h>
#include <linux/console.h>
#include<linux/platform_device.h>
#include<linux/screen_info.h>

#include "sm750.h"
#include "sm750_help.h"
#include "sm750_cursor.h"


#define PEEK32(addr) \
readl(cursor->mmio + (addr))

#define POKE32(addr,data) \
writel((data),cursor->mmio + (addr))

/* cursor control for voyager and 718/750*/
#define HWC_ADDRESS                         0x0
#define HWC_ADDRESS_ENABLE                  31:31
#define HWC_ADDRESS_ENABLE_DISABLE          0
#define HWC_ADDRESS_ENABLE_ENABLE           1
#define HWC_ADDRESS_EXT                     27:27
#define HWC_ADDRESS_EXT_LOCAL               0
#define HWC_ADDRESS_EXT_EXTERNAL            1
#define HWC_ADDRESS_CS                      26:26
#define HWC_ADDRESS_CS_0                    0
#define HWC_ADDRESS_CS_1                    1
#define HWC_ADDRESS_ADDRESS                 25:0

#define HWC_LOCATION                        0x4
#define HWC_LOCATION_TOP                    27:27
#define HWC_LOCATION_TOP_INSIDE             0
#define HWC_LOCATION_TOP_OUTSIDE            1
#define HWC_LOCATION_Y                      26:16
#define HWC_LOCATION_LEFT                   11:11
#define HWC_LOCATION_LEFT_INSIDE            0
#define HWC_LOCATION_LEFT_OUTSIDE           1
#define HWC_LOCATION_X                      10:0

#define HWC_COLOR_12                        0x8
#define HWC_COLOR_12_2_RGB565               31:16
#define HWC_COLOR_12_1_RGB565               15:0

#define HWC_COLOR_3                         0xC
#define HWC_COLOR_3_RGB565                  15:0


/* hw_cursor_xxx works for voyager,718 and 750 */
void hw_cursor_enable(struct lynx_cursor * cursor)
{
	u32 reg;
	reg = FIELD_VALUE(0,HWC_ADDRESS,ADDRESS,cursor->offset)|
			FIELD_SET(0,HWC_ADDRESS,EXT,LOCAL)|
			FIELD_SET(0,HWC_ADDRESS,ENABLE,ENABLE);
	POKE32(HWC_ADDRESS,reg);
}
void hw_cursor_disable(struct lynx_cursor * cursor)
{
	POKE32(HWC_ADDRESS,0);
}

void hw_cursor_setSize(struct lynx_cursor * cursor,
						int w,int h)
{
	cursor->w = w;
	cursor->h = h;
}
void hw_cursor_setPos(struct lynx_cursor * cursor,
						int x,int y)
{
	u32 reg;
	reg = FIELD_VALUE(0,HWC_LOCATION,Y,y)|
			FIELD_VALUE(0,HWC_LOCATION,X,x);
	POKE32(HWC_LOCATION,reg);
}
void hw_cursor_setColor(struct lynx_cursor * cursor,
						u32 fg,u32 bg)
{
	POKE32(HWC_COLOR_12,(fg<<16)|(bg&0xffff));
	POKE32(HWC_COLOR_3,0xffe0);
}

void hw_cursor_setData(struct lynx_cursor * cursor,
			u16 rop,const u8* pcol,const u8* pmsk)
{
	int i,j,count,pitch,offset;
	u8 color,mask,opr;
	u16 data;
	void __iomem *pbuffer, *pstart;

	/*  in byte*/
	pitch = cursor->w >> 3;

	/* in byte	*/
	count = pitch * cursor->h;

	/* in byte */
	offset = cursor->maxW * 2 / 8;

	data = 0;
	pstart = cursor->vstart;
	pbuffer = pstart;

/*
	if(odd &1){
		hw_cursor_setData2(cursor,rop,pcol,pmsk);
	}
	odd++;
	if(odd > 0xfffffff0)
		odd=0;
*/

	for(i=0;i<count;i++)
	{
		color = *pcol++;
		mask = *pmsk++;
		data = 0;

		/* either method below works well,
		 * but method 2 shows no lag
		 * and method 1 seems a bit wrong*/
#if 0
		if(rop == ROP_XOR)
			opr = mask ^ color;
		else
			opr = mask & color;

		for(j=0;j<8;j++)
		{

			if(opr & (0x80 >> j))
			{	//use fg color,id = 2
				data |= 2 << (j*2);
			}else{
				//use bg color,id = 1
				data |= 1 << (j*2);
			}
		}
#else
		for(j=0;j<8;j++){
			if(mask & (0x80>>j)){
				if(rop == ROP_XOR)
					opr = mask ^ color;
				else
					opr = mask & color;

				/* 2 stands for forecolor and 1 for backcolor */
				data |= ((opr & (0x80>>j))?2:1)<<(j*2);
			}
		}
#endif
		iowrite16(data, pbuffer);

		/* assume pitch is 1,2,4,8,...*/
#if 0
		if(!((i+1)&(pitch-1)))   /* below line equal to is line */
#else
		if((i+1) % pitch == 0)
#endif
		{
			/* need a return */
			pstart += offset;
			pbuffer = pstart;
		}else{
			pbuffer += sizeof(u16);
		}

	}


}


void hw_cursor_setData2(struct lynx_cursor * cursor,
			u16 rop,const u8* pcol,const u8* pmsk)
{
	int i,j,count,pitch,offset;
	u8 color, mask;
	u16 data;
	void __iomem *pbuffer, *pstart;

	/*  in byte*/
	pitch = cursor->w >> 3;

	/* in byte	*/
	count = pitch * cursor->h;

	/* in byte */
	offset = cursor->maxW * 2 / 8;

	data = 0;
	pstart = cursor->vstart;
	pbuffer = pstart;

	for(i=0;i<count;i++)
	{
		color = *pcol++;
		mask = *pmsk++;
		data = 0;

		/* either method below works well, but method 2 shows no lag */
#if 0
		if(rop == ROP_XOR)
			opr = mask ^ color;
		else
			opr = mask & color;

		for(j=0;j<8;j++)
		{

			if(opr & (0x80 >> j))
			{	//use fg color,id = 2
				data |= 2 << (j*2);
			}else{
				//use bg color,id = 1
				data |= 1 << (j*2);
			}
		}
#else
		for(j=0;j<8;j++){
			if(mask & (1<<j))
				data |= ((color & (1<<j))?1:2)<<(j*2);
		}
#endif
		iowrite16(data, pbuffer);

		/* assume pitch is 1,2,4,8,...*/
		if(!(i&(pitch-1)))
		//if((i+1) % pitch == 0)
		{
			/* need a return */
			pstart += offset;
			pbuffer = pstart;
		}else{
			pbuffer += sizeof(u16);
		}

	}
}
Commit	Line	Data
81dee67e SM	1	#include<linux/module.h>
	2	#include<linux/kernel.h>
	3	#include<linux/errno.h>
	4	#include<linux/string.h>
	5	#include<linux/mm.h>
	6	#include<linux/slab.h>
	7	#include<linux/delay.h>
	8	#include<linux/fb.h>
	9	#include<linux/ioport.h>
	10	#include<linux/init.h>
	11	#include<linux/pci.h>
	12	#include<linux/vmalloc.h>
	13	#include<linux/pagemap.h>
	14	#include <linux/console.h>
	15	#include<linux/platform_device.h>
	16	#include<linux/screen_info.h>
	17
	18	#include "sm750.h"
	19	#include "sm750_help.h"
	20	#include "sm750_cursor.h"
	21
	22
	23	#define PEEK32(addr) \
	24	readl(cursor->mmio + (addr))
	25
	26	#define POKE32(addr,data) \
	27	writel((data),cursor->mmio + (addr))
	28
	29	/* cursor control for voyager and 718/750*/
	30	#define HWC_ADDRESS 0x0
	31	#define HWC_ADDRESS_ENABLE 31:31
	32	#define HWC_ADDRESS_ENABLE_DISABLE 0
	33	#define HWC_ADDRESS_ENABLE_ENABLE 1
	34	#define HWC_ADDRESS_EXT 27:27
	35	#define HWC_ADDRESS_EXT_LOCAL 0
	36	#define HWC_ADDRESS_EXT_EXTERNAL 1
	37	#define HWC_ADDRESS_CS 26:26
	38	#define HWC_ADDRESS_CS_0 0
	39	#define HWC_ADDRESS_CS_1 1
	40	#define HWC_ADDRESS_ADDRESS 25:0
	41
	42	#define HWC_LOCATION 0x4
	43	#define HWC_LOCATION_TOP 27:27
	44	#define HWC_LOCATION_TOP_INSIDE 0
	45	#define HWC_LOCATION_TOP_OUTSIDE 1
	46	#define HWC_LOCATION_Y 26:16
	47	#define HWC_LOCATION_LEFT 11:11
	48	#define HWC_LOCATION_LEFT_INSIDE 0
	49	#define HWC_LOCATION_LEFT_OUTSIDE 1
	50	#define HWC_LOCATION_X 10:0
	51
	52	#define HWC_COLOR_12 0x8
	53	#define HWC_COLOR_12_2_RGB565 31:16
	54	#define HWC_COLOR_12_1_RGB565 15:0
	55
	56	#define HWC_COLOR_3 0xC
	57	#define HWC_COLOR_3_RGB565 15:0
	58
	59
	60	/* hw_cursor_xxx works for voyager,718 and 750 */
	61	void hw_cursor_enable(struct lynx_cursor * cursor)
	62	{
	63	u32 reg;
	64	reg = FIELD_VALUE(0,HWC_ADDRESS,ADDRESS,cursor->offset)\|
65	FIELD_SET(0,HWC_ADDRESS,EXT,LOCAL)\|
66	FIELD_SET(0,HWC_ADDRESS,ENABLE,ENABLE);
67	POKE32(HWC_ADDRESS,reg);
68	}
69	void hw_cursor_disable(struct lynx_cursor * cursor)
70	{
71	POKE32(HWC_ADDRESS,0);
72	}
73
74	void hw_cursor_setSize(struct lynx_cursor * cursor,
75	int w,int h)
76	{
77	cursor->w = w;
78	cursor->h = h;
79	}
80	void hw_cursor_setPos(struct lynx_cursor * cursor,
81	int x,int y)
82	{
83	u32 reg;
84	reg = FIELD_VALUE(0,HWC_LOCATION,Y,y)\|
85	FIELD_VALUE(0,HWC_LOCATION,X,x);
86	POKE32(HWC_LOCATION,reg);
87	}
88	void hw_cursor_setColor(struct lynx_cursor * cursor,
89	u32 fg,u32 bg)
90	{
91	POKE32(HWC_COLOR_12,(fg<<16)\|(bg&0xffff));
92	POKE32(HWC_COLOR_3,0xffe0);
93	}
94
95	void hw_cursor_setData(struct lynx_cursor * cursor,
96	u16 rop,const u8* pcol,const u8* pmsk)
97	{
98	int i,j,count,pitch,offset;
99	u8 color,mask,opr;
100	u16 data;
35fb80b9	101	void __iomem pbuffer, pstart;
81dee67e SM	102
	103	/* in byte*/
	104	pitch = cursor->w >> 3;
	105
	106	/* in byte */
	107	count = pitch * cursor->h;
	108
35fb80b9 LS	109	/* in byte */
35fb80b9 LS	110	offset = cursor->maxW * 2 / 8;
81dee67e SM	111
81dee67e SM	112	data = 0;
35fb80b9	113	pstart = cursor->vstart;
81dee67e SM	114	pbuffer = pstart;
	115
	116	/*
	117	if(odd &1){
	118	hw_cursor_setData2(cursor,rop,pcol,pmsk);
	119	}
	120	odd++;
	121	if(odd > 0xfffffff0)
	122	odd=0;
	123	*/
	124
	125	for(i=0;i<count;i++)
	126	{
	127	color = *pcol++;
	128	mask = *pmsk++;
	129	data = 0;
	130
	131	/* either method below works well,
	132	* but method 2 shows no lag
	133	* and method 1 seems a bit wrong*/
	134	#if 0
	135	if(rop == ROP_XOR)
	136	opr = mask ^ color;
	137	else
	138	opr = mask & color;
	139
	140	for(j=0;j<8;j++)
	141	{
	142
	143	if(opr & (0x80 >> j))
	144	{ //use fg color,id = 2
	145	data \|= 2 << (j*2);
	146	}else{
	147	//use bg color,id = 1
	148	data \|= 1 << (j*2);
	149	}
	150	}
	151	#else
	152	for(j=0;j<8;j++){
	153	if(mask & (0x80>>j)){
	154	if(rop == ROP_XOR)
	155	opr = mask ^ color;
	156	else
	157	opr = mask & color;
	158
	159	/* 2 stands for forecolor and 1 for backcolor */
	160	data \|= ((opr & (0x80>>j))?2:1)<<(j*2);
	161	}
	162	}
	163	#endif
35fb80b9	164	iowrite16(data, pbuffer);
81dee67e SM	165
	166	/* assume pitch is 1,2,4,8,...*/
	167	#if 0
	168	if(!((i+1)&(pitch-1))) /* below line equal to is line */
	169	#else
	170	if((i+1) % pitch == 0)
	171	#endif
	172	{
	173	/* need a return */
	174	pstart += offset;
	175	pbuffer = pstart;
	176	}else{
35fb80b9	177	pbuffer += sizeof(u16);
81dee67e SM	178	}
	179
	180	}
	181
	182
	183	}
	184
	185
	186	void hw_cursor_setData2(struct lynx_cursor * cursor,
	187	u16 rop,const u8* pcol,const u8* pmsk)
	188	{
	189	int i,j,count,pitch,offset;
041d3a42	190	u8 color, mask;
81dee67e	191	u16 data;
35fb80b9	192	void __iomem pbuffer, pstart;
81dee67e SM	193
	194	/* in byte*/
	195	pitch = cursor->w >> 3;
	196
	197	/* in byte */
	198	count = pitch * cursor->h;
	199
35fb80b9 LS	200	/* in byte */
35fb80b9 LS	201	offset = cursor->maxW * 2 / 8;
81dee67e SM	202
81dee67e SM	203	data = 0;
35fb80b9	204	pstart = cursor->vstart;
81dee67e SM	205	pbuffer = pstart;
	206
	207	for(i=0;i<count;i++)
	208	{
	209	color = *pcol++;
	210	mask = *pmsk++;
	211	data = 0;
	212
	213	/* either method below works well, but method 2 shows no lag */
	214	#if 0
	215	if(rop == ROP_XOR)
	216	opr = mask ^ color;
	217	else
	218	opr = mask & color;
	219
	220	for(j=0;j<8;j++)
	221	{
	222
	223	if(opr & (0x80 >> j))
	224	{ //use fg color,id = 2
	225	data \|= 2 << (j*2);
	226	}else{
	227	//use bg color,id = 1
	228	data \|= 1 << (j*2);
	229	}
	230	}
	231	#else
	232	for(j=0;j<8;j++){
	233	if(mask & (1<<j))
	234	data \|= ((color & (1<<j))?1:2)<<(j*2);
	235	}
	236	#endif
35fb80b9	237	iowrite16(data, pbuffer);
81dee67e SM	238
	239	/* assume pitch is 1,2,4,8,...*/
	240	if(!(i&(pitch-1)))
	241	//if((i+1) % pitch == 0)
	242	{
	243	/* need a return */
	244	pstart += offset;
	245	pbuffer = pstart;
	246	}else{
35fb80b9	247	pbuffer += sizeof(u16);
81dee67e SM	248	}
	249
	250	}
81dee67e	251	}