fbdev/mb862xx/mb862xxfbdrv.c

36 static inline int h_total(struct fb_var_screeninfo *var)
38 	return var->xres + var->left_margin +
39 		var->right_margin + var->hsync_len;
42 static inline int v_total(struct fb_var_screeninfo *var)
44 	return var->yres + var->upper_margin +
45 		var->lower_margin + var->vsync_len;
48 static inline int hsp(struct fb_var_screeninfo *var)
50 	return var->xres + var->right_margin - 1;
53 static inline int vsp(struct fb_var_screeninfo *var)
55 	return var->yres + var->lower_margin - 1;
58 static inline int d_pitch(struct fb_var_screeninfo *var)
60 	return var->xres * var->bits_per_pixel / 8;
81 			val  = chan_to_field(red,   &info->var.red);
82 			val |= chan_to_field(green, &info->var.green);
83 			val |= chan_to_field(blue,  &info->var.blue);
101 static int mb862xxfb_check_var(struct fb_var_screeninfo *var,
109 	if (var->hsync_len > 255 || var->vsync_len > 255)
112 	if ((var->xres + var->right_margin) >= 4096)
115 	if ((var->yres + var->lower_margin) > 4096)
118 	if (h_total(var) > 4096 || v_total(var) > 4096)
121 	if (var->xres_virtual > 4096 || var->yres_virtual > 4096)
124 	if (var->bits_per_pixel <= 8)
125 		var->bits_per_pixel = 8;
126 	else if (var->bits_per_pixel <= 16)
127 		var->bits_per_pixel = 16;
128 	else if (var->bits_per_pixel <= 32)
129 		var->bits_per_pixel = 32;
135 	if (d_pitch(&fbi->var) % GC_L0M_L0W_UNIT) {
138 		var->bits_per_pixel = 0;
140 			var->bits_per_pixel += 8;
141 			r = d_pitch(&fbi->var) % GC_L0M_L0W_UNIT;
142 		} while (r && var->bits_per_pixel <= 32);
144 		if (d_pitch(&fbi->var) % GC_L0M_L0W_UNIT)
149 	tmp = (var->xres * var->bits_per_pixel) / 8;
154 	switch (var->bits_per_pixel) {
156 		var->red.length		= var->bits_per_pixel;
157 		var->green.length	= var->bits_per_pixel;
158 		var->blue.length	= var->bits_per_pixel;
159 		var->red.offset		= 0;
160 		var->green.offset	= 0;
161 		var->blue.offset	= 0;
162 		var->transp.length	= 0;
165 		var->red.length		= 5;
166 		var->green.length	= 5;
167 		var->blue.length	= 5;
168 		var->red.offset		= 10;
169 		var->green.offset	= 5;
170 		var->blue.offset	= 0;
171 		var->transp.length	= 0;
175 		var->transp.length	= 8;
176 		var->red.length		= 8;
177 		var->green.length	= 8;
178 		var->blue.length	= 8;
179 		var->transp.offset	= 24;
180 		var->red.offset		= 16;
181 		var->green.offset	= 8;
182 		var->blue.offset	= 0;
202 		mb862xxfb_init_accel(fbi, &mb862xxfb_ops, fbi->var.xres);
213 	sc = par->refclk / (1000000 / fbi->var.pixclock) - 1;
221 	reg =  pack(d_pitch(&fbi->var) / GC_L0M_L0W_UNIT,
222 		    (fbi->var.yres - 1));
223 	if (fbi->var.bits_per_pixel == 16)
227 	if (fbi->var.bits_per_pixel == 32) {
232 	reg = pack(fbi->var.yres - 1, fbi->var.xres);
246 	reg = pack(fbi->var.xres - 1, fbi->var.xres - 1);
248 	reg = pack((fbi->var.yres - 1), vsp(&fbi->var));
250 	reg = ((fbi->var.vsync_len - 1) << 24) |
251 	      pack((fbi->var.hsync_len - 1), hsp(&fbi->var));
253 	outreg(disp, GC_HTP, pack(h_total(&fbi->var) - 1, 0));
254 	outreg(disp, GC_VTR, pack(v_total(&fbi->var) - 1, 0));
264 static int mb862xxfb_pan(struct fb_var_screeninfo *var,
270 	reg = pack(var->yoffset, var->xoffset);
273 	reg = pack(info->var.yres_virtual, info->var.xres_virtual);
441 		fbi->var.pixclock = (sc * 1000000) / par->refclk;
442 		fbi->var.xres = (inreg(disp, GC_HDB_HDP) & 0x0fff) + 1;
444 		fbi->var.yres = ((reg >> 16) & 0x0fff) + 1;
446 		fbi->var.xres_virtual = fbi->var.xres;
447 		fbi->var.yres_virtual = fbi->var.yres;
450 			fbi->var.bits_per_pixel = 32;
454 				fbi->var.bits_per_pixel = 16;
456 				fbi->var.bits_per_pixel = 8;
459 		fbi->var.hsync_len = ((reg & 0xff0000) >> 16) + 1;
460 		fbi->var.vsync_len = ((reg & 0x3f000000) >> 24) + 1;
463 		fbi->var.right_margin = hsp - fbi->var.xres;
464 		fbi->var.left_margin = ht - hsp - fbi->var.hsync_len;
466 		fbi->var.lower_margin = vsp - fbi->var.yres;
467 		fbi->var.upper_margin = vt - vsp - fbi->var.vsync_len;
470 		fb_videomode_to_var(&fbi->var, (struct fb_videomode *)mode);
471 		fbi->var.bits_per_pixel = mode->def_bpp ? mode->def_bpp : 8;
475 		ret = fb_find_mode(&fbi->var, fbi, "640x480-16@60",
484 	fbi->var.xoffset = 0;
485 	fbi->var.yoffset = 0;
486 	fbi->var.grayscale = 0;
487 	fbi->var.nonstd = 0;
488 	fbi->var.height = -1;
489 	fbi->var.width = -1;
490 	fbi->var.accel_flags = 0;
491 	fbi->var.vmode = FB_VMODE_NONINTERLACED;
492 	fbi->var.activate = FB_ACTIVATE_NOW;
501 	if ((fbi->fbops->fb_check_var)(&fbi->var, fbi))
504 	fbi->fix.visual = fbi->var.bits_per_pixel == 8 ?
506 	fbi->fix.line_length = (fbi->var.xres_virtual *
507 				fbi->var.bits_per_pixel) / 8;
508 	fbi->fix.smem_len = fbi->fix.line_length * fbi->var.yres_virtual;
524 	stride = par->l1_cfg.sw * (fbi->var.bits_per_pixel / 8);