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()
597 	struct imxfb_info *fbi = info->par;  in imxfb_activate_var()  local
598 	u32 ymax_mask = is_imx1_fb(fbi) ? YMAX_MASK_IMX1 : YMAX_MASK_IMX21;  in imxfb_activate_var()
636 		fbi->regs + LCDC_VPW);  in imxfb_activate_var()
641 		fbi->regs + LCDC_HCR);  in imxfb_activate_var()
646 		fbi->regs + LCDC_VCR);  in imxfb_activate_var()
649 			fbi->regs + LCDC_SIZE);  in imxfb_activate_var()
651 	writel(fbi->pcr, fbi->regs + LCDC_PCR);  in imxfb_activate_var()
652 	if (fbi->pwmr)  in imxfb_activate_var()
653 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_activate_var()
654 	writel(fbi->lscr1, fbi->regs + LCDC_LSCR1);  in imxfb_activate_var()
657 	if (fbi->dmacr)  in imxfb_activate_var()
658 		writel(fbi->dmacr, fbi->regs + LCDC_DMACR);  in imxfb_activate_var()
660 	if (fbi->lauscr)  in imxfb_activate_var()
661 		writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR);  in imxfb_activate_var()
669 	struct imxfb_info *fbi = info->par;  in imxfb_init_fbinfo()  local
679 	memset(fbi, 0, sizeof(struct imxfb_info));  in imxfb_init_fbinfo()
681 	fbi->devtype = pdev->id_entry->driver_data;  in imxfb_init_fbinfo()
705 	fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse");  in imxfb_init_fbinfo()
706 	fbi->cmap_static = of_property_read_bool(np, "cmap-static");  in imxfb_init_fbinfo()
708 	fbi->lscr1 = IMXFB_LSCR1_DEFAULT;  in imxfb_init_fbinfo()
710 	of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr);  in imxfb_init_fbinfo()
712 	of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1);  in imxfb_init_fbinfo()
714 	of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr);  in imxfb_init_fbinfo()
763 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_check_fb()  local
765 	if (!fi || fi->par == fbi)  in imxfb_lcd_check_fb()
773 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_contrast()  local
775 	return fbi->pwmr & 0xff;  in imxfb_lcd_get_contrast()
780 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_contrast()  local
782 	if (fbi->pwmr && fbi->enabled) {  in imxfb_lcd_set_contrast()
788 		fbi->pwmr &= ~0xff;  in imxfb_lcd_set_contrast()
789 		fbi->pwmr |= contrast;  in imxfb_lcd_set_contrast()
791 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_lcd_set_contrast()
799 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_power()  local
801 	if (!IS_ERR(fbi->lcd_pwr) &&  in imxfb_lcd_get_power()
802 	    !regulator_is_enabled(fbi->lcd_pwr))  in imxfb_lcd_get_power()
808 static int imxfb_regulator_set(struct imxfb_info *fbi, int enable)  in imxfb_regulator_set()  argument
812 	if (enable == fbi->lcd_pwr_enabled)  in imxfb_regulator_set()
816 		ret = regulator_enable(fbi->lcd_pwr);  in imxfb_regulator_set()
818 		ret = regulator_disable(fbi->lcd_pwr);  in imxfb_regulator_set()
821 		fbi->lcd_pwr_enabled = enable;  in imxfb_regulator_set()
828 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_power()  local
830 	if (!IS_ERR(fbi->lcd_pwr))  in imxfb_lcd_set_power()
831 		return imxfb_regulator_set(fbi, power == FB_BLANK_UNBLANK);  in imxfb_lcd_set_power()
866 	struct imxfb_info *fbi;  in imxfb_probe()  local
889 	fbi = info->par;  in imxfb_probe()
910 	fbi->num_modes = 1;  in imxfb_probe()
912 	fbi->mode = devm_kzalloc(&pdev->dev,  in imxfb_probe()
914 	if (!fbi->mode) {  in imxfb_probe()
920 	ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode);  in imxfb_probe()
927 	m = &fbi->mode[0];  in imxfb_probe()
929 	for (i = 0; i < fbi->num_modes; i++, m++)  in imxfb_probe()
933 	fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg");  in imxfb_probe()
934 	if (IS_ERR(fbi->clk_ipg)) {  in imxfb_probe()
935 		ret = PTR_ERR(fbi->clk_ipg);  in imxfb_probe()
949 	ret = clk_prepare_enable(fbi->clk_ipg);  in imxfb_probe()
952 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_probe()
954 	fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb");  in imxfb_probe()
955 	if (IS_ERR(fbi->clk_ahb)) {  in imxfb_probe()
956 		ret = PTR_ERR(fbi->clk_ahb);  in imxfb_probe()
960 	fbi->clk_per = devm_clk_get(&pdev->dev, "per");  in imxfb_probe()
961 	if (IS_ERR(fbi->clk_per)) {  in imxfb_probe()
962 		ret = PTR_ERR(fbi->clk_per);  in imxfb_probe()
966 	fbi->regs = devm_platform_ioremap_resource(pdev, 0);  in imxfb_probe()
967 	if (IS_ERR(fbi->regs)) {  in imxfb_probe()
968 		ret = PTR_ERR(fbi->regs);  in imxfb_probe()
972 	fbi->map_size = PAGE_ALIGN(info->fix.smem_len);  in imxfb_probe()
973 	info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size,  in imxfb_probe()
974 					   &fbi->map_dma, GFP_KERNEL);  in imxfb_probe()
981 	info->fix.smem_start = fbi->map_dma;  in imxfb_probe()
984 	for (i = 0; i < fbi->num_modes; i++)  in imxfb_probe()
985 		fb_add_videomode(&fbi->mode[i].mode, &info->modelist);  in imxfb_probe()
1008 	fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd");  in imxfb_probe()
1009 	if (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER) {  in imxfb_probe()
1014 	lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi,  in imxfb_probe()
1023 	imxfb_enable_controller(fbi);  in imxfb_probe()
1024 	fbi->pdev = pdev;  in imxfb_probe()
1033 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_probe()
1034 		    fbi->map_dma);  in imxfb_probe()
1043 	struct imxfb_info *fbi = info->par;  in imxfb_remove()  local
1045 	imxfb_disable_controller(fbi);  in imxfb_remove()
1049 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_remove()
1050 		    fbi->map_dma);  in imxfb_remove()
1057 	struct imxfb_info *fbi = info->par;  in imxfb_suspend()  local
1059 	imxfb_disable_controller(fbi);  in imxfb_suspend()
1067 	struct imxfb_info *fbi = info->par;  in imxfb_resume()  local
1069 	imxfb_enable_controller(fbi);  in imxfb_resume()