611 static void overlay1fb_setup(struct pxafb_layer *ofb)  in overlay1fb_setup()  argument
613 	int size = ofb->fb.fix.line_length * ofb->fb.var.yres_virtual;  in overlay1fb_setup()
614 	unsigned long start = ofb->video_mem_phys;  in overlay1fb_setup()
615 	setup_frame_dma(ofb->fbi, DMA_OV1, PAL_NONE, start, size);  in overlay1fb_setup()
621 static void overlay1fb_enable(struct pxafb_layer *ofb)  in overlay1fb_enable()  argument
623 	int enabled = lcd_readl(ofb->fbi, OVL1C1) & OVLxC1_OEN;  in overlay1fb_enable()
624 	uint32_t fdadr1 = ofb->fbi->fdadr[DMA_OV1] | (enabled ? 0x1 : 0);  in overlay1fb_enable()
626 	lcd_writel(ofb->fbi, enabled ? FBR1 : FDADR1, fdadr1);  in overlay1fb_enable()
627 	lcd_writel(ofb->fbi, OVL1C2, ofb->control[1]);  in overlay1fb_enable()
628 	lcd_writel(ofb->fbi, OVL1C1, ofb->control[0] | OVLxC1_OEN);  in overlay1fb_enable()
631 static void overlay1fb_disable(struct pxafb_layer *ofb)  in overlay1fb_disable()  argument
635 	if (!(lcd_readl(ofb->fbi, OVL1C1) & OVLxC1_OEN))  in overlay1fb_disable()
638 	lccr5 = lcd_readl(ofb->fbi, LCCR5);  in overlay1fb_disable()
640 	lcd_writel(ofb->fbi, OVL1C1, ofb->control[0] & ~OVLxC1_OEN);  in overlay1fb_disable()
642 	lcd_writel(ofb->fbi, LCSR1, LCSR1_BS(1));  in overlay1fb_disable()
643 	lcd_writel(ofb->fbi, LCCR5, lccr5 & ~LCSR1_BS(1));  in overlay1fb_disable()
644 	lcd_writel(ofb->fbi, FBR1, ofb->fbi->fdadr[DMA_OV1] | 0x3);  in overlay1fb_disable()
646 	if (wait_for_completion_timeout(&ofb->branch_done, 1 * HZ) == 0)  in overlay1fb_disable()
649 	lcd_writel(ofb->fbi, LCCR5, lccr5);  in overlay1fb_disable()
652 static void overlay2fb_setup(struct pxafb_layer *ofb)  in overlay2fb_setup()  argument
654 	int size, div = 1, pfor = NONSTD_TO_PFOR(ofb->fb.var.nonstd);  in overlay2fb_setup()
655 	unsigned long start[3] = { ofb->video_mem_phys, 0, 0 };  in overlay2fb_setup()
658 		size = ofb->fb.fix.line_length * ofb->fb.var.yres_virtual;  in overlay2fb_setup()
659 		setup_frame_dma(ofb->fbi, DMA_OV2_Y, -1, start[0], size);  in overlay2fb_setup()
661 		size = ofb->fb.var.xres_virtual * ofb->fb.var.yres_virtual;  in overlay2fb_setup()
669 		setup_frame_dma(ofb->fbi, DMA_OV2_Y,  -1, start[0], size);  in overlay2fb_setup()
670 		setup_frame_dma(ofb->fbi, DMA_OV2_Cb, -1, start[1], size / div);  in overlay2fb_setup()
671 		setup_frame_dma(ofb->fbi, DMA_OV2_Cr, -1, start[2], size / div);  in overlay2fb_setup()
675 static void overlay2fb_enable(struct pxafb_layer *ofb)  in overlay2fb_enable()  argument
677 	int pfor = NONSTD_TO_PFOR(ofb->fb.var.nonstd);  in overlay2fb_enable()
678 	int enabled = lcd_readl(ofb->fbi, OVL2C1) & OVLxC1_OEN;  in overlay2fb_enable()
679 	uint32_t fdadr2 = ofb->fbi->fdadr[DMA_OV2_Y]  | (enabled ? 0x1 : 0);  in overlay2fb_enable()
680 	uint32_t fdadr3 = ofb->fbi->fdadr[DMA_OV2_Cb] | (enabled ? 0x1 : 0);  in overlay2fb_enable()
681 	uint32_t fdadr4 = ofb->fbi->fdadr[DMA_OV2_Cr] | (enabled ? 0x1 : 0);  in overlay2fb_enable()
684 		lcd_writel(ofb->fbi, enabled ? FBR2 : FDADR2, fdadr2);  in overlay2fb_enable()
686 		lcd_writel(ofb->fbi, enabled ? FBR2 : FDADR2, fdadr2);  in overlay2fb_enable()
687 		lcd_writel(ofb->fbi, enabled ? FBR3 : FDADR3, fdadr3);  in overlay2fb_enable()
688 		lcd_writel(ofb->fbi, enabled ? FBR4 : FDADR4, fdadr4);  in overlay2fb_enable()
690 	lcd_writel(ofb->fbi, OVL2C2, ofb->control[1]);  in overlay2fb_enable()
691 	lcd_writel(ofb->fbi, OVL2C1, ofb->control[0] | OVLxC1_OEN);  in overlay2fb_enable()
694 static void overlay2fb_disable(struct pxafb_layer *ofb)  in overlay2fb_disable()  argument
698 	if (!(lcd_readl(ofb->fbi, OVL2C1) & OVLxC1_OEN))  in overlay2fb_disable()
701 	lccr5 = lcd_readl(ofb->fbi, LCCR5);  in overlay2fb_disable()
703 	lcd_writel(ofb->fbi, OVL2C1, ofb->control[0] & ~OVLxC1_OEN);  in overlay2fb_disable()
705 	lcd_writel(ofb->fbi, LCSR1, LCSR1_BS(2));  in overlay2fb_disable()
706 	lcd_writel(ofb->fbi, LCCR5, lccr5 & ~LCSR1_BS(2));  in overlay2fb_disable()
707 	lcd_writel(ofb->fbi, FBR2, ofb->fbi->fdadr[DMA_OV2_Y]  | 0x3);  in overlay2fb_disable()
708 	lcd_writel(ofb->fbi, FBR3, ofb->fbi->fdadr[DMA_OV2_Cb] | 0x3);  in overlay2fb_disable()
709 	lcd_writel(ofb->fbi, FBR4, ofb->fbi->fdadr[DMA_OV2_Cr] | 0x3);  in overlay2fb_disable()
711 	if (wait_for_completion_timeout(&ofb->branch_done, 1 * HZ) == 0)  in overlay2fb_disable()
730 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_open()  local
736 	if (ofb->usage++ == 0) {  in overlayfb_open()
739 		fb_blank(&ofb->fbi->fb, FB_BLANK_UNBLANK);  in overlayfb_open()
748 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_release()  local
750 	if (ofb->usage == 1) {  in overlayfb_release()
751 		ofb->ops->disable(ofb);  in overlayfb_release()
752 		ofb->fb.var.height	= -1;  in overlayfb_release()
753 		ofb->fb.var.width	= -1;  in overlayfb_release()
754 		ofb->fb.var.xres = ofb->fb.var.xres_virtual = 0;  in overlayfb_release()
755 		ofb->fb.var.yres = ofb->fb.var.yres_virtual = 0;  in overlayfb_release()
757 		ofb->usage--;  in overlayfb_release()
765 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_check_var()  local
766 	struct fb_var_screeninfo *base_var = &ofb->fbi->fb.var;  in overlayfb_check_var()
778 	if (ofb->id == OVERLAY1 && pfor != 0)  in overlayfb_check_var()
814 static int overlayfb_check_video_memory(struct pxafb_layer *ofb)  in overlayfb_check_video_memory()  argument
816 	struct fb_var_screeninfo *var = &ofb->fb.var;  in overlayfb_check_video_memory()
828 	ofb->fb.fix.line_length = var->xres_virtual * bpp / 8;  in overlayfb_check_video_memory()
830 	size = PAGE_ALIGN(ofb->fb.fix.line_length * var->yres_virtual);  in overlayfb_check_video_memory()
832 	if (ofb->video_mem) {  in overlayfb_check_video_memory()
833 		if (ofb->video_mem_size >= size)  in overlayfb_check_video_memory()
841 	struct pxafb_layer *ofb = container_of(info, struct pxafb_layer, fb);  in overlayfb_set_par()  local
845 	ret = overlayfb_check_video_memory(ofb);  in overlayfb_set_par()
854 	ofb->control[0] = OVLxC1_PPL(var->xres) | OVLxC1_LPO(var->yres) |  in overlayfb_set_par()
856 	ofb->control[1] = OVLxC2_XPOS(xpos) | OVLxC2_YPOS(ypos);  in overlayfb_set_par()
858 	if (ofb->id == OVERLAY2)  in overlayfb_set_par()
859 		ofb->control[1] |= OVL2C2_PFOR(pfor);  in overlayfb_set_par()
861 	ofb->ops->setup(ofb);  in overlayfb_set_par()
862 	ofb->ops->enable(ofb);  in overlayfb_set_par()
874 static void init_pxafb_overlay(struct pxafb_info *fbi, struct pxafb_layer *ofb,  in init_pxafb_overlay()  argument
877 	sprintf(ofb->fb.fix.id, "overlay%d", id + 1);  in init_pxafb_overlay()
879 	ofb->fb.fix.type		= FB_TYPE_PACKED_PIXELS;  in init_pxafb_overlay()
880 	ofb->fb.fix.xpanstep		= 0;  in init_pxafb_overlay()
881 	ofb->fb.fix.ypanstep		= 1;  in init_pxafb_overlay()
883 	ofb->fb.var.activate		= FB_ACTIVATE_NOW;  in init_pxafb_overlay()
884 	ofb->fb.var.height		= -1;  in init_pxafb_overlay()
885 	ofb->fb.var.width		= -1;  in init_pxafb_overlay()
886 	ofb->fb.var.vmode		= FB_VMODE_NONINTERLACED;  in init_pxafb_overlay()
888 	ofb->fb.fbops			= &overlay_fb_ops;  in init_pxafb_overlay()
889 	ofb->fb.node			= -1;  in init_pxafb_overlay()
890 	ofb->fb.pseudo_palette		= NULL;  in init_pxafb_overlay()
892 	ofb->id = id;  in init_pxafb_overlay()
893 	ofb->ops = &ofb_ops[id];  in init_pxafb_overlay()
894 	ofb->usage = 0;  in init_pxafb_overlay()
895 	ofb->fbi = fbi;  in init_pxafb_overlay()
896 	init_completion(&ofb->branch_done);  in init_pxafb_overlay()
908 					  struct pxafb_layer *ofb)  in pxafb_overlay_map_video_memory()  argument
913 	ofb->video_mem = alloc_pages_exact(PAGE_ALIGN(pxafb->video_mem_size),  in pxafb_overlay_map_video_memory()
915 	if (ofb->video_mem == NULL)  in pxafb_overlay_map_video_memory()
918 	ofb->video_mem_phys = virt_to_phys(ofb->video_mem);  in pxafb_overlay_map_video_memory()
919 	ofb->video_mem_size = PAGE_ALIGN(pxafb->video_mem_size);  in pxafb_overlay_map_video_memory()
921 	mutex_lock(&ofb->fb.mm_lock);  in pxafb_overlay_map_video_memory()
922 	ofb->fb.fix.smem_start	= ofb->video_mem_phys;  in pxafb_overlay_map_video_memory()
923 	ofb->fb.fix.smem_len	= pxafb->video_mem_size;  in pxafb_overlay_map_video_memory()
924 	mutex_unlock(&ofb->fb.mm_lock);  in pxafb_overlay_map_video_memory()
926 	ofb->fb.screen_base	= ofb->video_mem;  in pxafb_overlay_map_video_memory()
939 		struct pxafb_layer *ofb = &fbi->overlay[i];  in pxafb_overlay_init()  local
940 		init_pxafb_overlay(fbi, ofb, i);  in pxafb_overlay_init()
941 		ret = register_framebuffer(&ofb->fb);  in pxafb_overlay_init()
946 		ret = pxafb_overlay_map_video_memory(fbi, ofb);  in pxafb_overlay_init()
951 			unregister_framebuffer(&ofb->fb);  in pxafb_overlay_init()
954 		ofb->registered = 1;  in pxafb_overlay_init()
971 		struct pxafb_layer *ofb = &fbi->overlay[i];  in pxafb_overlay_exit()  local
972 		if (ofb->registered) {  in pxafb_overlay_exit()
973 			if (ofb->video_mem)  in pxafb_overlay_exit()
974 				free_pages_exact(ofb->video_mem,  in pxafb_overlay_exit()
975 					ofb->video_mem_size);  in pxafb_overlay_exit()
976 			unregister_framebuffer(&ofb->fb);  in pxafb_overlay_exit()