613 static void overlay1fb_setup(struct pxafb_layer *ofb)  in overlay1fb_setup()  argument
615 	int size = ofb->fb.fix.line_length * ofb->fb.var.yres_virtual;  in overlay1fb_setup()
616 	unsigned long start = ofb->video_mem_phys;  in overlay1fb_setup()
617 	setup_frame_dma(ofb->fbi, DMA_OV1, PAL_NONE, start, size);  in overlay1fb_setup()
623 static void overlay1fb_enable(struct pxafb_layer *ofb)  in overlay1fb_enable()  argument
625 	int enabled = lcd_readl(ofb->fbi, OVL1C1) & OVLxC1_OEN;  in overlay1fb_enable()
626 	uint32_t fdadr1 = ofb->fbi->fdadr[DMA_OV1] | (enabled ? 0x1 : 0);  in overlay1fb_enable()
628 	lcd_writel(ofb->fbi, enabled ? FBR1 : FDADR1, fdadr1);  in overlay1fb_enable()
629 	lcd_writel(ofb->fbi, OVL1C2, ofb->control[1]);  in overlay1fb_enable()
630 	lcd_writel(ofb->fbi, OVL1C1, ofb->control[0] | OVLxC1_OEN);  in overlay1fb_enable()
633 static void overlay1fb_disable(struct pxafb_layer *ofb)  in overlay1fb_disable()  argument
637 	if (!(lcd_readl(ofb->fbi, OVL1C1) & OVLxC1_OEN))  in overlay1fb_disable()
640 	lccr5 = lcd_readl(ofb->fbi, LCCR5);  in overlay1fb_disable()
642 	lcd_writel(ofb->fbi, OVL1C1, ofb->control[0] & ~OVLxC1_OEN);  in overlay1fb_disable()
644 	lcd_writel(ofb->fbi, LCSR1, LCSR1_BS(1));  in overlay1fb_disable()
645 	lcd_writel(ofb->fbi, LCCR5, lccr5 & ~LCSR1_BS(1));  in overlay1fb_disable()
646 	lcd_writel(ofb->fbi, FBR1, ofb->fbi->fdadr[DMA_OV1] | 0x3);  in overlay1fb_disable()
648 	if (wait_for_completion_timeout(&ofb->branch_done, 1 * HZ) == 0)  in overlay1fb_disable()
651 	lcd_writel(ofb->fbi, LCCR5, lccr5);  in overlay1fb_disable()
654 static void overlay2fb_setup(struct pxafb_layer *ofb)  in overlay2fb_setup()  argument
656 	int size, div = 1, pfor = NONSTD_TO_PFOR(ofb->fb.var.nonstd);  in overlay2fb_setup()
657 	unsigned long start[3] = { ofb->video_mem_phys, 0, 0 };  in overlay2fb_setup()
660 		size = ofb->fb.fix.line_length * ofb->fb.var.yres_virtual;  in overlay2fb_setup()
661 		setup_frame_dma(ofb->fbi, DMA_OV2_Y, -1, start[0], size);  in overlay2fb_setup()
663 		size = ofb->fb.var.xres_virtual * ofb->fb.var.yres_virtual;  in overlay2fb_setup()
671 		setup_frame_dma(ofb->fbi, DMA_OV2_Y,  -1, start[0], size);  in overlay2fb_setup()
672 		setup_frame_dma(ofb->fbi, DMA_OV2_Cb, -1, start[1], size / div);  in overlay2fb_setup()
673 		setup_frame_dma(ofb->fbi, DMA_OV2_Cr, -1, start[2], size / div);  in overlay2fb_setup()
677 static void overlay2fb_enable(struct pxafb_layer *ofb)  in overlay2fb_enable()  argument
679 	int pfor = NONSTD_TO_PFOR(ofb->fb.var.nonstd);  in overlay2fb_enable()
680 	int enabled = lcd_readl(ofb->fbi, OVL2C1) & OVLxC1_OEN;  in overlay2fb_enable()
681 	uint32_t fdadr2 = ofb->fbi->fdadr[DMA_OV2_Y]  | (enabled ? 0x1 : 0);  in overlay2fb_enable()
682 	uint32_t fdadr3 = ofb->fbi->fdadr[DMA_OV2_Cb] | (enabled ? 0x1 : 0);  in overlay2fb_enable()
683 	uint32_t fdadr4 = ofb->fbi->fdadr[DMA_OV2_Cr] | (enabled ? 0x1 : 0);  in overlay2fb_enable()
686 		lcd_writel(ofb->fbi, enabled ? FBR2 : FDADR2, fdadr2);  in overlay2fb_enable()
688 		lcd_writel(ofb->fbi, enabled ? FBR2 : FDADR2, fdadr2);  in overlay2fb_enable()
689 		lcd_writel(ofb->fbi, enabled ? FBR3 : FDADR3, fdadr3);  in overlay2fb_enable()
690 		lcd_writel(ofb->fbi, enabled ? FBR4 : FDADR4, fdadr4);  in overlay2fb_enable()
692 	lcd_writel(ofb->fbi, OVL2C2, ofb->control[1]);  in overlay2fb_enable()
693 	lcd_writel(ofb->fbi, OVL2C1, ofb->control[0] | OVLxC1_OEN);  in overlay2fb_enable()
696 static void overlay2fb_disable(struct pxafb_layer *ofb)  in overlay2fb_disable()  argument
700 	if (!(lcd_readl(ofb->fbi, OVL2C1) & OVLxC1_OEN))  in overlay2fb_disable()
703 	lccr5 = lcd_readl(ofb->fbi, LCCR5);  in overlay2fb_disable()
705 	lcd_writel(ofb->fbi, OVL2C1, ofb->control[0] & ~OVLxC1_OEN);  in overlay2fb_disable()
707 	lcd_writel(ofb->fbi, LCSR1, LCSR1_BS(2));  in overlay2fb_disable()
708 	lcd_writel(ofb->fbi, LCCR5, lccr5 & ~LCSR1_BS(2));  in overlay2fb_disable()
709 	lcd_writel(ofb->fbi, FBR2, ofb->fbi->fdadr[DMA_OV2_Y]  | 0x3);  in overlay2fb_disable()
710 	lcd_writel(ofb->fbi, FBR3, ofb->fbi->fdadr[DMA_OV2_Cb] | 0x3);  in overlay2fb_disable()
711 	lcd_writel(ofb->fbi, FBR4, ofb->fbi->fdadr[DMA_OV2_Cr] | 0x3);  in overlay2fb_disable()
713 	if (wait_for_completion_timeout(&ofb->branch_done, 1 * HZ) == 0)  in overlay2fb_disable()
732 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_open()  local
738 	if (ofb->usage++ == 0) {  in overlayfb_open()
741 		fb_blank(&ofb->fbi->fb, FB_BLANK_UNBLANK);  in overlayfb_open()
750 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_release()  local
752 	if (ofb->usage == 1) {  in overlayfb_release()
753 		ofb->ops->disable(ofb);  in overlayfb_release()
754 		ofb->fb.var.height	= -1;  in overlayfb_release()
755 		ofb->fb.var.width	= -1;  in overlayfb_release()
756 		ofb->fb.var.xres = ofb->fb.var.xres_virtual = 0;  in overlayfb_release()
757 		ofb->fb.var.yres = ofb->fb.var.yres_virtual = 0;  in overlayfb_release()
759 		ofb->usage--;  in overlayfb_release()
767 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_check_var()  local
768 	struct fb_var_screeninfo *base_var = &ofb->fbi->fb.var;  in overlayfb_check_var()
780 	if (ofb->id == OVERLAY1 && pfor != 0)  in overlayfb_check_var()
816 static int overlayfb_check_video_memory(struct pxafb_layer *ofb)  in overlayfb_check_video_memory()  argument
818 	struct fb_var_screeninfo *var = &ofb->fb.var;  in overlayfb_check_video_memory()
830 	ofb->fb.fix.line_length = var->xres_virtual * bpp / 8;  in overlayfb_check_video_memory()
832 	size = PAGE_ALIGN(ofb->fb.fix.line_length * var->yres_virtual);  in overlayfb_check_video_memory()
834 	if (ofb->video_mem) {  in overlayfb_check_video_memory()
835 		if (ofb->video_mem_size >= size)  in overlayfb_check_video_memory()
843 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_set_par()  local
847 	ret = overlayfb_check_video_memory(ofb);  in overlayfb_set_par()
856 	ofb->control[0] = OVLxC1_PPL(var->xres) | OVLxC1_LPO(var->yres) |  in overlayfb_set_par()
858 	ofb->control[1] = OVLxC2_XPOS(xpos) | OVLxC2_YPOS(ypos);  in overlayfb_set_par()
860 	if (ofb->id == OVERLAY2)  in overlayfb_set_par()
861 		ofb->control[1] |= OVL2C2_PFOR(pfor);  in overlayfb_set_par()
863 	ofb->ops->setup(ofb);  in overlayfb_set_par()
864 	ofb->ops->enable(ofb);  in overlayfb_set_par()
876 static void init_pxafb_overlay(struct pxafb_info *fbi, struct pxafb_layer *ofb,  in init_pxafb_overlay()  argument
879 	sprintf(ofb->fb.fix.id, "overlay%d", id + 1);  in init_pxafb_overlay()
881 	ofb->fb.fix.type		= FB_TYPE_PACKED_PIXELS;  in init_pxafb_overlay()
882 	ofb->fb.fix.xpanstep		= 0;  in init_pxafb_overlay()
883 	ofb->fb.fix.ypanstep		= 1;  in init_pxafb_overlay()
885 	ofb->fb.var.activate		= FB_ACTIVATE_NOW;  in init_pxafb_overlay()
886 	ofb->fb.var.height		= -1;  in init_pxafb_overlay()
887 	ofb->fb.var.width		= -1;  in init_pxafb_overlay()
888 	ofb->fb.var.vmode		= FB_VMODE_NONINTERLACED;  in init_pxafb_overlay()
890 	ofb->fb.fbops			= &overlay_fb_ops;  in init_pxafb_overlay()
891 	ofb->fb.flags			= FBINFO_FLAG_DEFAULT;  in init_pxafb_overlay()
892 	ofb->fb.node			= -1;  in init_pxafb_overlay()
893 	ofb->fb.pseudo_palette		= NULL;  in init_pxafb_overlay()
895 	ofb->id = id;  in init_pxafb_overlay()
896 	ofb->ops = &ofb_ops[id];  in init_pxafb_overlay()
897 	ofb->usage = 0;  in init_pxafb_overlay()
898 	ofb->fbi = fbi;  in init_pxafb_overlay()
899 	init_completion(&ofb->branch_done);  in init_pxafb_overlay()
911 					  struct pxafb_layer *ofb)  in pxafb_overlay_map_video_memory()  argument
916 	ofb->video_mem = alloc_pages_exact(PAGE_ALIGN(pxafb->video_mem_size),  in pxafb_overlay_map_video_memory()
918 	if (ofb->video_mem == NULL)  in pxafb_overlay_map_video_memory()
921 	ofb->video_mem_phys = virt_to_phys(ofb->video_mem);  in pxafb_overlay_map_video_memory()
922 	ofb->video_mem_size = PAGE_ALIGN(pxafb->video_mem_size);  in pxafb_overlay_map_video_memory()
924 	mutex_lock(&ofb->fb.mm_lock);  in pxafb_overlay_map_video_memory()
925 	ofb->fb.fix.smem_start	= ofb->video_mem_phys;  in pxafb_overlay_map_video_memory()
926 	ofb->fb.fix.smem_len	= pxafb->video_mem_size;  in pxafb_overlay_map_video_memory()
927 	mutex_unlock(&ofb->fb.mm_lock);  in pxafb_overlay_map_video_memory()
929 	ofb->fb.screen_base	= ofb->video_mem;  in pxafb_overlay_map_video_memory()
942 		struct pxafb_layer *ofb = &fbi->overlay[i];  in pxafb_overlay_init()  local
943 		init_pxafb_overlay(fbi, ofb, i);  in pxafb_overlay_init()
944 		ret = register_framebuffer(&ofb->fb);  in pxafb_overlay_init()
949 		ret = pxafb_overlay_map_video_memory(fbi, ofb);  in pxafb_overlay_init()
954 			unregister_framebuffer(&ofb->fb);  in pxafb_overlay_init()
957 		ofb->registered = 1;  in pxafb_overlay_init()
974 		struct pxafb_layer *ofb = &fbi->overlay[i];  in pxafb_overlay_exit()  local
975 		if (ofb->registered) {  in pxafb_overlay_exit()
976 			if (ofb->video_mem)  in pxafb_overlay_exit()
977 				free_pages_exact(ofb->video_mem,  in pxafb_overlay_exit()
978 					ofb->video_mem_size);  in pxafb_overlay_exit()
979 			unregister_framebuffer(&ofb->fb);  in pxafb_overlay_exit()