132 static void arkfb_settile(struct fb_info *info, struct fb_tilemap *map)  in arkfb_settile()  argument
135 	u8 __iomem *fb = (u8 __iomem *)info->screen_base;  in arkfb_settile()
140 		fb_err(info, "unsupported font parameters: width %d, height %d, depth %d, length %d\n",  in arkfb_settile()
160 static void arkfb_tilecursor(struct fb_info *info, struct fb_tilecursor *cursor)  in arkfb_tilecursor()  argument
162 	struct arkfb_info *par = info->par;  in arkfb_tilecursor()
164 	svga_tilecursor(par->state.vgabase, info, cursor);  in arkfb_tilecursor()
187 static void arkfb_iplan_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_iplan_imageblit()  argument
198 	dst1 = info->screen_base + (image->dy * info->fix.line_length)  in arkfb_iplan_imageblit()
210 		dst1 += info->fix.line_length;  in arkfb_iplan_imageblit()
216 static void arkfb_iplan_fillrect(struct fb_info *info, const struct fb_fillrect *rect)  in arkfb_iplan_fillrect()  argument
223 	dst1 = info->screen_base + (rect->dy * info->fix.line_length)  in arkfb_iplan_fillrect()
231 		dst1 += info->fix.line_length;  in arkfb_iplan_fillrect()
245 static void arkfb_cfb4_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_cfb4_imageblit()  argument
256 	dst1 = info->screen_base + (image->dy * info->fix.line_length)  in arkfb_cfb4_imageblit()
268 		dst1 += info->fix.line_length;  in arkfb_cfb4_imageblit()
273 static void arkfb_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_imageblit()  argument
275 	if ((info->var.bits_per_pixel == 4) && (image->depth == 1)  in arkfb_imageblit()
277 		if (info->fix.type == FB_TYPE_INTERLEAVED_PLANES)  in arkfb_imageblit()
278 			arkfb_iplan_imageblit(info, image);  in arkfb_imageblit()
280 			arkfb_cfb4_imageblit(info, image);  in arkfb_imageblit()
282 		cfb_imageblit(info, image);  in arkfb_imageblit()
285 static void arkfb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)  in arkfb_fillrect()  argument
287 	if ((info->var.bits_per_pixel == 4)  in arkfb_fillrect()
289 	    && (info->fix.type == FB_TYPE_INTERLEAVED_PLANES))  in arkfb_fillrect()
290 		arkfb_iplan_fillrect(info, rect);  in arkfb_fillrect()
292 		cfb_fillrect(info, rect);  in arkfb_fillrect()
315 	int (*dac_get_mode)(struct dac_info *info);
316 	int (*dac_set_mode)(struct dac_info *info, int mode);
317 	int (*dac_get_freq)(struct dac_info *info, int channel);
318 	int (*dac_set_freq)(struct dac_info *info, int channel, u32 freq);
319 	void (*dac_release)(struct dac_info *info);
334 static inline u8 dac_read_reg(struct dac_info *info, u8 reg)  in dac_read_reg()  argument
337 	info->dac_read_regs(info->data, code, 1);  in dac_read_reg()
341 static inline void dac_read_regs(struct dac_info *info, u8 *code, int count)  in dac_read_regs()  argument
343 	info->dac_read_regs(info->data, code, count);  in dac_read_regs()
346 static inline void dac_write_reg(struct dac_info *info, u8 reg, u8 val)  in dac_write_reg()  argument
349 	info->dac_write_regs(info->data, code, 1);  in dac_write_reg()
352 static inline void dac_write_regs(struct dac_info *info, u8 *code, int count)  in dac_write_regs()  argument
354 	info->dac_write_regs(info->data, code, count);  in dac_write_regs()
357 static inline int dac_set_mode(struct dac_info *info, int mode)  in dac_set_mode()  argument
359 	return info->dacops->dac_set_mode(info, mode);  in dac_set_mode()
362 static inline int dac_set_freq(struct dac_info *info, int channel, u32 freq)  in dac_set_freq()  argument
364 	return info->dacops->dac_set_freq(info, channel, freq);  in dac_set_freq()
367 static inline void dac_release(struct dac_info *info)  in dac_release()  argument
369 	info->dacops->dac_release(info);  in dac_release()
384 #define DAC_PAR(info) ((struct ics5342_info *) info)  argument
393 static int ics5342_set_mode(struct dac_info *info, int mode)  in ics5342_set_mode()  argument
405 	dac_write_reg(info, 6, code & 0xF0);  in ics5342_set_mode()
406 	DAC_PAR(info)->mode = mode;  in ics5342_set_mode()
421 static int ics5342_set_freq(struct dac_info *info, int channel, u32 freq)  in ics5342_set_freq()  argument
426 	int rv = svga_compute_pll((DAC_PAR(info)->mode == DAC_PSEUDO8_16)  in ics5342_set_freq()
434 		dac_write_regs(info, code, 3);  in ics5342_set_freq()
439 static void ics5342_release(struct dac_info *info)  in ics5342_release()  argument
441 	ics5342_set_mode(info, DAC_PSEUDO8_8);  in ics5342_release()
442 	kfree(info);  in ics5342_release()
454 	struct dac_info *info = kzalloc(sizeof(struct ics5342_info), GFP_KERNEL);  in ics5342_init()  local
456 	if (! info)  in ics5342_init()
459 	info->dacops = &ics5342_ops;  in ics5342_init()
460 	info->dac_read_regs = drr;  in ics5342_init()
461 	info->dac_write_regs = dwr;  in ics5342_init()
462 	info->data = data;  in ics5342_init()
463 	DAC_PAR(info)->mode = DAC_PSEUDO8_8; /* estimation */  in ics5342_init()
464 	return info;  in ics5342_init()
475 	struct fb_info *info = data;  in ark_dac_read_regs()  local
479 	par = info->par;  in ark_dac_read_regs()
494 	struct fb_info *info = data;  in ark_dac_write_regs()  local
498 	par = info->par;  in ark_dac_write_regs()
512 static void ark_set_pixclock(struct fb_info *info, u32 pixclock)  in ark_set_pixclock()  argument
514 	struct arkfb_info *par = info->par;  in ark_set_pixclock()
519 		fb_err(info, "cannot set requested pixclock, keeping old value\n");  in ark_set_pixclock()
531 static int arkfb_open(struct fb_info *info, int user)  in arkfb_open()  argument
533 	struct arkfb_info *par = info->par;  in arkfb_open()
555 static int arkfb_release(struct fb_info *info, int user)  in arkfb_release()  argument
557 	struct arkfb_info *par = info->par;  in arkfb_release()
578 static int arkfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)  in arkfb_check_var()  argument
586 		fb_err(info, "unsupported mode requested\n");  in arkfb_check_var()
604 	if (mem > info->screen_size)  in arkfb_check_var()
606 		fb_err(info, "not enough framebuffer memory (%d kB requested, %d kB available)\n",  in arkfb_check_var()
607 		       mem >> 10, (unsigned int) (info->screen_size >> 10));  in arkfb_check_var()
611 	rv = svga_check_timings (&ark_timing_regs, var, info->node);  in arkfb_check_var()
614 		fb_err(info, "invalid timings requested\n");  in arkfb_check_var()
627 static int arkfb_set_par(struct fb_info *info)  in arkfb_set_par()  argument
629 	struct arkfb_info *par = info->par;  in arkfb_set_par()
631 	u32 bpp = info->var.bits_per_pixel;  in arkfb_set_par()
635 		info->fix.ypanstep = 1;  in arkfb_set_par()
636 		info->fix.line_length = (info->var.xres_virtual * bpp) / 8;  in arkfb_set_par()
638 		info->flags &= ~FBINFO_MISC_TILEBLITTING;  in arkfb_set_par()
639 		info->tileops = NULL;  in arkfb_set_par()
642 		info->pixmap.blit_x = (bpp == 4) ? (1 << (8 - 1)) : (~(u32)0);  in arkfb_set_par()
643 		info->pixmap.blit_y = ~(u32)0;  in arkfb_set_par()
645 		offset_value = (info->var.xres_virtual * bpp) / 64;  in arkfb_set_par()
646 		screen_size = info->var.yres_virtual * info->fix.line_length;  in arkfb_set_par()
648 		info->fix.ypanstep = 16;  in arkfb_set_par()
649 		info->fix.line_length = 0;  in arkfb_set_par()
651 		info->flags |= FBINFO_MISC_TILEBLITTING;  in arkfb_set_par()
652 		info->tileops = &arkfb_tile_ops;  in arkfb_set_par()
655 		info->pixmap.blit_x = 1 << (8 - 1);  in arkfb_set_par()
656 		info->pixmap.blit_y = 1 << (16 - 1);  in arkfb_set_par()
658 		offset_value = info->var.xres_virtual / 16;  in arkfb_set_par()
659 		screen_size = (info->var.xres_virtual * info->var.yres_virtual) / 64;  in arkfb_set_par()
662 	info->var.xoffset = 0;  in arkfb_set_par()
663 	info->var.yoffset = 0;  in arkfb_set_par()
664 	info->var.activate = FB_ACTIVATE_NOW;  in arkfb_set_par()
685 	vga_wseq(par->state.vgabase, 0x13, info->fix.smem_start >> 16);  in arkfb_set_par()
686 	vga_wseq(par->state.vgabase, 0x14, info->fix.smem_start >> 24);  in arkfb_set_par()
696 	fb_dbg(info, "offset register       : %d\n", offset_value);  in arkfb_set_par()
702 	if (info->var.vmode & FB_VMODE_DOUBLE)  in arkfb_set_par()
707 	if (info->var.vmode & FB_VMODE_INTERLACED)  in arkfb_set_par()
714 	mode = svga_match_format(arkfb_formats, &(info->var), &(info->fix));  in arkfb_set_par()
719 		fb_dbg(info, "text mode\n");  in arkfb_set_par()
728 		fb_dbg(info, "4 bit pseudocolor\n");  in arkfb_set_par()
736 		fb_dbg(info, "4 bit pseudocolor, planar\n");  in arkfb_set_par()
743 		fb_dbg(info, "8 bit pseudocolor\n");  in arkfb_set_par()
747 		if (info->var.pixclock > 20000) {  in arkfb_set_par()
748 			fb_dbg(info, "not using multiplex\n");  in arkfb_set_par()
752 			fb_dbg(info, "using multiplex\n");  in arkfb_set_par()
759 		fb_dbg(info, "5/5/5 truecolor\n");  in arkfb_set_par()
766 		fb_dbg(info, "5/6/5 truecolor\n");  in arkfb_set_par()
773 		fb_dbg(info, "8/8/8 truecolor\n");  in arkfb_set_par()
782 		fb_dbg(info, "8/8/8/8 truecolor\n");  in arkfb_set_par()
790 		fb_err(info, "unsupported mode - bug\n");  in arkfb_set_par()
794 	ark_set_pixclock(info, (hdiv * info->var.pixclock) / hmul);  in arkfb_set_par()
795 	svga_set_timings(par->state.vgabase, &ark_timing_regs, &(info->var), hmul, hdiv,  in arkfb_set_par()
796 			 (info->var.vmode & FB_VMODE_DOUBLE)     ? 2 : 1,  in arkfb_set_par()
797 			 (info->var.vmode & FB_VMODE_INTERLACED) ? 2 : 1,  in arkfb_set_par()
798 			  hmul, info->node);  in arkfb_set_par()
801 	value = info->var.xres + info->var.left_margin + info->var.right_margin + info->var.hsync_len;  in arkfb_set_par()
805 	memset_io(info->screen_base, 0x00, screen_size);  in arkfb_set_par()
876 static int arkfb_blank(int blank_mode, struct fb_info *info)  in arkfb_blank()  argument
878 	struct arkfb_info *par = info->par;  in arkfb_blank()
882 		fb_dbg(info, "unblank\n");  in arkfb_blank()
887 		fb_dbg(info, "blank\n");  in arkfb_blank()
894 		fb_dbg(info, "sync down\n");  in arkfb_blank()
905 static int arkfb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)  in arkfb_pan_display()  argument
907 	struct arkfb_info *par = info->par;  in arkfb_pan_display()
911 	if (info->var.bits_per_pixel == 0) {  in arkfb_pan_display()
912 		offset = (var->yoffset / 16) * (info->var.xres_virtual / 2)  in arkfb_pan_display()
916 		offset = (var->yoffset * info->fix.line_length) +  in arkfb_pan_display()
917 			 (var->xoffset * info->var.bits_per_pixel / 8);  in arkfb_pan_display()
918 		offset = offset >> ((info->var.bits_per_pixel == 4) ? 2 : 3);  in arkfb_pan_display()
957 	struct fb_info *info;  in ark_pci_probe()  local
969 	info = framebuffer_alloc(sizeof(struct arkfb_info), &(dev->dev));  in ark_pci_probe()
970 	if (! info) {  in ark_pci_probe()
975 	par = info->par;  in ark_pci_probe()
978 	info->flags = FBINFO_PARTIAL_PAN_OK | FBINFO_HWACCEL_YPAN;  in ark_pci_probe()
979 	info->fbops = &arkfb_ops;  in ark_pci_probe()
984 		dev_err(info->device, "cannot enable PCI device\n");  in ark_pci_probe()
990 		dev_err(info->device, "cannot reserve framebuffer region\n");  in ark_pci_probe()
994 	par->dac = ics5342_init(ark_dac_read_regs, ark_dac_write_regs, info);  in ark_pci_probe()
997 		dev_err(info->device, "RAMDAC initialization failed\n");  in ark_pci_probe()
1001 	info->fix.smem_start = pci_resource_start(dev, 0);  in ark_pci_probe()
1002 	info->fix.smem_len = pci_resource_len(dev, 0);  in ark_pci_probe()
1005 	info->screen_base = pci_iomap(dev, 0, 0);  in ark_pci_probe()
1006 	if (! info->screen_base) {  in ark_pci_probe()
1008 		dev_err(info->device, "iomap for framebuffer failed\n");  in ark_pci_probe()
1023 	info->screen_size = (1 << (regval >> 6)) << 20;  in ark_pci_probe()
1024 	info->fix.smem_len = info->screen_size;  in ark_pci_probe()
1026 	strcpy(info->fix.id, "ARK 2000PV");  in ark_pci_probe()
1027 	info->fix.mmio_start = 0;  in ark_pci_probe()
1028 	info->fix.mmio_len = 0;  in ark_pci_probe()
1029 	info->fix.type = FB_TYPE_PACKED_PIXELS;  in ark_pci_probe()
1030 	info->fix.visual = FB_VISUAL_PSEUDOCOLOR;  in ark_pci_probe()
1031 	info->fix.ypanstep = 0;  in ark_pci_probe()
1032 	info->fix.accel = FB_ACCEL_NONE;  in ark_pci_probe()
1033 	info->pseudo_palette = (void*) (par->pseudo_palette);  in ark_pci_probe()
1036 	rc = fb_find_mode(&(info->var), info, mode_option, NULL, 0, NULL, 8);  in ark_pci_probe()
1039 		dev_err(info->device, "mode %s not found\n", mode_option);  in ark_pci_probe()
1043 	rc = fb_alloc_cmap(&info->cmap, 256, 0);  in ark_pci_probe()
1045 		dev_err(info->device, "cannot allocate colormap\n");  in ark_pci_probe()
1049 	rc = register_framebuffer(info);  in ark_pci_probe()
1051 		dev_err(info->device, "cannot register framebuffer\n");  in ark_pci_probe()
1055 	fb_info(info, "%s on %s, %d MB RAM\n",  in ark_pci_probe()
1056 		info->fix.id, pci_name(dev), info->fix.smem_len >> 20);  in ark_pci_probe()
1059 	pci_set_drvdata(dev, info);  in ark_pci_probe()
1064 		par->mtrr_reg = mtrr_add(info->fix.smem_start, info->fix.smem_len, MTRR_TYPE_WRCOMB, 1);  in ark_pci_probe()
1072 	fb_dealloc_cmap(&info->cmap);  in ark_pci_probe()
1075 	pci_iounmap(dev, info->screen_base);  in ark_pci_probe()
1083 	framebuffer_release(info);  in ark_pci_probe()
1091 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_remove()  local
1093 	if (info) {  in ark_pci_remove()
1094 		struct arkfb_info *par = info->par;  in ark_pci_remove()
1104 		unregister_framebuffer(info);  in ark_pci_remove()
1105 		fb_dealloc_cmap(&info->cmap);  in ark_pci_remove()
1107 		pci_iounmap(dev, info->screen_base);  in ark_pci_remove()
1111 		framebuffer_release(info);  in ark_pci_remove()
1121 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_suspend()  local
1122 	struct arkfb_info *par = info->par;  in ark_pci_suspend()
1124 	dev_info(info->device, "suspend\n");  in ark_pci_suspend()
1135 	fb_set_suspend(info, 1);  in ark_pci_suspend()
1152 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_resume()  local
1153 	struct arkfb_info *par = info->par;  in ark_pci_resume()
1155 	dev_info(info->device, "resume\n");  in ark_pci_resume()
1171 	arkfb_set_par(info);  in ark_pci_resume()
1172 	fb_set_suspend(info, 0);  in ark_pci_resume()