119 static void arkfb_settile(struct fb_info *info, struct fb_tilemap *map)  in arkfb_settile()  argument
122 	u8 __iomem *fb = (u8 __iomem *)info->screen_base;  in arkfb_settile()
127 		fb_err(info, "unsupported font parameters: width %d, height %d, depth %d, length %d\n",  in arkfb_settile()
147 static void arkfb_tilecursor(struct fb_info *info, struct fb_tilecursor *cursor)  in arkfb_tilecursor()  argument
149 	struct arkfb_info *par = info->par;  in arkfb_tilecursor()
151 	svga_tilecursor(par->state.vgabase, info, cursor);  in arkfb_tilecursor()
174 static void arkfb_iplan_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_iplan_imageblit()  argument
185 	dst1 = info->screen_base + (image->dy * info->fix.line_length)  in arkfb_iplan_imageblit()
197 		dst1 += info->fix.line_length;  in arkfb_iplan_imageblit()
203 static void arkfb_iplan_fillrect(struct fb_info *info, const struct fb_fillrect *rect)  in arkfb_iplan_fillrect()  argument
210 	dst1 = info->screen_base + (rect->dy * info->fix.line_length)  in arkfb_iplan_fillrect()
218 		dst1 += info->fix.line_length;  in arkfb_iplan_fillrect()
232 static void arkfb_cfb4_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_cfb4_imageblit()  argument
243 	dst1 = info->screen_base + (image->dy * info->fix.line_length)  in arkfb_cfb4_imageblit()
255 		dst1 += info->fix.line_length;  in arkfb_cfb4_imageblit()
260 static void arkfb_imageblit(struct fb_info *info, const struct fb_image *image)  in arkfb_imageblit()  argument
262 	if ((info->var.bits_per_pixel == 4) && (image->depth == 1)  in arkfb_imageblit()
264 		if (info->fix.type == FB_TYPE_INTERLEAVED_PLANES)  in arkfb_imageblit()
265 			arkfb_iplan_imageblit(info, image);  in arkfb_imageblit()
267 			arkfb_cfb4_imageblit(info, image);  in arkfb_imageblit()
269 		cfb_imageblit(info, image);  in arkfb_imageblit()
272 static void arkfb_fillrect(struct fb_info *info, const struct fb_fillrect *rect)  in arkfb_fillrect()  argument
274 	if ((info->var.bits_per_pixel == 4)  in arkfb_fillrect()
276 	    && (info->fix.type == FB_TYPE_INTERLEAVED_PLANES))  in arkfb_fillrect()
277 		arkfb_iplan_fillrect(info, rect);  in arkfb_fillrect()
279 		cfb_fillrect(info, rect);  in arkfb_fillrect()
302 	int (*dac_get_mode)(struct dac_info *info);
303 	int (*dac_set_mode)(struct dac_info *info, int mode);
304 	int (*dac_get_freq)(struct dac_info *info, int channel);
305 	int (*dac_set_freq)(struct dac_info *info, int channel, u32 freq);
306 	void (*dac_release)(struct dac_info *info);
321 static inline u8 dac_read_reg(struct dac_info *info, u8 reg)  in dac_read_reg()  argument
324 	info->dac_read_regs(info->data, code, 1);  in dac_read_reg()
328 static inline void dac_read_regs(struct dac_info *info, u8 *code, int count)  in dac_read_regs()  argument
330 	info->dac_read_regs(info->data, code, count);  in dac_read_regs()
333 static inline void dac_write_reg(struct dac_info *info, u8 reg, u8 val)  in dac_write_reg()  argument
336 	info->dac_write_regs(info->data, code, 1);  in dac_write_reg()
339 static inline void dac_write_regs(struct dac_info *info, u8 *code, int count)  in dac_write_regs()  argument
341 	info->dac_write_regs(info->data, code, count);  in dac_write_regs()
344 static inline int dac_set_mode(struct dac_info *info, int mode)  in dac_set_mode()  argument
346 	return info->dacops->dac_set_mode(info, mode);  in dac_set_mode()
349 static inline int dac_set_freq(struct dac_info *info, int channel, u32 freq)  in dac_set_freq()  argument
351 	return info->dacops->dac_set_freq(info, channel, freq);  in dac_set_freq()
354 static inline void dac_release(struct dac_info *info)  in dac_release()  argument
356 	info->dacops->dac_release(info);  in dac_release()
371 #define DAC_PAR(info) ((struct ics5342_info *) info)  argument
380 static int ics5342_set_mode(struct dac_info *info, int mode)  in ics5342_set_mode()  argument
392 	dac_write_reg(info, 6, code & 0xF0);  in ics5342_set_mode()
393 	DAC_PAR(info)->mode = mode;  in ics5342_set_mode()
408 static int ics5342_set_freq(struct dac_info *info, int channel, u32 freq)  in ics5342_set_freq()  argument
413 	int rv = svga_compute_pll((DAC_PAR(info)->mode == DAC_PSEUDO8_16)  in ics5342_set_freq()
421 		dac_write_regs(info, code, 3);  in ics5342_set_freq()
426 static void ics5342_release(struct dac_info *info)  in ics5342_release()  argument
428 	ics5342_set_mode(info, DAC_PSEUDO8_8);  in ics5342_release()
429 	kfree(info);  in ics5342_release()
441 	struct dac_info *info = kzalloc(sizeof(struct ics5342_info), GFP_KERNEL);  in ics5342_init()  local
443 	if (! info)  in ics5342_init()
446 	info->dacops = &ics5342_ops;  in ics5342_init()
447 	info->dac_read_regs = drr;  in ics5342_init()
448 	info->dac_write_regs = dwr;  in ics5342_init()
449 	info->data = data;  in ics5342_init()
450 	DAC_PAR(info)->mode = DAC_PSEUDO8_8; /* estimation */  in ics5342_init()
451 	return info;  in ics5342_init()
462 	struct fb_info *info = data;  in ark_dac_read_regs()  local
466 	par = info->par;  in ark_dac_read_regs()
481 	struct fb_info *info = data;  in ark_dac_write_regs()  local
485 	par = info->par;  in ark_dac_write_regs()
499 static void ark_set_pixclock(struct fb_info *info, u32 pixclock)  in ark_set_pixclock()  argument
501 	struct arkfb_info *par = info->par;  in ark_set_pixclock()
506 		fb_err(info, "cannot set requested pixclock, keeping old value\n");  in ark_set_pixclock()
518 static int arkfb_open(struct fb_info *info, int user)  in arkfb_open()  argument
520 	struct arkfb_info *par = info->par;  in arkfb_open()
542 static int arkfb_release(struct fb_info *info, int user)  in arkfb_release()  argument
544 	struct arkfb_info *par = info->par;  in arkfb_release()
565 static int arkfb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)  in arkfb_check_var()  argument
573 		fb_err(info, "unsupported mode requested\n");  in arkfb_check_var()
591 	if (mem > info->screen_size)  in arkfb_check_var()
593 		fb_err(info, "not enough framebuffer memory (%d kB requested, %d kB available)\n",  in arkfb_check_var()
594 		       mem >> 10, (unsigned int) (info->screen_size >> 10));  in arkfb_check_var()
598 	rv = svga_check_timings (&ark_timing_regs, var, info->node);  in arkfb_check_var()
601 		fb_err(info, "invalid timings requested\n");  in arkfb_check_var()
614 static int arkfb_set_par(struct fb_info *info)  in arkfb_set_par()  argument
616 	struct arkfb_info *par = info->par;  in arkfb_set_par()
618 	u32 bpp = info->var.bits_per_pixel;  in arkfb_set_par()
622 		info->fix.ypanstep = 1;  in arkfb_set_par()
623 		info->fix.line_length = (info->var.xres_virtual * bpp) / 8;  in arkfb_set_par()
625 		info->flags &= ~FBINFO_MISC_TILEBLITTING;  in arkfb_set_par()
626 		info->tileops = NULL;  in arkfb_set_par()
629 		info->pixmap.blit_x = (bpp == 4) ? (1 << (8 - 1)) : (~(u32)0);  in arkfb_set_par()
630 		info->pixmap.blit_y = ~(u32)0;  in arkfb_set_par()
632 		offset_value = (info->var.xres_virtual * bpp) / 64;  in arkfb_set_par()
633 		screen_size = info->var.yres_virtual * info->fix.line_length;  in arkfb_set_par()
635 		info->fix.ypanstep = 16;  in arkfb_set_par()
636 		info->fix.line_length = 0;  in arkfb_set_par()
638 		info->flags |= FBINFO_MISC_TILEBLITTING;  in arkfb_set_par()
639 		info->tileops = &arkfb_tile_ops;  in arkfb_set_par()
642 		info->pixmap.blit_x = 1 << (8 - 1);  in arkfb_set_par()
643 		info->pixmap.blit_y = 1 << (16 - 1);  in arkfb_set_par()
645 		offset_value = info->var.xres_virtual / 16;  in arkfb_set_par()
646 		screen_size = (info->var.xres_virtual * info->var.yres_virtual) / 64;  in arkfb_set_par()
649 	info->var.xoffset = 0;  in arkfb_set_par()
650 	info->var.yoffset = 0;  in arkfb_set_par()
651 	info->var.activate = FB_ACTIVATE_NOW;  in arkfb_set_par()
672 	vga_wseq(par->state.vgabase, 0x13, info->fix.smem_start >> 16);  in arkfb_set_par()
673 	vga_wseq(par->state.vgabase, 0x14, info->fix.smem_start >> 24);  in arkfb_set_par()
683 	fb_dbg(info, "offset register       : %d\n", offset_value);  in arkfb_set_par()
689 	if (info->var.vmode & FB_VMODE_DOUBLE)  in arkfb_set_par()
694 	if (info->var.vmode & FB_VMODE_INTERLACED)  in arkfb_set_par()
701 	mode = svga_match_format(arkfb_formats, &(info->var), &(info->fix));  in arkfb_set_par()
706 		fb_dbg(info, "text mode\n");  in arkfb_set_par()
715 		fb_dbg(info, "4 bit pseudocolor\n");  in arkfb_set_par()
723 		fb_dbg(info, "4 bit pseudocolor, planar\n");  in arkfb_set_par()
730 		fb_dbg(info, "8 bit pseudocolor\n");  in arkfb_set_par()
734 		if (info->var.pixclock > 20000) {  in arkfb_set_par()
735 			fb_dbg(info, "not using multiplex\n");  in arkfb_set_par()
739 			fb_dbg(info, "using multiplex\n");  in arkfb_set_par()
746 		fb_dbg(info, "5/5/5 truecolor\n");  in arkfb_set_par()
753 		fb_dbg(info, "5/6/5 truecolor\n");  in arkfb_set_par()
760 		fb_dbg(info, "8/8/8 truecolor\n");  in arkfb_set_par()
769 		fb_dbg(info, "8/8/8/8 truecolor\n");  in arkfb_set_par()
777 		fb_err(info, "unsupported mode - bug\n");  in arkfb_set_par()
781 	ark_set_pixclock(info, (hdiv * info->var.pixclock) / hmul);  in arkfb_set_par()
782 	svga_set_timings(par->state.vgabase, &ark_timing_regs, &(info->var), hmul, hdiv,  in arkfb_set_par()
783 			 (info->var.vmode & FB_VMODE_DOUBLE)     ? 2 : 1,  in arkfb_set_par()
784 			 (info->var.vmode & FB_VMODE_INTERLACED) ? 2 : 1,  in arkfb_set_par()
785 			  hmul, info->node);  in arkfb_set_par()
788 	value = info->var.xres + info->var.left_margin + info->var.right_margin + info->var.hsync_len;  in arkfb_set_par()
792 	memset_io(info->screen_base, 0x00, screen_size);  in arkfb_set_par()
863 static int arkfb_blank(int blank_mode, struct fb_info *info)  in arkfb_blank()  argument
865 	struct arkfb_info *par = info->par;  in arkfb_blank()
869 		fb_dbg(info, "unblank\n");  in arkfb_blank()
874 		fb_dbg(info, "blank\n");  in arkfb_blank()
881 		fb_dbg(info, "sync down\n");  in arkfb_blank()
892 static int arkfb_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)  in arkfb_pan_display()  argument
894 	struct arkfb_info *par = info->par;  in arkfb_pan_display()
898 	if (info->var.bits_per_pixel == 0) {  in arkfb_pan_display()
899 		offset = (var->yoffset / 16) * (info->var.xres_virtual / 2)  in arkfb_pan_display()
903 		offset = (var->yoffset * info->fix.line_length) +  in arkfb_pan_display()
904 			 (var->xoffset * info->var.bits_per_pixel / 8);  in arkfb_pan_display()
905 		offset = offset >> ((info->var.bits_per_pixel == 4) ? 2 : 3);  in arkfb_pan_display()
944 	struct fb_info *info;  in ark_pci_probe()  local
956 	info = framebuffer_alloc(sizeof(struct arkfb_info), &(dev->dev));  in ark_pci_probe()
957 	if (! info) {  in ark_pci_probe()
962 	par = info->par;  in ark_pci_probe()
965 	info->flags = FBINFO_PARTIAL_PAN_OK | FBINFO_HWACCEL_YPAN;  in ark_pci_probe()
966 	info->fbops = &arkfb_ops;  in ark_pci_probe()
971 		dev_err(info->device, "cannot enable PCI device\n");  in ark_pci_probe()
977 		dev_err(info->device, "cannot reserve framebuffer region\n");  in ark_pci_probe()
981 	par->dac = ics5342_init(ark_dac_read_regs, ark_dac_write_regs, info);  in ark_pci_probe()
984 		dev_err(info->device, "RAMDAC initialization failed\n");  in ark_pci_probe()
988 	info->fix.smem_start = pci_resource_start(dev, 0);  in ark_pci_probe()
989 	info->fix.smem_len = pci_resource_len(dev, 0);  in ark_pci_probe()
992 	info->screen_base = pci_iomap_wc(dev, 0, 0);  in ark_pci_probe()
993 	if (! info->screen_base) {  in ark_pci_probe()
995 		dev_err(info->device, "iomap for framebuffer failed\n");  in ark_pci_probe()
1010 	info->screen_size = (1 << (regval >> 6)) << 20;  in ark_pci_probe()
1011 	info->fix.smem_len = info->screen_size;  in ark_pci_probe()
1013 	strcpy(info->fix.id, "ARK 2000PV");  in ark_pci_probe()
1014 	info->fix.mmio_start = 0;  in ark_pci_probe()
1015 	info->fix.mmio_len = 0;  in ark_pci_probe()
1016 	info->fix.type = FB_TYPE_PACKED_PIXELS;  in ark_pci_probe()
1017 	info->fix.visual = FB_VISUAL_PSEUDOCOLOR;  in ark_pci_probe()
1018 	info->fix.ypanstep = 0;  in ark_pci_probe()
1019 	info->fix.accel = FB_ACCEL_NONE;  in ark_pci_probe()
1020 	info->pseudo_palette = (void*) (par->pseudo_palette);  in ark_pci_probe()
1023 	rc = fb_find_mode(&(info->var), info, mode_option, NULL, 0, NULL, 8);  in ark_pci_probe()
1026 		dev_err(info->device, "mode %s not found\n", mode_option);  in ark_pci_probe()
1030 	rc = fb_alloc_cmap(&info->cmap, 256, 0);  in ark_pci_probe()
1032 		dev_err(info->device, "cannot allocate colormap\n");  in ark_pci_probe()
1036 	rc = register_framebuffer(info);  in ark_pci_probe()
1038 		dev_err(info->device, "cannot register framebuffer\n");  in ark_pci_probe()
1042 	fb_info(info, "%s on %s, %d MB RAM\n",  in ark_pci_probe()
1043 		info->fix.id, pci_name(dev), info->fix.smem_len >> 20);  in ark_pci_probe()
1046 	pci_set_drvdata(dev, info);  in ark_pci_probe()
1047 	par->wc_cookie = arch_phys_wc_add(info->fix.smem_start,  in ark_pci_probe()
1048 					  info->fix.smem_len);  in ark_pci_probe()
1053 	fb_dealloc_cmap(&info->cmap);  in ark_pci_probe()
1056 	pci_iounmap(dev, info->screen_base);  in ark_pci_probe()
1064 	framebuffer_release(info);  in ark_pci_probe()
1072 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_remove()  local
1074 	if (info) {  in ark_pci_remove()
1075 		struct arkfb_info *par = info->par;  in ark_pci_remove()
1078 		unregister_framebuffer(info);  in ark_pci_remove()
1079 		fb_dealloc_cmap(&info->cmap);  in ark_pci_remove()
1081 		pci_iounmap(dev, info->screen_base);  in ark_pci_remove()
1085 		framebuffer_release(info);  in ark_pci_remove()
1095 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_suspend()  local
1096 	struct arkfb_info *par = info->par;  in ark_pci_suspend()
1098 	dev_info(info->device, "suspend\n");  in ark_pci_suspend()
1109 	fb_set_suspend(info, 1);  in ark_pci_suspend()
1126 	struct fb_info *info = pci_get_drvdata(dev);  in ark_pci_resume()  local
1127 	struct arkfb_info *par = info->par;  in ark_pci_resume()
1129 	dev_info(info->device, "resume\n");  in ark_pci_resume()
1145 	arkfb_set_par(info);  in ark_pci_resume()
1146 	fb_set_suspend(info, 0);  in ark_pci_resume()