215 static inline int is_imx1_fb(struct imxfb_info *fbi)  in is_imx1_fb()  argument
217 	return fbi->devtype == IMX1_FB;  in is_imx1_fb()
273 	struct imxfb_info *fbi = info->par;  in imxfb_setpalettereg()  local
277 	if (regno < fbi->palette_size) {  in imxfb_setpalettereg()
282 		writel(val, fbi->regs + 0x800 + (regno << 2));  in imxfb_setpalettereg()
291 	struct imxfb_info *fbi = info->par;  in imxfb_setcolreg()  local
301 	if (fbi->cmap_inverse) {  in imxfb_setcolreg()
342 static const struct imx_fb_videomode *imxfb_find_mode(struct imxfb_info *fbi)  in imxfb_find_mode()  argument
348 		return &fbi->mode[0];  in imxfb_find_mode()
350 	for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) {  in imxfb_find_mode()
365 	struct imxfb_info *fbi = info->par;  in imxfb_check_var()  local
377 	imxfb_mode = imxfb_find_mode(fbi);  in imxfb_check_var()
397 	lcd_clk = clk_get_rate(fbi->clk_per);  in imxfb_check_var()
421 		if (is_imx1_fb(fbi))  in imxfb_check_var()
440 	fbi->pcr = pcr;  in imxfb_check_var()
444 	if (!is_imx1_fb(fbi) && imxfb_mode->aus_mode)  in imxfb_check_var()
445 		fbi->lauscr = LAUSCR_AUS_MODE;  in imxfb_check_var()
473 	struct imxfb_info *fbi = info->par;  in imxfb_set_par()  local
478 	else if (!fbi->cmap_static)  in imxfb_set_par()
490 	fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;  in imxfb_set_par()
497 static int imxfb_enable_controller(struct imxfb_info *fbi)  in imxfb_enable_controller()  argument
501 	if (fbi->enabled)  in imxfb_enable_controller()
506 	writel(fbi->map_dma, fbi->regs + LCDC_SSA);  in imxfb_enable_controller()
509 	writel(0x00000000, fbi->regs + LCDC_POS);  in imxfb_enable_controller()
512 	writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1),  in imxfb_enable_controller()
513 		fbi->regs + LCDC_CPOS);  in imxfb_enable_controller()
519 	writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR);  in imxfb_enable_controller()
521 	ret = clk_prepare_enable(fbi->clk_ipg);  in imxfb_enable_controller()
525 	ret = clk_prepare_enable(fbi->clk_ahb);  in imxfb_enable_controller()
529 	ret = clk_prepare_enable(fbi->clk_per);  in imxfb_enable_controller()
533 	fbi->enabled = true;  in imxfb_enable_controller()
537 	clk_disable_unprepare(fbi->clk_ahb);  in imxfb_enable_controller()
539 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_enable_controller()
541 	writel(0, fbi->regs + LCDC_RMCR);  in imxfb_enable_controller()
546 static void imxfb_disable_controller(struct imxfb_info *fbi)  in imxfb_disable_controller()  argument
548 	if (!fbi->enabled)  in imxfb_disable_controller()
553 	clk_disable_unprepare(fbi->clk_per);  in imxfb_disable_controller()
554 	clk_disable_unprepare(fbi->clk_ahb);  in imxfb_disable_controller()
555 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_disable_controller()
556 	fbi->enabled = false;  in imxfb_disable_controller()
558 	writel(0, fbi->regs + LCDC_RMCR);  in imxfb_disable_controller()
563 	struct imxfb_info *fbi = info->par;  in imxfb_blank()  local
572 		imxfb_disable_controller(fbi);  in imxfb_blank()
576 		return imxfb_enable_controller(fbi);  in imxfb_blank()
599 	struct imxfb_info *fbi = info->par;  in imxfb_activate_var()  local
600 	u32 ymax_mask = is_imx1_fb(fbi) ? YMAX_MASK_IMX1 : YMAX_MASK_IMX21;  in imxfb_activate_var()
638 		fbi->regs + LCDC_VPW);  in imxfb_activate_var()
643 		fbi->regs + LCDC_HCR);  in imxfb_activate_var()
648 		fbi->regs + LCDC_VCR);  in imxfb_activate_var()
651 			fbi->regs + LCDC_SIZE);  in imxfb_activate_var()
653 	writel(fbi->pcr, fbi->regs + LCDC_PCR);  in imxfb_activate_var()
654 	if (fbi->pwmr)  in imxfb_activate_var()
655 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_activate_var()
656 	writel(fbi->lscr1, fbi->regs + LCDC_LSCR1);  in imxfb_activate_var()
659 	if (fbi->dmacr)  in imxfb_activate_var()
660 		writel(fbi->dmacr, fbi->regs + LCDC_DMACR);  in imxfb_activate_var()
662 	if (fbi->lauscr)  in imxfb_activate_var()
663 		writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR);  in imxfb_activate_var()
671 	struct imxfb_info *fbi = info->par;  in imxfb_init_fbinfo()  local
680 	memset(fbi, 0, sizeof(struct imxfb_info));  in imxfb_init_fbinfo()
682 	fbi->devtype = pdev->id_entry->driver_data;  in imxfb_init_fbinfo()
707 	fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse");  in imxfb_init_fbinfo()
708 	fbi->cmap_static = of_property_read_bool(np, "cmap-static");  in imxfb_init_fbinfo()
710 	fbi->lscr1 = IMXFB_LSCR1_DEFAULT;  in imxfb_init_fbinfo()
712 	of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr);  in imxfb_init_fbinfo()
714 	of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1);  in imxfb_init_fbinfo()
716 	of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr);  in imxfb_init_fbinfo()
765 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_check_fb()  local
767 	if (!fi || fi->par == fbi)  in imxfb_lcd_check_fb()
775 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_contrast()  local
777 	return fbi->pwmr & 0xff;  in imxfb_lcd_get_contrast()
782 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_contrast()  local
784 	if (fbi->pwmr && fbi->enabled) {  in imxfb_lcd_set_contrast()
790 		fbi->pwmr &= ~0xff;  in imxfb_lcd_set_contrast()
791 		fbi->pwmr |= contrast;  in imxfb_lcd_set_contrast()
793 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_lcd_set_contrast()
801 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_power()  local
803 	if (!IS_ERR(fbi->lcd_pwr) &&  in imxfb_lcd_get_power()
804 	    !regulator_is_enabled(fbi->lcd_pwr))  in imxfb_lcd_get_power()
810 static int imxfb_regulator_set(struct imxfb_info *fbi, int enable)  in imxfb_regulator_set()  argument
814 	if (enable == fbi->lcd_pwr_enabled)  in imxfb_regulator_set()
818 		ret = regulator_enable(fbi->lcd_pwr);  in imxfb_regulator_set()
820 		ret = regulator_disable(fbi->lcd_pwr);  in imxfb_regulator_set()
823 		fbi->lcd_pwr_enabled = enable;  in imxfb_regulator_set()
830 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_power()  local
832 	if (!IS_ERR(fbi->lcd_pwr))  in imxfb_lcd_set_power()
833 		return imxfb_regulator_set(fbi, power == FB_BLANK_UNBLANK);  in imxfb_lcd_set_power()
868 	struct imxfb_info *fbi;  in imxfb_probe()  local
896 	fbi = info->par;  in imxfb_probe()
917 	fbi->num_modes = 1;  in imxfb_probe()
919 	fbi->mode = devm_kzalloc(&pdev->dev,  in imxfb_probe()
921 	if (!fbi->mode) {  in imxfb_probe()
927 	ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode);  in imxfb_probe()
934 	m = &fbi->mode[0];  in imxfb_probe()
936 	for (i = 0; i < fbi->num_modes; i++, m++)  in imxfb_probe()
940 	fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg");  in imxfb_probe()
941 	if (IS_ERR(fbi->clk_ipg)) {  in imxfb_probe()
942 		ret = PTR_ERR(fbi->clk_ipg);  in imxfb_probe()
956 	ret = clk_prepare_enable(fbi->clk_ipg);  in imxfb_probe()
959 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_probe()
961 	fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb");  in imxfb_probe()
962 	if (IS_ERR(fbi->clk_ahb)) {  in imxfb_probe()
963 		ret = PTR_ERR(fbi->clk_ahb);  in imxfb_probe()
967 	fbi->clk_per = devm_clk_get(&pdev->dev, "per");  in imxfb_probe()
968 	if (IS_ERR(fbi->clk_per)) {  in imxfb_probe()
969 		ret = PTR_ERR(fbi->clk_per);  in imxfb_probe()
973 	fbi->regs = devm_ioremap_resource(&pdev->dev, res);  in imxfb_probe()
974 	if (IS_ERR(fbi->regs)) {  in imxfb_probe()
975 		ret = PTR_ERR(fbi->regs);  in imxfb_probe()
979 	fbi->map_size = PAGE_ALIGN(info->fix.smem_len);  in imxfb_probe()
980 	info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size,  in imxfb_probe()
981 					   &fbi->map_dma, GFP_KERNEL);  in imxfb_probe()
988 	info->fix.smem_start = fbi->map_dma;  in imxfb_probe()
991 	for (i = 0; i < fbi->num_modes; i++)  in imxfb_probe()
992 		fb_add_videomode(&fbi->mode[i].mode, &info->modelist);  in imxfb_probe()
1015 	fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd");  in imxfb_probe()
1016 	if (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER) {  in imxfb_probe()
1021 	lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi,  in imxfb_probe()
1030 	imxfb_enable_controller(fbi);  in imxfb_probe()
1031 	fbi->pdev = pdev;  in imxfb_probe()
1041 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_probe()
1042 		    fbi->map_dma);  in imxfb_probe()
1057 	struct imxfb_info *fbi = info->par;  in imxfb_remove()  local
1059 	imxfb_disable_controller(fbi);  in imxfb_remove()
1063 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_remove()
1064 		    fbi->map_dma);  in imxfb_remove()
1074 	struct imxfb_info *fbi = info->par;  in imxfb_suspend()  local
1076 	imxfb_disable_controller(fbi);  in imxfb_suspend()
1084 	struct imxfb_info *fbi = info->par;  in imxfb_resume()  local
1086 	imxfb_enable_controller(fbi);  in imxfb_resume()