Lines Matching refs:p
139 static int init_control(struct fb_info_control *p);
140 static void control_set_hardware(struct fb_info_control *p,
143 static void find_vram_size(struct fb_info_control *p);
144 static int read_control_sense(struct fb_info_control *p);
150 static void control_init_info(struct fb_info *info, struct fb_info_control *p);
221 struct fb_info_control *p = in controlfb_set_par() local
232 control_set_hardware(p, &par); in controlfb_set_par()
234 info->fix.visual = (p->par.cmode == CMODE_8) ? in controlfb_set_par()
236 info->fix.line_length = p->par.pitch; in controlfb_set_par()
237 info->fix.xpanstep = 32 >> p->par.cmode; in controlfb_set_par()
247 struct fb_info_control *p) in set_screen_start() argument
249 struct fb_par_control *par = &p->par; in set_screen_start()
253 out_le32(CNTRL_REG(p,start_addr), in set_screen_start()
262 struct fb_info_control *p = in controlfb_pan_display() local
264 struct fb_par_control *par = &p->par; in controlfb_pan_display()
276 set_screen_start(xoffset, var->yoffset, p); in controlfb_pan_display()
314 struct fb_info_control *p = in controlfb_blank() local
318 ctrl = le32_to_cpup(CNTRL_REG(p,ctrl)); in controlfb_blank()
340 out_le32(CNTRL_REG(p,ctrl), ctrl); in controlfb_blank()
348 struct fb_info_control *p = in controlfb_setcolreg() local
359 out_8(&p->cmap_regs->addr, regno); /* tell clut what addr to fill */ in controlfb_setcolreg()
360 out_8(&p->cmap_regs->lut, r); /* send one color channel at */ in controlfb_setcolreg()
361 out_8(&p->cmap_regs->lut, g); /* a time... */ in controlfb_setcolreg()
362 out_8(&p->cmap_regs->lut, b); in controlfb_setcolreg()
366 switch (p->par.cmode) { in controlfb_setcolreg()
368 p->pseudo_palette[regno] = in controlfb_setcolreg()
373 p->pseudo_palette[regno] = (i << 16) | i; in controlfb_setcolreg()
405 static int __init init_control(struct fb_info_control *p) in init_control() argument
413 full = p->total_vram == 0x400000; in init_control()
429 sense = read_control_sense(p); in init_control()
448 control_init_info(&p->info, p); in init_control()
465 vyres = (p->total_vram - CTRLFB_OFF) / (var.xres << cmode); in init_control()
471 rc = fb_set_var(&p->info, &var); in init_control()
476 if (register_framebuffer(&p->info) < 0) in init_control()
479 fb_info(&p->info, "control display adapter\n"); in init_control()
485 out_8(&p->cmap_regs->addr, (a)); \
486 out_8(&p->cmap_regs->dat, (d))
490 static void control_set_hardware(struct fb_info_control *p, struct fb_par_control *par) in control_set_hardware() argument
496 if (PAR_EQUAL(&p->par, par)) { in control_set_hardware()
501 if (p->par.xoffset != par->xoffset || in control_set_hardware()
502 p->par.yoffset != par->yoffset) in control_set_hardware()
503 set_screen_start(par->xoffset, par->yoffset, p); in control_set_hardware()
508 p->par = *par; in control_set_hardware()
509 cmode = p->par.cmode; in control_set_hardware()
513 out_le32(CNTRL_REG(p,ctrl), 0x400 | par->ctrl); in control_set_hardware()
518 RADACAL_WRITE(0x21, p->control_use_bank2 ? 0 : 1); in control_set_hardware()
522 rp = &p->control_regs->vswin; in control_set_hardware()
526 out_le32(CNTRL_REG(p,pitch), par->pitch); in control_set_hardware()
527 out_le32(CNTRL_REG(p,mode), r->mode); in control_set_hardware()
528 out_le32(CNTRL_REG(p,vram_attr), p->vram_attr); in control_set_hardware()
529 out_le32(CNTRL_REG(p,start_addr), par->yoffset * par->pitch in control_set_hardware()
531 out_le32(CNTRL_REG(p,rfrcnt), 0x1e5); in control_set_hardware()
532 out_le32(CNTRL_REG(p,intr_ena), 0); in control_set_hardware()
535 out_le32(CNTRL_REG(p,ctrl), par->ctrl); in control_set_hardware()
538 btext_update_display(p->frame_buffer_phys + CTRLFB_OFF, in control_set_hardware()
539 p->par.xres, p->par.yres, in control_set_hardware()
541 p->par.pitch); in control_set_hardware()
609 static void __init find_vram_size(struct fb_info_control *p) in find_vram_size() argument
618 out_le32(CNTRL_REG(p,vram_attr), 0x31); in find_vram_size()
620 out_8(&p->frame_buffer[0x600000], 0xb3); in find_vram_size()
621 out_8(&p->frame_buffer[0x600001], 0x71); in find_vram_size()
622 asm volatile("eieio; dcbf 0,%0" : : "r" (&p->frame_buffer[0x600000]) in find_vram_size()
625 asm volatile("eieio; dcbi 0,%0" : : "r" (&p->frame_buffer[0x600000]) in find_vram_size()
629 bank2 = (in_8(&p->frame_buffer[0x600000]) == 0xb3) in find_vram_size()
630 && (in_8(&p->frame_buffer[0x600001]) == 0x71); in find_vram_size()
637 out_le32(CNTRL_REG(p,vram_attr), 0x39); in find_vram_size()
639 out_8(&p->frame_buffer[0], 0x5a); in find_vram_size()
640 out_8(&p->frame_buffer[1], 0xc7); in find_vram_size()
641 asm volatile("eieio; dcbf 0,%0" : : "r" (&p->frame_buffer[0]) in find_vram_size()
644 asm volatile("eieio; dcbi 0,%0" : : "r" (&p->frame_buffer[0]) in find_vram_size()
648 bank1 = (in_8(&p->frame_buffer[0]) == 0x5a) in find_vram_size()
649 && (in_8(&p->frame_buffer[1]) == 0xc7); in find_vram_size()
656 p->control_use_bank2 = 1; in find_vram_size()
657 p->vram_attr = 0x39; in find_vram_size()
658 p->frame_buffer += 0x600000; in find_vram_size()
659 p->frame_buffer_phys += 0x600000; in find_vram_size()
664 p->vram_attr = 0x51; in find_vram_size()
670 p->vram_attr = 0x31; in find_vram_size()
673 p->total_vram = (bank1 + bank2) * 0x200000; in find_vram_size()
686 struct fb_info_control *p; in control_of_init() local
699 p = kzalloc(sizeof(*p), GFP_KERNEL); in control_of_init()
700 if (p == 0) in control_of_init()
702 control_fb = p; /* save it for cleanups */ in control_of_init()
705 p->fb_orig_base = fb_res.start; in control_of_init()
706 p->fb_orig_size = resource_size(&fb_res); in control_of_init()
708 p->frame_buffer_phys = fb_res.start + 0x800000; in control_of_init()
709 p->control_regs_phys = reg_res.start; in control_of_init()
710 p->control_regs_size = resource_size(®_res); in control_of_init()
712 if (!p->fb_orig_base || in control_of_init()
713 !request_mem_region(p->fb_orig_base,p->fb_orig_size,"controlfb")) { in control_of_init()
714 p->fb_orig_base = 0; in control_of_init()
718 p->frame_buffer = __ioremap(p->frame_buffer_phys, 0x800000, in control_of_init()
721 if (!p->control_regs_phys || in control_of_init()
722 !request_mem_region(p->control_regs_phys, p->control_regs_size, in control_of_init()
724 p->control_regs_phys = 0; in control_of_init()
727 p->control_regs = ioremap(p->control_regs_phys, p->control_regs_size); in control_of_init()
729 p->cmap_regs_phys = 0xf301b000; /* XXX not in prom? */ in control_of_init()
730 if (!request_mem_region(p->cmap_regs_phys, 0x1000, "controlfb cmap")) { in control_of_init()
731 p->cmap_regs_phys = 0; in control_of_init()
734 p->cmap_regs = ioremap(p->cmap_regs_phys, 0x1000); in control_of_init()
736 if (!p->cmap_regs || !p->control_regs || !p->frame_buffer) in control_of_init()
739 find_vram_size(p); in control_of_init()
740 if (!p->total_vram) in control_of_init()
743 if (init_control(p) < 0) in control_of_init()
758 static int read_control_sense(struct fb_info_control *p) in read_control_sense() argument
762 out_le32(CNTRL_REG(p,mon_sense), 7); /* drive all lines high */ in read_control_sense()
764 out_le32(CNTRL_REG(p,mon_sense), 077); /* turn off drivers */ in read_control_sense()
766 sense = (in_le32(CNTRL_REG(p,mon_sense)) & 0x1c0) << 2; in read_control_sense()
769 out_le32(CNTRL_REG(p,mon_sense), 033); /* drive A low */ in read_control_sense()
771 sense |= (in_le32(CNTRL_REG(p,mon_sense)) & 0xc0) >> 2; in read_control_sense()
772 out_le32(CNTRL_REG(p,mon_sense), 055); /* drive B low */ in read_control_sense()
774 sense |= ((in_le32(CNTRL_REG(p,mon_sense)) & 0x100) >> 5) in read_control_sense()
775 | ((in_le32(CNTRL_REG(p,mon_sense)) & 0x40) >> 4); in read_control_sense()
776 out_le32(CNTRL_REG(p,mon_sense), 066); /* drive C low */ in read_control_sense()
778 sense |= (in_le32(CNTRL_REG(p,mon_sense)) & 0x180) >> 7; in read_control_sense()
780 out_le32(CNTRL_REG(p,mon_sense), 077); /* turn off drivers */ in read_control_sense()
840 struct fb_info_control *p = in control_var_to_par() local
847 if (p->total_vram > 0x200000) { in control_var_to_par()
860 if (p->total_vram > 0x200000) { in control_var_to_par()
872 if (p->total_vram > 0x200000) { in control_var_to_par()
905 if (par->pitch * par->vyres + CTRLFB_OFF > p->total_vram) in control_var_to_par()
1040 static void __init control_init_info(struct fb_info *info, struct fb_info_control *p) in control_init_info() argument
1043 info->par = &p->par; in control_init_info()
1045 info->pseudo_palette = p->pseudo_palette; in control_init_info()
1047 info->screen_base = p->frame_buffer + CTRLFB_OFF; in control_init_info()
1053 info->fix.mmio_start = p->control_regs_phys; in control_init_info()
1056 info->fix.smem_start = p->frame_buffer_phys + CTRLFB_OFF; in control_init_info()
1057 info->fix.smem_len = p->total_vram - CTRLFB_OFF; in control_init_info()
1066 struct fb_info_control *p = control_fb; in control_cleanup() local
1068 if (!p) in control_cleanup()
1071 if (p->cmap_regs) in control_cleanup()
1072 iounmap(p->cmap_regs); in control_cleanup()
1073 if (p->control_regs) in control_cleanup()
1074 iounmap(p->control_regs); in control_cleanup()
1075 if (p->frame_buffer) { in control_cleanup()
1076 if (p->control_use_bank2) in control_cleanup()
1077 p->frame_buffer -= 0x600000; in control_cleanup()
1078 iounmap(p->frame_buffer); in control_cleanup()
1080 if (p->cmap_regs_phys) in control_cleanup()
1081 release_mem_region(p->cmap_regs_phys, 0x1000); in control_cleanup()
1082 if (p->control_regs_phys) in control_cleanup()
1083 release_mem_region(p->control_regs_phys, p->control_regs_size); in control_cleanup()
1084 if (p->fb_orig_base) in control_cleanup()
1085 release_mem_region(p->fb_orig_base, p->fb_orig_size); in control_cleanup()
1086 kfree(p); in control_cleanup()