WebSVN - shark - Blame - Rev 1618 - /shark/branches/xen/drivers/fb/matrox/matroxfb

Rev	Author	Line No.	Line
489	giacomo	1	/*
		2	*
		3	* Hardware accelerated Matrox Millennium I, II, Mystique, G100, G200, G400 and G450.
		4	*
		5	* (c) 1998-2002 Petr Vandrovec <vandrove@vc.cvut.cz>
		6	*
		7	* Portions Copyright (c) 2001 Matrox Graphics Inc.
		8	*
		9	* Version: 1.65 2002/08/14
		10	*
		11	*/
		12
		13	#include <linuxcomp.h>
		14
		15	#include "matroxfb_maven.h"
		16	#include "matroxfb_crtc2.h"
		17	#include "matroxfb_misc.h"
		18	#include "matroxfb_DAC1064.h"
		19	#include <linux/matroxfb.h>
		20	#include <asm/uaccess.h>
		21
		22	/* **************************************************** */
		23
		24	static int mem = 8192;
		25
		26	MODULE_PARM(mem, "i");
		27	MODULE_PARM_DESC(mem, "Memory size reserved for dualhead (default=8MB)");
		28
		29	/* **************************************************** */
		30
		31	static int matroxfb_dh_setcolreg(unsigned regno, unsigned red, unsigned green,
		32	unsigned blue, unsigned transp, struct fb_info* info) {
		33	u_int32_t col;
		34	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		35
		36	if (regno >= 16)
		37	return 1;
		38	if (m2info->fbcon.var.grayscale) {
		39	/* gray = 0.30R + 0.59G + 0.11B /
		40	red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8;
		41	}
		42	red = CNVT_TOHW(red, m2info->fbcon.var.red.length);
		43	green = CNVT_TOHW(green, m2info->fbcon.var.green.length);
		44	blue = CNVT_TOHW(blue, m2info->fbcon.var.blue.length);
		45	transp = CNVT_TOHW(transp, m2info->fbcon.var.transp.length);
		46
		47	col = (red << m2info->fbcon.var.red.offset) \|
		48	(green << m2info->fbcon.var.green.offset) \|
		49	(blue << m2info->fbcon.var.blue.offset) \|
		50	(transp << m2info->fbcon.var.transp.offset);
		51
		52	switch (m2info->fbcon.var.bits_per_pixel) {
		53	case 16:
		54	m2info->cmap[regno] = col \| (col << 16);
		55	break;
		56	case 32:
		57	m2info->cmap[regno] = col;
		58	break;
		59	}
		60	return 0;
		61	#undef m2info
		62	}
		63
		64	static void matroxfb_dh_restore(struct matroxfb_dh_fb_info* m2info,
		65	struct my_timming* mt,
		66	int mode,
		67	unsigned int pos) {
		68	u_int32_t tmp;
		69	u_int32_t datactl;
		70	MINFO_FROM(m2info->primary_dev);
		71
		72	switch (mode) {
		73	case 15:
		74	tmp = 0x00200000;
		75	break;
		76	case 16:
		77	tmp = 0x00400000;
		78	break;
		79	/* case 32: */
		80	default:
		81	tmp = 0x00800000;
		82	break;
		83	}
		84	tmp \|= 0x00000001; /* enable CRTC2 */
		85	datactl = 0;
		86	if (ACCESS_FBINFO(outputs[1]).src == MATROXFB_SRC_CRTC2) {
		87	if (ACCESS_FBINFO(devflags.g450dac)) {
		88	tmp \|= 0x00000006; /* source from secondary pixel PLL */
		89	/* no vidrst when in monitor mode */
		90	if (ACCESS_FBINFO(outputs[1]).mode != MATROXFB_OUTPUT_MODE_MONITOR) {
		91	tmp \|= 0xC0001000; /* Enable H/V vidrst */
		92	}
		93	} else {
		94	tmp \|= 0x00000002; /* source from VDOCLK */
		95	tmp \|= 0xC0000000; /* enable vvidrst & hvidrst */
		96	/* MGA TVO is our clock source */
		97	}
		98	} else if (ACCESS_FBINFO(outputs[0]).src == MATROXFB_SRC_CRTC2) {
		99	tmp \|= 0x00000004; /* source from pixclock */
		100	/* PIXPLL is our clock source */
		101	}
		102	if (ACCESS_FBINFO(outputs[0]).src == MATROXFB_SRC_CRTC2) {
		103	tmp \|= 0x00100000; /* connect CRTC2 to DAC */
		104	}
		105	if (mt->interlaced) {
		106	tmp \|= 0x02000000; /* interlaced, second field is bigger, as G450 apparently ignores it */
		107	mt->VDisplay >>= 1;
		108	mt->VSyncStart >>= 1;
		109	mt->VSyncEnd >>= 1;
		110	mt->VTotal >>= 1;
		111	}
		112	if ((mt->HTotal & 7) == 2) {
		113	datactl \|= 0x00000010;
		114	mt->HTotal &= ~7;
		115	}
		116	tmp \|= 0x10000000; /* 0x10000000 is VIDRST polarity */
		117	mga_outl(0x3C14, ((mt->HDisplay - 8) << 16) \| (mt->HTotal - 8));
		118	mga_outl(0x3C18, ((mt->HSyncEnd - 8) << 16) \| (mt->HSyncStart - 8));
		119	mga_outl(0x3C1C, ((mt->VDisplay - 1) << 16) \| (mt->VTotal - 1));
		120	mga_outl(0x3C20, ((mt->VSyncEnd - 1) << 16) \| (mt->VSyncStart - 1));
		121	mga_outl(0x3C24, ((mt->VSyncStart) << 16) \| (mt->HSyncStart)); /* preload */
		122	{
		123	u_int32_t linelen = m2info->fbcon.var.xres_virtual * (m2info->fbcon.var.bits_per_pixel >> 3);
		124	if (tmp & 0x02000000) {
		125	/* field #0 is smaller, so... */
		126	mga_outl(0x3C2C, pos); /* field #1 vmemory start */
		127	mga_outl(0x3C28, pos + linelen); /* field #0 vmemory start */
		128	linelen <<= 1;
		129	m2info->interlaced = 1;
		130	} else {
		131	mga_outl(0x3C28, pos); /* vmemory start */
		132	m2info->interlaced = 0;
		133	}
		134	mga_outl(0x3C40, linelen);
		135	}
		136	mga_outl(0x3C4C, datactl); /* data control */
		137	if (tmp & 0x02000000) {
		138	int i;
		139
		140	mga_outl(0x3C10, tmp & ~0x02000000);
		141	for (i = 0; i < 2; i++) {
		142	unsigned int nl;
		143	unsigned int lastl = 0;
		144
		145	while ((nl = mga_inl(0x3C48) & 0xFFF) >= lastl) {
		146	lastl = nl;
		147	}
		148	}
		149	}
		150	mga_outl(0x3C10, tmp);
		151	ACCESS_FBINFO(hw).crtc2.ctl = tmp;
		152
		153	tmp = mt->VDisplay << 16; /* line compare */
		154	if (mt->sync & FB_SYNC_HOR_HIGH_ACT)
		155	tmp \|= 0x00000100;
		156	if (mt->sync & FB_SYNC_VERT_HIGH_ACT)
		157	tmp \|= 0x00000200;
		158	mga_outl(0x3C44, tmp);
		159	}
		160
		161	static void matroxfb_dh_disable(struct matroxfb_dh_fb_info* m2info) {
		162	MINFO_FROM(m2info->primary_dev);
		163
		164	mga_outl(0x3C10, 0x00000004); /* disable CRTC2, CRTC1->DAC1, PLL as clock source */
		165	ACCESS_FBINFO(hw).crtc2.ctl = 0x00000004;
		166	}
		167
		168	static void matroxfb_dh_cfbX_init(struct matroxfb_dh_fb_info* m2info) {
		169	/* no acceleration for secondary head... */
		170	m2info->cmap[16] = 0xFFFFFFFF;
		171	}
		172
		173	static void matroxfb_dh_pan_var(struct matroxfb_dh_fb_info* m2info,
		174	struct fb_var_screeninfo* var) {
		175	unsigned int pos;
		176	unsigned int linelen;
		177	unsigned int pixelsize;
		178	MINFO_FROM(m2info->primary_dev);
		179
		180	m2info->fbcon.var.xoffset = var->xoffset;
		181	m2info->fbcon.var.yoffset = var->yoffset;
		182	pixelsize = m2info->fbcon.var.bits_per_pixel >> 3;
		183	linelen = m2info->fbcon.var.xres_virtual * pixelsize;
		184	pos = m2info->fbcon.var.yoffset * linelen + m2info->fbcon.var.xoffset * pixelsize;
		185	pos += m2info->video.offbase;
		186	if (m2info->interlaced) {
		187	mga_outl(0x3C2C, pos);
		188	mga_outl(0x3C28, pos + linelen);
		189	} else {
		190	mga_outl(0x3C28, pos);
		191	}
		192	}
		193
		194	static int matroxfb_dh_decode_var(struct matroxfb_dh_fb_info* m2info,
		195	struct fb_var_screeninfo* var,
		196	int *visual,
		197	int *video_cmap_len,
		198	int *mode) {
		199	unsigned int mask;
		200	unsigned int memlen;
		201	unsigned int vramlen;
		202
		203	switch (var->bits_per_pixel) {
		204	case 16: mask = 0x1F;
		205	break;
		206	case 32: mask = 0x0F;
		207	break;
		208	default: return -EINVAL;
		209	}
		210	vramlen = m2info->video.len_usable;
		211	if (var->yres_virtual < var->yres)
		212	var->yres_virtual = var->yres;
		213	if (var->xres_virtual < var->xres)
		214	var->xres_virtual = var->xres;
		215	var->xres_virtual = (var->xres_virtual + mask) & ~mask;
		216	if (var->yres_virtual > 32767)
		217	return -EINVAL;
		218	memlen = var->xres_virtual * var->yres_virtual * (var->bits_per_pixel >> 3);
		219	if (memlen > vramlen)
		220	return -EINVAL;
		221	if (var->xoffset + var->xres > var->xres_virtual)
		222	var->xoffset = var->xres_virtual - var->xres;
		223	if (var->yoffset + var->yres > var->yres_virtual)
		224	var->yoffset = var->yres_virtual - var->yres;
		225
		226	var->xres &= ~7;
		227	var->left_margin &= ~7;
		228	var->right_margin &= ~7;
		229	var->hsync_len &= ~7;
		230
		231	*mode = var->bits_per_pixel;
		232	if (var->bits_per_pixel == 16) {
		233	if (var->green.length == 5) {
		234	var->red.offset = 10;
		235	var->red.length = 5;
		236	var->green.offset = 5;
		237	var->green.length = 5;
		238	var->blue.offset = 0;
		239	var->blue.length = 5;
		240	var->transp.offset = 15;
		241	var->transp.length = 1;
		242	*mode = 15;
		243	} else {
		244	var->red.offset = 11;
		245	var->red.length = 5;
		246	var->green.offset = 5;
		247	var->green.length = 6;
		248	var->blue.offset = 0;
		249	var->blue.length = 5;
		250	var->transp.offset = 0;
		251	var->transp.length = 0;
		252	}
		253	} else {
		254	var->red.offset = 16;
		255	var->red.length = 8;
		256	var->green.offset = 8;
		257	var->green.length = 8;
		258	var->blue.offset = 0;
		259	var->blue.length = 8;
		260	var->transp.offset = 24;
		261	var->transp.length = 8;
		262	}
		263	*visual = FB_VISUAL_TRUECOLOR;
		264	*video_cmap_len = 16;
		265	return 0;
		266	}
		267
		268	static int matroxfb_dh_open(struct fb_info* info, int user) {
		269	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		270	MINFO_FROM(m2info->primary_dev);
		271
		272	if (MINFO) {
		273	int err;
		274
		275	if (ACCESS_FBINFO(dead)) {
		276	return -ENXIO;
		277	}
		278	err = ACCESS_FBINFO(fbops).fb_open(&ACCESS_FBINFO(fbcon), user);
		279	if (err) {
		280	return err;
		281	}
		282	}
		283	return 0;
		284	#undef m2info
		285	}
		286
		287	static int matroxfb_dh_release(struct fb_info* info, int user) {
		288	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		289	int err = 0;
		290	MINFO_FROM(m2info->primary_dev);
		291
		292	if (MINFO) {
		293	err = ACCESS_FBINFO(fbops).fb_release(&ACCESS_FBINFO(fbcon), user);
		294	}
		295	return err;
		296	#undef m2info
		297	}
		298
		299	static void matroxfb_dh_init_fix(struct matroxfb_dh_fb_info *m2info) {
		300	struct fb_fix_screeninfo *fix = &m2info->fbcon.fix;
		301
		302	strcpy(fix->id, "MATROX DH");
		303
		304	fix->smem_start = m2info->video.base;
		305	fix->smem_len = m2info->video.len_usable;
		306	fix->ypanstep = 1;
		307	fix->ywrapstep = 0;
		308	fix->xpanstep = 8; /* TBD */
		309	fix->mmio_start = m2info->mmio.base;
		310	fix->mmio_len = m2info->mmio.len;
		311	fix->accel = 0; /* no accel... */
		312	}
		313
		314	static int matroxfb_dh_check_var(struct fb_var_screeninfo* var, struct fb_info* info) {
		315	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		316	int visual;
		317	int cmap_len;
		318	int mode;
		319
		320	return matroxfb_dh_decode_var(m2info, var, &visual, &cmap_len, &mode);
		321	#undef m2info
		322	}
		323
		324	static int matroxfb_dh_set_par(struct fb_info* info) {
		325	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		326	int visual;
		327	int cmap_len;
		328	int mode;
		329	int err;
		330	struct fb_var_screeninfo* var = &info->var;
		331	MINFO_FROM(m2info->primary_dev);
		332
		333	if ((err = matroxfb_dh_decode_var(m2info, var, &visual, &cmap_len, &mode)) != 0)
		334	return err;
		335	/* cmap */
		336	{
		337	m2info->fbcon.screen_base = vaddr_va(m2info->video.vbase);
		338	m2info->fbcon.fix.visual = visual;
		339	m2info->fbcon.fix.type = FB_TYPE_PACKED_PIXELS;
		340	m2info->fbcon.fix.type_aux = 0;
		341	m2info->fbcon.fix.line_length = (var->xres_virtual * var->bits_per_pixel) >> 3;
		342	}
		343	{
		344	struct my_timming mt;
		345	unsigned int pos;
		346	int out;
		347	int cnt;
		348
		349	matroxfb_var2my(&m2info->fbcon.var, &mt);
		350	mt.crtc = MATROXFB_SRC_CRTC2;
		351	/* CRTC2 delay */
		352	mt.delay = 34;
		353
		354	pos = (m2info->fbcon.var.yoffset * m2info->fbcon.var.xres_virtual + m2info->fbcon.var.xoffset) * m2info->fbcon.var.bits_per_pixel >> 3;
		355	pos += m2info->video.offbase;
		356	cnt = 0;
		357	down_read(&ACCESS_FBINFO(altout).lock);
		358	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		359	if (ACCESS_FBINFO(outputs[out]).src == MATROXFB_SRC_CRTC2) {
		360	cnt++;
		361	if (ACCESS_FBINFO(outputs[out]).output->compute) {
		362	ACCESS_FBINFO(outputs[out]).output->compute(ACCESS_FBINFO(outputs[out]).data, &mt);
		363	}
		364	}
		365	}
		366	ACCESS_FBINFO(crtc2).pixclock = mt.pixclock;
		367	ACCESS_FBINFO(crtc2).mnp = mt.mnp;
		368	up_read(&ACCESS_FBINFO(altout).lock);
		369	if (cnt) {
		370	matroxfb_dh_restore(m2info, &mt, mode, pos);
		371	} else {
		372	matroxfb_dh_disable(m2info);
		373	}
		374	DAC1064_global_init(PMINFO2);
		375	DAC1064_global_restore(PMINFO2);
		376	down_read(&ACCESS_FBINFO(altout).lock);
		377	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		378	if (ACCESS_FBINFO(outputs[out]).src == MATROXFB_SRC_CRTC2 &&
		379	ACCESS_FBINFO(outputs[out]).output->program) {
		380	ACCESS_FBINFO(outputs[out]).output->program(ACCESS_FBINFO(outputs[out]).data);
		381	}
		382	}
		383	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		384	if (ACCESS_FBINFO(outputs[out]).src == MATROXFB_SRC_CRTC2 &&
		385	ACCESS_FBINFO(outputs[out]).output->start) {
		386	ACCESS_FBINFO(outputs[out]).output->start(ACCESS_FBINFO(outputs[out]).data);
		387	}
		388	}
		389	up_read(&ACCESS_FBINFO(altout).lock);
		390	matroxfb_dh_cfbX_init(m2info);
		391	}
		392	return 0;
		393	#undef m2info
		394	}
		395
		396	static int matroxfb_dh_pan_display(struct fb_var_screeninfo* var, struct fb_info* info) {
		397	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		398	matroxfb_dh_pan_var(m2info, var);
		399	return 0;
		400	#undef m2info
		401	}
		402
		403	static int matroxfb_dh_get_vblank(const struct matroxfb_dh_fb_info* m2info, struct fb_vblank* vblank) {
		404	MINFO_FROM(m2info->primary_dev);
		405
		406	matroxfb_enable_irq(PMINFO 0);
		407	memset(vblank, 0, sizeof(*vblank));
		408	vblank->flags = FB_VBLANK_HAVE_VCOUNT \| FB_VBLANK_HAVE_VBLANK;
		409	/* mask out reserved bits + field number (odd/even) */
		410	vblank->vcount = mga_inl(0x3C48) & 0x000007FF;
		411	/* compatibility stuff */
		412	if (vblank->vcount >= m2info->fbcon.var.yres)
		413	vblank->flags \|= FB_VBLANK_VBLANKING;
		414	if (test_bit(0, &ACCESS_FBINFO(irq_flags))) {
		415	vblank->flags \|= FB_VBLANK_HAVE_COUNT;
		416	/* Only one writer, aligned int value...
		417	it should work without lock and without atomic_t */
		418	vblank->count = ACCESS_FBINFO(crtc2).vsync.cnt;
		419	}
		420	return 0;
		421	}
		422
		423	static int matroxfb_dh_ioctl(struct inode* inode,
		424	struct file* file,
		425	unsigned int cmd,
		426	unsigned long arg,
		427	struct fb_info* info) {
		428	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		429	MINFO_FROM(m2info->primary_dev);
		430
		431	DBG(__FUNCTION__)
		432
		433	switch (cmd) {
		434	case FBIOGET_VBLANK:
		435	{
		436	struct fb_vblank vblank;
		437	int err;
		438
		439	err = matroxfb_dh_get_vblank(m2info, &vblank);
		440	if (err)
		441	return err;
		442	if (copy_to_user((struct fb_vblank*)arg, &vblank, sizeof(vblank)))
		443	return -EFAULT;
		444	return 0;
		445	}
		446	case FBIO_WAITFORVSYNC:
		447	{
		448	u_int32_t crt;
		449
		450	if (get_user(crt, (u_int32_t *)arg))
		451	return -EFAULT;
		452
		453	if (crt != 0)
		454	return -ENODEV;
		455	return matroxfb_wait_for_sync(PMINFO 1);
		456	}
		457	case MATROXFB_SET_OUTPUT_MODE:
		458	case MATROXFB_GET_OUTPUT_MODE:
		459	case MATROXFB_GET_ALL_OUTPUTS:
		460	{
		461	return ACCESS_FBINFO(fbcon.fbops)->fb_ioctl(inode, file, cmd, arg, &ACCESS_FBINFO(fbcon));
		462	}
		463	case MATROXFB_SET_OUTPUT_CONNECTION:
		464	{
		465	u_int32_t tmp;
		466	int out;
		467	int changes;
		468
		469	if (get_user(tmp, (u_int32_t*)arg))
		470	return -EFAULT;
		471	for (out = 0; out < 32; out++) {
		472	if (tmp & (1 << out)) {
		473	if (out >= MATROXFB_MAX_OUTPUTS)
		474	return -ENXIO;
		475	if (!ACCESS_FBINFO(outputs[out]).output)
		476	return -ENXIO;
		477	switch (ACCESS_FBINFO(outputs[out]).src) {
		478	case MATROXFB_SRC_NONE:
		479	case MATROXFB_SRC_CRTC2:
		480	break;
		481	default:
		482	return -EBUSY;
		483	}
		484	}
		485	}
		486	if (ACCESS_FBINFO(devflags.panellink)) {
		487	if (tmp & MATROXFB_OUTPUT_CONN_DFP)
		488	return -EINVAL;
		489	if ((ACCESS_FBINFO(outputs[2]).src == MATROXFB_SRC_CRTC1) && tmp)
		490	return -EBUSY;
		491	}
		492	changes = 0;
		493	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		494	if (tmp & (1 << out)) {
		495	if (ACCESS_FBINFO(outputs[out]).src != MATROXFB_SRC_CRTC2) {
		496	changes = 1;
		497	ACCESS_FBINFO(outputs[out]).src = MATROXFB_SRC_CRTC2;
		498	}
		499	} else if (ACCESS_FBINFO(outputs[out]).src == MATROXFB_SRC_CRTC2) {
		500	changes = 1;
		501	ACCESS_FBINFO(outputs[out]).src = MATROXFB_SRC_NONE;
		502	}
		503	}
		504	if (!changes)
		505	return 0;
		506	matroxfb_dh_set_par(info);
		507	return 0;
		508	}
		509	case MATROXFB_GET_OUTPUT_CONNECTION:
		510	{
		511	u_int32_t conn = 0;
		512	int out;
		513
		514	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		515	if (ACCESS_FBINFO(outputs[out]).src == MATROXFB_SRC_CRTC2) {
		516	conn \|= 1 << out;
		517	}
		518	}
		519	if (put_user(conn, (u_int32_t*)arg))
		520	return -EFAULT;
		521	return 0;
		522	}
		523	case MATROXFB_GET_AVAILABLE_OUTPUTS:
		524	{
		525	u_int32_t tmp = 0;
		526	int out;
		527
		528	for (out = 0; out < MATROXFB_MAX_OUTPUTS; out++) {
		529	if (ACCESS_FBINFO(outputs[out]).output) {
		530	switch (ACCESS_FBINFO(outputs[out]).src) {
		531	case MATROXFB_SRC_NONE:
		532	case MATROXFB_SRC_CRTC2:
		533	tmp \|= 1 << out;
		534	break;
		535	}
		536	}
		537	}
		538	if (ACCESS_FBINFO(devflags.panellink)) {
		539	tmp &= ~MATROXFB_OUTPUT_CONN_DFP;
		540	if (ACCESS_FBINFO(outputs[2]).src == MATROXFB_SRC_CRTC1) {
		541	tmp = 0;
		542	}
		543	}
		544	if (put_user(tmp, (u_int32_t*)arg))
		545	return -EFAULT;
		546	return 0;
		547	}
		548	}
		549	return -ENOTTY;
		550	#undef m2info
		551	}
		552
		553	static int matroxfb_dh_blank(int blank, struct fb_info* info) {
		554	#define m2info (container_of(info, struct matroxfb_dh_fb_info, fbcon))
		555	switch (blank) {
		556	case 1:
		557	case 2:
		558	case 3:
		559	case 4:
		560	default:;
		561	}
		562	/* do something... */
		563	return 0;
		564	#undef m2info
		565	}
		566
		567	static struct fb_ops matroxfb_dh_ops = {
		568	.owner = THIS_MODULE,
		569	.fb_open = matroxfb_dh_open,
		570	.fb_release = matroxfb_dh_release,
		571	.fb_check_var = matroxfb_dh_check_var,
		572	.fb_set_par = matroxfb_dh_set_par,
		573	.fb_setcolreg = matroxfb_dh_setcolreg,
		574	.fb_pan_display =matroxfb_dh_pan_display,
		575	.fb_blank = matroxfb_dh_blank,
		576	.fb_ioctl = matroxfb_dh_ioctl,
		577	.fb_fillrect = cfb_fillrect,
		578	.fb_copyarea = cfb_copyarea,
		579	.fb_imageblit = cfb_imageblit,
		580	.fb_cursor = soft_cursor,
		581	};
		582
		583	static struct fb_var_screeninfo matroxfb_dh_defined = {
		584	640,480,640,480,/* W,H, virtual W,H */
		585	0,0, /* offset */
		586	32, /* depth */
		587	0, /* gray */
		588	{0,0,0}, /* R */
		589	{0,0,0}, /* G */
		590	{0,0,0}, /* B */
		591	{0,0,0}, /* alpha */
		592	0, /* nonstd */
		593	FB_ACTIVATE_NOW,
		594	-1,-1, /* display size */
		595	0, /* accel flags */
		596	39721L,48L,16L,33L,10L,
		597	96L,2,0, /* no sync info */
		598	FB_VMODE_NONINTERLACED,
		599	0, {0,0,0,0,0}
		600	};
		601
		602	static int matroxfb_dh_regit(CPMINFO struct matroxfb_dh_fb_info* m2info) {
		603	#define minfo (m2info->primary_dev)
		604	void* oldcrtc2;
		605
		606	m2info->fbcon.fbops = &matroxfb_dh_ops;
		607	m2info->fbcon.flags = FBINFO_FLAG_DEFAULT;
		608	m2info->fbcon.currcon = -1;
		609	m2info->fbcon.pseudo_palette = m2info->cmap;
		610	fb_alloc_cmap(&m2info->fbcon.cmap, 256, 1);
		611
		612	if (mem < 64)
		613	mem *= 1024;
		614	if (mem < 64*1024)
		615	mem *= 1024;
		616	mem &= ~0x00000FFF; /* PAGE_MASK? */
		617	if (ACCESS_FBINFO(video.len_usable) + mem <= ACCESS_FBINFO(video.len))
		618	m2info->video.offbase = ACCESS_FBINFO(video.len) - mem;
		619	else if (ACCESS_FBINFO(video.len) < mem) {
		620	return -ENOMEM;
		621	} else { /* check yres on first head... */
		622	m2info->video.borrowed = mem;
		623	ACCESS_FBINFO(video.len_usable) -= mem;
		624	m2info->video.offbase = ACCESS_FBINFO(video.len_usable);
		625	}
		626	m2info->video.base = ACCESS_FBINFO(video.base) + m2info->video.offbase;
		627	m2info->video.len = m2info->video.len_usable = m2info->video.len_maximum = mem;
		628	m2info->video.vbase.vaddr = vaddr_va(ACCESS_FBINFO(video.vbase)) + m2info->video.offbase;
		629	m2info->mmio.base = ACCESS_FBINFO(mmio.base);
		630	m2info->mmio.vbase = ACCESS_FBINFO(mmio.vbase);
		631	m2info->mmio.len = ACCESS_FBINFO(mmio.len);
		632
		633	/*
		634	* If we have unused output, connect CRTC2 to it...
		635	*/
		636	if (ACCESS_FBINFO(outputs[1]).output &&
		637	ACCESS_FBINFO(outputs[1]).src == MATROXFB_SRC_NONE &&
		638	ACCESS_FBINFO(outputs[2]).src == MATROXFB_SRC_NONE) {
		639	ACCESS_FBINFO(outputs[1]).src = MATROXFB_SRC_CRTC2;
		640	}
		641
		642	matroxfb_dh_init_fix(m2info);
		643	if (register_framebuffer(&m2info->fbcon)) {
		644	return -ENXIO;
		645	}
		646	if (m2info->fbcon.currcon < 0) {
		647	fb_set_var(&m2info->fbcon, &matroxfb_dh_defined);
		648	}
		649	down_write(&ACCESS_FBINFO(crtc2.lock));
		650	oldcrtc2 = ACCESS_FBINFO(crtc2.info);
		651	ACCESS_FBINFO(crtc2.info) = m2info;
		652	up_write(&ACCESS_FBINFO(crtc2.lock));
		653	if (oldcrtc2) {
		654	printk(KERN_ERR "matroxfb_crtc2: Internal consistency check failed: crtc2 already present: %p\n",
		655	oldcrtc2);
		656	}
		657	return 0;
		658	#undef minfo
		659	}
		660
		661	/* ************************** */
		662
		663	static int matroxfb_dh_registerfb(struct matroxfb_dh_fb_info* m2info) {
		664	#define minfo (m2info->primary_dev)
		665	if (matroxfb_dh_regit(PMINFO m2info)) {
		666	printk(KERN_ERR "matroxfb_crtc2: secondary head failed to register\n");
		667	return -1;
		668	}
		669	printk(KERN_INFO "matroxfb_crtc2: secondary head of fb%u was registered as fb%u\n",
		670	ACCESS_FBINFO(fbcon.node), m2info->fbcon.node);
		671	m2info->fbcon_registered = 1;
		672	return 0;
		673	#undef minfo
		674	}
		675
		676	static void matroxfb_dh_deregisterfb(struct matroxfb_dh_fb_info* m2info) {
		677	#define minfo (m2info->primary_dev)
		678	if (m2info->fbcon_registered) {
		679	int id;
		680	struct matroxfb_dh_fb_info* crtc2;
		681
		682	down_write(&ACCESS_FBINFO(crtc2.lock));
		683	crtc2 = ACCESS_FBINFO(crtc2.info);
		684	if (crtc2 == m2info)
		685	ACCESS_FBINFO(crtc2.info) = NULL;
		686	up_write(&ACCESS_FBINFO(crtc2.lock));
		687	if (crtc2 != m2info) {
		688	printk(KERN_ERR "matroxfb_crtc2: Internal consistency check failed: crtc2 mismatch at unload: %p != %p\n",
		689	crtc2, m2info);
		690	printk(KERN_ERR "matroxfb_crtc2: Expect kernel crash after module unload.\n");
		691	return;
		692	}
		693	id = m2info->fbcon.node;
		694	unregister_framebuffer(&m2info->fbcon);
		695	/* return memory back to primary head */
		696	ACCESS_FBINFO(video.len_usable) += m2info->video.borrowed;
		697	printk(KERN_INFO "matroxfb_crtc2: fb%u unregistered\n", id);
		698	m2info->fbcon_registered = 0;
		699	}
		700	#undef minfo
		701	}
		702
		703	static void* matroxfb_crtc2_probe(struct matrox_fb_info* minfo) {
		704	struct matroxfb_dh_fb_info* m2info;
		705
		706	/* hardware is CRTC2 incapable... */
		707	if (!ACCESS_FBINFO(devflags.crtc2))
		708	return NULL;
		709	m2info = (struct matroxfb_dh_fb_info)kmalloc(sizeof(m2info), GFP_KERNEL);
		710	if (!m2info) {
		711	printk(KERN_ERR "matroxfb_crtc2: Not enough memory for CRTC2 control structs\n");
		712	return NULL;
		713	}
		714	memset(m2info, 0, sizeof(*m2info));
		715	m2info->primary_dev = MINFO;
		716	if (matroxfb_dh_registerfb(m2info)) {
		717	kfree(m2info);
		718	printk(KERN_ERR "matroxfb_crtc2: CRTC2 framebuffer failed to register\n");
		719	return NULL;
		720	}
		721	return m2info;
		722	}
		723
		724	static void matroxfb_crtc2_remove(struct matrox_fb_info* minfo, void* crtc2) {
		725	matroxfb_dh_deregisterfb(crtc2);
		726	kfree(crtc2);
		727	}
		728
		729	static struct matroxfb_driver crtc2 = {
		730	.name = "Matrox G400 CRTC2",
		731	.probe = matroxfb_crtc2_probe,
		732	.remove = matroxfb_crtc2_remove };
		733
		734	static int matroxfb_crtc2_init(void) {
		735	matroxfb_register_driver(&crtc2);
		736	return 0;
		737	}
		738
		739	static void matroxfb_crtc2_exit(void) {
		740	matroxfb_unregister_driver(&crtc2);
		741	}
		742
		743	MODULE_AUTHOR("(c) 1999-2002 Petr Vandrovec <vandrove@vc.cvut.cz>");
		744	MODULE_DESCRIPTION("Matrox G400 CRTC2 driver");
		745	MODULE_LICENSE("GPL");
		746	module_init(matroxfb_crtc2_init);
		747	module_exit(matroxfb_crtc2_exit);
		748	/* we do not have __setup() yet */

Subversion Repositories shark

(root)/shark/branches/xen/drivers/fb/matrox/matroxfb_crtc2.c - Rev 1618