199 static inline int is_imx1_fb(struct imxfb_info *fbi)  in is_imx1_fb()  argument
201 	return fbi->devtype == IMX1_FB;  in is_imx1_fb()
257 	struct imxfb_info *fbi = info->par;  in imxfb_setpalettereg()  local
261 	if (regno < fbi->palette_size) {  in imxfb_setpalettereg()
266 		writel(val, fbi->regs + 0x800 + (regno << 2));  in imxfb_setpalettereg()
275 	struct imxfb_info *fbi = info->par;  in imxfb_setcolreg()  local
285 	if (fbi->cmap_inverse) {  in imxfb_setcolreg()
326 static const struct imx_fb_videomode *imxfb_find_mode(struct imxfb_info *fbi)  in imxfb_find_mode()  argument
332 		return &fbi->mode[0];  in imxfb_find_mode()
334 	for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) {  in imxfb_find_mode()
349 	struct imxfb_info *fbi = info->par;  in imxfb_check_var()  local
361 	imxfb_mode = imxfb_find_mode(fbi);  in imxfb_check_var()
381 	lcd_clk = clk_get_rate(fbi->clk_per);  in imxfb_check_var()
405 		if (is_imx1_fb(fbi))  in imxfb_check_var()
424 	fbi->pcr = pcr;  in imxfb_check_var()
452 	struct imxfb_info *fbi = info->par;  in imxfb_set_par()  local
457 	else if (!fbi->cmap_static)  in imxfb_set_par()
469 	fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16;  in imxfb_set_par()
476 static void imxfb_enable_controller(struct imxfb_info *fbi)  in imxfb_enable_controller()  argument
479 	if (fbi->enabled)  in imxfb_enable_controller()
484 	writel(fbi->map_dma, fbi->regs + LCDC_SSA);  in imxfb_enable_controller()
487 	writel(0x00000000, fbi->regs + LCDC_POS);  in imxfb_enable_controller()
490 	writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1),  in imxfb_enable_controller()
491 		fbi->regs + LCDC_CPOS);  in imxfb_enable_controller()
497 	writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR);  in imxfb_enable_controller()
499 	clk_prepare_enable(fbi->clk_ipg);  in imxfb_enable_controller()
500 	clk_prepare_enable(fbi->clk_ahb);  in imxfb_enable_controller()
501 	clk_prepare_enable(fbi->clk_per);  in imxfb_enable_controller()
502 	fbi->enabled = true;  in imxfb_enable_controller()
505 static void imxfb_disable_controller(struct imxfb_info *fbi)  in imxfb_disable_controller()  argument
507 	if (!fbi->enabled)  in imxfb_disable_controller()
512 	clk_disable_unprepare(fbi->clk_per);  in imxfb_disable_controller()
513 	clk_disable_unprepare(fbi->clk_ipg);  in imxfb_disable_controller()
514 	clk_disable_unprepare(fbi->clk_ahb);  in imxfb_disable_controller()
515 	fbi->enabled = false;  in imxfb_disable_controller()
517 	writel(0, fbi->regs + LCDC_RMCR);  in imxfb_disable_controller()
522 	struct imxfb_info *fbi = info->par;  in imxfb_blank()  local
531 		imxfb_disable_controller(fbi);  in imxfb_blank()
535 		imxfb_enable_controller(fbi);  in imxfb_blank()
559 	struct imxfb_info *fbi = info->par;  in imxfb_activate_var()  local
560 	u32 ymax_mask = is_imx1_fb(fbi) ? YMAX_MASK_IMX1 : YMAX_MASK_IMX21;  in imxfb_activate_var()
598 		fbi->regs + LCDC_VPW);  in imxfb_activate_var()
603 		fbi->regs + LCDC_HCR);  in imxfb_activate_var()
608 		fbi->regs + LCDC_VCR);  in imxfb_activate_var()
611 			fbi->regs + LCDC_SIZE);  in imxfb_activate_var()
613 	writel(fbi->pcr, fbi->regs + LCDC_PCR);  in imxfb_activate_var()
614 	if (fbi->pwmr)  in imxfb_activate_var()
615 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_activate_var()
616 	writel(fbi->lscr1, fbi->regs + LCDC_LSCR1);  in imxfb_activate_var()
619 	if (fbi->dmacr)  in imxfb_activate_var()
620 		writel(fbi->dmacr, fbi->regs + LCDC_DMACR);  in imxfb_activate_var()
629 	struct imxfb_info *fbi = info->par;  in imxfb_init_fbinfo()  local
638 	memset(fbi, 0, sizeof(struct imxfb_info));  in imxfb_init_fbinfo()
640 	fbi->devtype = pdev->id_entry->driver_data;  in imxfb_init_fbinfo()
662 		fbi->lscr1			= pdata->lscr1;  in imxfb_init_fbinfo()
663 		fbi->dmacr			= pdata->dmacr;  in imxfb_init_fbinfo()
664 		fbi->pwmr			= pdata->pwmr;  in imxfb_init_fbinfo()
669 		fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse");  in imxfb_init_fbinfo()
670 		fbi->cmap_static = of_property_read_bool(np, "cmap-static");  in imxfb_init_fbinfo()
672 		fbi->lscr1 = IMXFB_LSCR1_DEFAULT;  in imxfb_init_fbinfo()
674 		of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr);  in imxfb_init_fbinfo()
676 		of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1);  in imxfb_init_fbinfo()
678 		of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr);  in imxfb_init_fbinfo()
723 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_check_fb()  local
725 	if (!fi || fi->par == fbi)  in imxfb_lcd_check_fb()
733 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_contrast()  local
735 	return fbi->pwmr & 0xff;  in imxfb_lcd_get_contrast()
740 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_contrast()  local
742 	if (fbi->pwmr && fbi->enabled) {  in imxfb_lcd_set_contrast()
748 		fbi->pwmr &= ~0xff;  in imxfb_lcd_set_contrast()
749 		fbi->pwmr |= contrast;  in imxfb_lcd_set_contrast()
751 		writel(fbi->pwmr, fbi->regs + LCDC_PWMR);  in imxfb_lcd_set_contrast()
759 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_get_power()  local
761 	if (!IS_ERR(fbi->lcd_pwr))  in imxfb_lcd_get_power()
762 		return regulator_is_enabled(fbi->lcd_pwr);  in imxfb_lcd_get_power()
769 	struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev);  in imxfb_lcd_set_power()  local
771 	if (!IS_ERR(fbi->lcd_pwr)) {  in imxfb_lcd_set_power()
773 			return regulator_enable(fbi->lcd_pwr);  in imxfb_lcd_set_power()
775 			return regulator_disable(fbi->lcd_pwr);  in imxfb_lcd_set_power()
811 	struct imxfb_info *fbi;  in imxfb_probe()  local
841 	fbi = info->par;  in imxfb_probe()
853 		fbi->mode = pdata->mode;  in imxfb_probe()
854 		fbi->num_modes = pdata->num_modes;  in imxfb_probe()
870 		fbi->num_modes = 1;  in imxfb_probe()
872 		fbi->mode = devm_kzalloc(&pdev->dev,  in imxfb_probe()
874 		if (!fbi->mode) {  in imxfb_probe()
879 		ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode);  in imxfb_probe()
886 	m = &fbi->mode[0];  in imxfb_probe()
888 	for (i = 0; i < fbi->num_modes; i++, m++)  in imxfb_probe()
899 	fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg");  in imxfb_probe()
900 	if (IS_ERR(fbi->clk_ipg)) {  in imxfb_probe()
901 		ret = PTR_ERR(fbi->clk_ipg);  in imxfb_probe()
905 	fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb");  in imxfb_probe()
906 	if (IS_ERR(fbi->clk_ahb)) {  in imxfb_probe()
907 		ret = PTR_ERR(fbi->clk_ahb);  in imxfb_probe()
911 	fbi->clk_per = devm_clk_get(&pdev->dev, "per");  in imxfb_probe()
912 	if (IS_ERR(fbi->clk_per)) {  in imxfb_probe()
913 		ret = PTR_ERR(fbi->clk_per);  in imxfb_probe()
917 	fbi->regs = ioremap(res->start, resource_size(res));  in imxfb_probe()
918 	if (fbi->regs == NULL) {  in imxfb_probe()
924 	fbi->map_size = PAGE_ALIGN(info->fix.smem_len);  in imxfb_probe()
925 	info->screen_base = dma_alloc_writecombine(&pdev->dev, fbi->map_size,  in imxfb_probe()
926 						   &fbi->map_dma, GFP_KERNEL);  in imxfb_probe()
934 	info->fix.smem_start = fbi->map_dma;  in imxfb_probe()
937 		ret = pdata->init(fbi->pdev);  in imxfb_probe()
944 	for (i = 0; i < fbi->num_modes; i++)  in imxfb_probe()
945 		fb_add_videomode(&fbi->mode[i].mode, &info->modelist);  in imxfb_probe()
964 	fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd");  in imxfb_probe()
965 	if (IS_ERR(fbi->lcd_pwr) && (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER)) {  in imxfb_probe()
970 	lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi,  in imxfb_probe()
979 	imxfb_enable_controller(fbi);  in imxfb_probe()
980 	fbi->pdev = pdev;  in imxfb_probe()
991 		pdata->exit(fbi->pdev);  in imxfb_probe()
993 	dma_free_writecombine(&pdev->dev, fbi->map_size, info->screen_base,  in imxfb_probe()
994 			      fbi->map_dma);  in imxfb_probe()
996 	iounmap(fbi->regs);  in imxfb_probe()
1012 	struct imxfb_info *fbi = info->par;  in imxfb_remove()  local
1017 	imxfb_disable_controller(fbi);  in imxfb_remove()
1023 		pdata->exit(fbi->pdev);  in imxfb_remove()
1029 	dma_free_writecombine(&pdev->dev, fbi->map_size, info->screen_base,  in imxfb_remove()
1030 			      fbi->map_dma);  in imxfb_remove()
1032 	iounmap(fbi->regs);  in imxfb_remove()
1041 	struct imxfb_info *fbi = info->par;  in imxfb_suspend()  local
1043 	imxfb_disable_controller(fbi);  in imxfb_suspend()
1051 	struct imxfb_info *fbi = info->par;  in imxfb_resume()  local
1053 	imxfb_enable_controller(fbi);  in imxfb_resume()