203 static inline int is_imx1_fb(struct imxfb_info *fbi)  in is_imx1_fb()  argument
205 	return fbi->devtype == IMX1_FB;  in is_imx1_fb()
261 	struct imxfb_info *fbi = info->par;  in imxfb_setpalettereg()  local
265 	if (regno < fbi->palette_size) {  in imxfb_setpalettereg()
270 		writel(val, fbi->regs + 0x800 + (regno << 2));  in imxfb_setpalettereg()
279 	struct imxfb_info *fbi = info->par;  in imxfb_setcolreg()  local
289 	if (fbi->cmap_inverse) {  in imxfb_setcolreg()
330 static const struct imx_fb_videomode *imxfb_find_mode(struct imxfb_info *fbi)  in imxfb_find_mode()  argument
336 		return &fbi->mode[0];  in imxfb_find_mode()
338 	for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) {  in imxfb_find_mode()
353 	struct imxfb_info *fbi = info->par;  in imxfb_check_var()  local
365 	imxfb_mode = imxfb_find_mode(fbi);  in imxfb_check_var()
385 	lcd_clk = clk_get_rate(fbi->clk_per);  in imxfb_check_var()
409 		if (is_imx1_fb(fbi))  in imxfb_check_var()
428 	fbi->pcr = pcr;  in imxfb_check_var()
432 	if (!is_imx1_fb(fbi) && imxfb_mode->aus_mode)  in imxfb_check_var()
433 		fbi->lauscr = LAUSCR_AUS_MODE;  in imxfb_check_var()
461 	struct imxfb_info *fbi = info->par;  in imxfb_set_par()  local
466 	else if (!fbi->cmap_static)  in imxfb_set_par()
478 	fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;  in imxfb_set_par()
485 static int imxfb_enable_controller(struct imxfb_info *fbi)  in imxfb_enable_controller()  argument
489 	if (fbi->enabled)  in imxfb_enable_controller()
494 	writel(fbi->map_dma, fbi->regs + LCDC_SSA);  in imxfb_enable_controller()
497 	writel(0x00000000, fbi->regs + LCDC_POS);  in imxfb_enable_controller()
500 	writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1),  in imxfb_enable_controller()
501 		fbi->regs + LCDC_CPOS);  in imxfb_enable_controller()
507 	writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR);  in imxfb_enable_controller()
509 	ret = clk_prepare_enable(fbi->clk_ipg);  in imxfb_enable_controller()
513 	ret = clk_prepare_enable(fbi->clk_ahb);  in imxfb_enable_controller()
517 	ret = clk_prepare_enable(fbi->clk_per);  in imxfb_enable_controller()
521 	fbi->enabled = true;  in imxfb_enable_controller()
525 	clk_disable_unprepare(fbi->clk_ahb);  in imxfb_enable_controller()
527 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_enable_controller()
529 	writel(0, fbi->regs + LCDC_RMCR);  in imxfb_enable_controller()
534 static void imxfb_disable_controller(struct imxfb_info *fbi)  in imxfb_disable_controller()  argument
536 	if (!fbi->enabled)  in imxfb_disable_controller()
541 	clk_disable_unprepare(fbi->clk_per);  in imxfb_disable_controller()
542 	clk_disable_unprepare(fbi->clk_ahb);  in imxfb_disable_controller()
543 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_disable_controller()
544 	fbi->enabled = false;  in imxfb_disable_controller()
546 	writel(0, fbi->regs + LCDC_RMCR);  in imxfb_disable_controller()
551 	struct imxfb_info *fbi = info->par;  in imxfb_blank()  local
560 		imxfb_disable_controller(fbi);  in imxfb_blank()
564 		return imxfb_enable_controller(fbi);  in imxfb_blank()
587 	struct imxfb_info *fbi = info->par;  in imxfb_activate_var()  local
588 	u32 ymax_mask = is_imx1_fb(fbi) ? YMAX_MASK_IMX1 : YMAX_MASK_IMX21;  in imxfb_activate_var()
626 		fbi->regs + LCDC_VPW);  in imxfb_activate_var()
631 		fbi->regs + LCDC_HCR);  in imxfb_activate_var()
636 		fbi->regs + LCDC_VCR);  in imxfb_activate_var()
639 			fbi->regs + LCDC_SIZE);  in imxfb_activate_var()
641 	writel(fbi->pcr, fbi->regs + LCDC_PCR);  in imxfb_activate_var()
642 	if (fbi->pwmr)  in imxfb_activate_var()
643 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_activate_var()
644 	writel(fbi->lscr1, fbi->regs + LCDC_LSCR1);  in imxfb_activate_var()
647 	if (fbi->dmacr)  in imxfb_activate_var()
648 		writel(fbi->dmacr, fbi->regs + LCDC_DMACR);  in imxfb_activate_var()
650 	if (fbi->lauscr)  in imxfb_activate_var()
651 		writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR);  in imxfb_activate_var()
660 	struct imxfb_info *fbi = info->par;  in imxfb_init_fbinfo()  local
669 	memset(fbi, 0, sizeof(struct imxfb_info));  in imxfb_init_fbinfo()
671 	fbi->devtype = pdev->id_entry->driver_data;  in imxfb_init_fbinfo()
693 		fbi->lscr1			= pdata->lscr1;  in imxfb_init_fbinfo()
694 		fbi->dmacr			= pdata->dmacr;  in imxfb_init_fbinfo()
695 		fbi->pwmr			= pdata->pwmr;  in imxfb_init_fbinfo()
700 		fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse");  in imxfb_init_fbinfo()
701 		fbi->cmap_static = of_property_read_bool(np, "cmap-static");  in imxfb_init_fbinfo()
703 		fbi->lscr1 = IMXFB_LSCR1_DEFAULT;  in imxfb_init_fbinfo()
705 		of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr);  in imxfb_init_fbinfo()
707 		of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1);  in imxfb_init_fbinfo()
709 		of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr);  in imxfb_init_fbinfo()
759 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_check_fb()  local
761 	if (!fi || fi->par == fbi)  in imxfb_lcd_check_fb()
769 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_contrast()  local
771 	return fbi->pwmr & 0xff;  in imxfb_lcd_get_contrast()
776 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_contrast()  local
778 	if (fbi->pwmr && fbi->enabled) {  in imxfb_lcd_set_contrast()
784 		fbi->pwmr &= ~0xff;  in imxfb_lcd_set_contrast()
785 		fbi->pwmr |= contrast;  in imxfb_lcd_set_contrast()
787 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_lcd_set_contrast()
795 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_power()  local
797 	if (!IS_ERR(fbi->lcd_pwr) &&  in imxfb_lcd_get_power()
798 	    !regulator_is_enabled(fbi->lcd_pwr))  in imxfb_lcd_get_power()
806 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_power()  local
808 	if (!IS_ERR(fbi->lcd_pwr)) {  in imxfb_lcd_set_power()
810 			return regulator_enable(fbi->lcd_pwr);  in imxfb_lcd_set_power()
812 			return regulator_disable(fbi->lcd_pwr);  in imxfb_lcd_set_power()
848 	struct imxfb_info *fbi;  in imxfb_probe()  local
878 	fbi = info->par;  in imxfb_probe()
890 		fbi->mode = pdata->mode;  in imxfb_probe()
891 		fbi->num_modes = pdata->num_modes;  in imxfb_probe()
907 		fbi->num_modes = 1;  in imxfb_probe()
909 		fbi->mode = devm_kzalloc(&pdev->dev,  in imxfb_probe()
911 		if (!fbi->mode) {  in imxfb_probe()
916 		ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode);  in imxfb_probe()
923 	m = &fbi->mode[0];  in imxfb_probe()
925 	for (i = 0; i < fbi->num_modes; i++, m++)  in imxfb_probe()
936 	fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg");  in imxfb_probe()
937 	if (IS_ERR(fbi->clk_ipg)) {  in imxfb_probe()
938 		ret = PTR_ERR(fbi->clk_ipg);  in imxfb_probe()
952 	ret = clk_prepare_enable(fbi->clk_ipg);  in imxfb_probe()
955 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_probe()
957 	fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb");  in imxfb_probe()
958 	if (IS_ERR(fbi->clk_ahb)) {  in imxfb_probe()
959 		ret = PTR_ERR(fbi->clk_ahb);  in imxfb_probe()
963 	fbi->clk_per = devm_clk_get(&pdev->dev, "per");  in imxfb_probe()
964 	if (IS_ERR(fbi->clk_per)) {  in imxfb_probe()
965 		ret = PTR_ERR(fbi->clk_per);  in imxfb_probe()
969 	fbi->regs = ioremap(res->start, resource_size(res));  in imxfb_probe()
970 	if (fbi->regs == NULL) {  in imxfb_probe()
976 	fbi->map_size = PAGE_ALIGN(info->fix.smem_len);  in imxfb_probe()
977 	info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size,  in imxfb_probe()
978 					   &fbi->map_dma, GFP_KERNEL);  in imxfb_probe()
985 	info->fix.smem_start = fbi->map_dma;  in imxfb_probe()
988 		ret = pdata->init(fbi->pdev);  in imxfb_probe()
995 	for (i = 0; i < fbi->num_modes; i++)  in imxfb_probe()
996 		fb_add_videomode(&fbi->mode[i].mode, &info->modelist);  in imxfb_probe()
1019 	fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd");  in imxfb_probe()
1020 	if (IS_ERR(fbi->lcd_pwr) && (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER)) {  in imxfb_probe()
1025 	lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi,  in imxfb_probe()
1034 	imxfb_enable_controller(fbi);  in imxfb_probe()
1035 	fbi->pdev = pdev;  in imxfb_probe()
1046 		pdata->exit(fbi->pdev);  in imxfb_probe()
1048 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_probe()
1049 		    fbi->map_dma);  in imxfb_probe()
1051 	iounmap(fbi->regs);  in imxfb_probe()
1067 	struct imxfb_info *fbi = info->par;  in imxfb_remove()  local
1072 	imxfb_disable_controller(fbi);  in imxfb_remove()
1078 		pdata->exit(fbi->pdev);  in imxfb_remove()
1079 	dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer,  in imxfb_remove()
1080 		    fbi->map_dma);  in imxfb_remove()
1081 	iounmap(fbi->regs);  in imxfb_remove()
1092 	struct imxfb_info *fbi = info->par;  in imxfb_suspend()  local
1094 	imxfb_disable_controller(fbi);  in imxfb_suspend()
1102 	struct imxfb_info *fbi = info->par;  in imxfb_resume()  local
1104 	imxfb_enable_controller(fbi);  in imxfb_resume()