Lines Matching +full:imx1 +full:- +full:clock
14 * linux-arm-kernel@lists.arm.linux.org.uk
31 #include <linux/dma-mapping.h>
44 #include <linux/platform_data/video-imxfb.h>
51 #define DRIVER_NAME "imx-fb"
123 /* Used fb-mode. Can be set on kernel command line, therefore file-static. */
180 .name = "imx1-fb",
183 .name = "imx21-fb",
193 .compatible = "fsl,imx1-fb",
196 .compatible = "fsl,imx21-fb",
206 return fbi->devtype == IMX1_FB; in is_imx1_fb()
255 chan >>= 16 - bf->length; in chan_to_field()
256 return chan << bf->offset; in chan_to_field()
262 struct imxfb_info *fbi = info->par; in imxfb_setpalettereg()
265 #define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16) in imxfb_setpalettereg()
266 if (regno < fbi->palette_size) { in imxfb_setpalettereg()
271 writel(val, fbi->regs + 0x800 + (regno << 2)); in imxfb_setpalettereg()
280 struct imxfb_info *fbi = info->par; in imxfb_setcolreg()
290 if (fbi->cmap_inverse) { in imxfb_setcolreg()
291 red = 0xffff - red; in imxfb_setcolreg()
292 green = 0xffff - green; in imxfb_setcolreg()
293 blue = 0xffff - blue; in imxfb_setcolreg()
300 if (info->var.grayscale) in imxfb_setcolreg()
304 switch (info->fix.visual) { in imxfb_setcolreg()
307 * 12 or 16-bit True Colour. We encode the RGB value in imxfb_setcolreg()
311 u32 *pal = info->pseudo_palette; in imxfb_setcolreg()
313 val = chan_to_field(red, &info->var.red); in imxfb_setcolreg()
314 val |= chan_to_field(green, &info->var.green); in imxfb_setcolreg()
315 val |= chan_to_field(blue, &info->var.blue); in imxfb_setcolreg()
337 return &fbi->mode[0]; in imxfb_find_mode()
339 for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) { in imxfb_find_mode()
340 if (!strcmp(m->mode.name, fb_mode)) in imxfb_find_mode()
354 struct imxfb_info *fbi = info->par; in imxfb_check_var()
361 if (var->xres < MIN_XRES) in imxfb_check_var()
362 var->xres = MIN_XRES; in imxfb_check_var()
363 if (var->yres < MIN_YRES) in imxfb_check_var()
364 var->yres = MIN_YRES; in imxfb_check_var()
368 return -EINVAL; in imxfb_check_var()
370 var->xres = imxfb_mode->mode.xres; in imxfb_check_var()
371 var->yres = imxfb_mode->mode.yres; in imxfb_check_var()
372 var->bits_per_pixel = imxfb_mode->bpp; in imxfb_check_var()
373 var->pixclock = imxfb_mode->mode.pixclock; in imxfb_check_var()
374 var->hsync_len = imxfb_mode->mode.hsync_len; in imxfb_check_var()
375 var->left_margin = imxfb_mode->mode.left_margin; in imxfb_check_var()
376 var->right_margin = imxfb_mode->mode.right_margin; in imxfb_check_var()
377 var->vsync_len = imxfb_mode->mode.vsync_len; in imxfb_check_var()
378 var->upper_margin = imxfb_mode->mode.upper_margin; in imxfb_check_var()
379 var->lower_margin = imxfb_mode->mode.lower_margin; in imxfb_check_var()
380 var->sync = imxfb_mode->mode.sync; in imxfb_check_var()
381 var->xres_virtual = max(var->xres_virtual, var->xres); in imxfb_check_var()
382 var->yres_virtual = max(var->yres_virtual, var->yres); in imxfb_check_var()
384 pr_debug("var->bits_per_pixel=%d\n", var->bits_per_pixel); in imxfb_check_var()
386 lcd_clk = clk_get_rate(fbi->clk_per); in imxfb_check_var()
388 tmp = var->pixclock * (unsigned long long)lcd_clk; in imxfb_check_var()
397 if (--pcr > 0x3F) { in imxfb_check_var()
399 printk(KERN_WARNING "Must limit pixel clock to %luHz\n", in imxfb_check_var()
403 switch (var->bits_per_pixel) { in imxfb_check_var()
415 if (imxfb_mode->pcr & PCR_TFT) in imxfb_check_var()
427 pcr |= imxfb_mode->pcr & ~(0x3f | (7 << 25)); in imxfb_check_var()
429 fbi->pcr = pcr; in imxfb_check_var()
431 * The LCDC AUS Mode Control Register does not exist on imx1. in imxfb_check_var()
433 if (!is_imx1_fb(fbi) && imxfb_mode->aus_mode) in imxfb_check_var()
434 fbi->lauscr = LAUSCR_AUS_MODE; in imxfb_check_var()
440 var->red = rgb->red; in imxfb_check_var()
441 var->green = rgb->green; in imxfb_check_var()
442 var->blue = rgb->blue; in imxfb_check_var()
443 var->transp = rgb->transp; in imxfb_check_var()
446 var->red.length, var->green.length, var->blue.length, in imxfb_check_var()
447 var->transp.length); in imxfb_check_var()
450 var->red.offset, var->green.offset, var->blue.offset, in imxfb_check_var()
451 var->transp.offset); in imxfb_check_var()
462 struct imxfb_info *fbi = info->par; in imxfb_set_par()
463 struct fb_var_screeninfo *var = &info->var; in imxfb_set_par()
465 if (var->bits_per_pixel == 16 || var->bits_per_pixel == 32) in imxfb_set_par()
466 info->fix.visual = FB_VISUAL_TRUECOLOR; in imxfb_set_par()
467 else if (!fbi->cmap_static) in imxfb_set_par()
468 info->fix.visual = FB_VISUAL_PSEUDOCOLOR; in imxfb_set_par()
475 info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR; in imxfb_set_par()
478 info->fix.line_length = var->xres_virtual * var->bits_per_pixel / 8; in imxfb_set_par()
479 fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16; in imxfb_set_par()
490 if (fbi->enabled) in imxfb_enable_controller()
495 writel(fbi->map_dma, fbi->regs + LCDC_SSA); in imxfb_enable_controller()
498 writel(0x00000000, fbi->regs + LCDC_POS); in imxfb_enable_controller()
501 writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1), in imxfb_enable_controller()
502 fbi->regs + LCDC_CPOS); in imxfb_enable_controller()
508 writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR); in imxfb_enable_controller()
510 ret = clk_prepare_enable(fbi->clk_ipg); in imxfb_enable_controller()
514 ret = clk_prepare_enable(fbi->clk_ahb); in imxfb_enable_controller()
518 ret = clk_prepare_enable(fbi->clk_per); in imxfb_enable_controller()
522 fbi->enabled = true; in imxfb_enable_controller()
526 clk_disable_unprepare(fbi->clk_ahb); in imxfb_enable_controller()
528 clk_disable_unprepare(fbi->clk_ipg); in imxfb_enable_controller()
530 writel(0, fbi->regs + LCDC_RMCR); in imxfb_enable_controller()
537 if (!fbi->enabled) in imxfb_disable_controller()
542 clk_disable_unprepare(fbi->clk_per); in imxfb_disable_controller()
543 clk_disable_unprepare(fbi->clk_ahb); in imxfb_disable_controller()
544 clk_disable_unprepare(fbi->clk_ipg); in imxfb_disable_controller()
545 fbi->enabled = false; in imxfb_disable_controller()
547 writel(0, fbi->regs + LCDC_RMCR); in imxfb_disable_controller()
552 struct imxfb_info *fbi = info->par; in imxfb_blank()
588 struct imxfb_info *fbi = info->par; in imxfb_activate_var()
592 var->xres, var->hsync_len, in imxfb_activate_var()
593 var->left_margin, var->right_margin); in imxfb_activate_var()
595 var->yres, var->vsync_len, in imxfb_activate_var()
596 var->upper_margin, var->lower_margin); in imxfb_activate_var()
599 if (var->xres < 16 || var->xres > 1024) in imxfb_activate_var()
601 info->fix.id, var->xres); in imxfb_activate_var()
602 if (var->hsync_len < 1 || var->hsync_len > 64) in imxfb_activate_var()
604 info->fix.id, var->hsync_len); in imxfb_activate_var()
605 if (var->left_margin > 255) in imxfb_activate_var()
607 info->fix.id, var->left_margin); in imxfb_activate_var()
608 if (var->right_margin > 255) in imxfb_activate_var()
610 info->fix.id, var->right_margin); in imxfb_activate_var()
611 if (var->yres < 1 || var->yres > ymax_mask) in imxfb_activate_var()
613 info->fix.id, var->yres); in imxfb_activate_var()
614 if (var->vsync_len > 100) in imxfb_activate_var()
616 info->fix.id, var->vsync_len); in imxfb_activate_var()
617 if (var->upper_margin > 63) in imxfb_activate_var()
619 info->fix.id, var->upper_margin); in imxfb_activate_var()
620 if (var->lower_margin > 255) in imxfb_activate_var()
622 info->fix.id, var->lower_margin); in imxfb_activate_var()
626 writel(VPW_VPW(var->xres * var->bits_per_pixel / 8 / 4), in imxfb_activate_var()
627 fbi->regs + LCDC_VPW); in imxfb_activate_var()
629 writel(HCR_H_WIDTH(var->hsync_len - 1) | in imxfb_activate_var()
630 HCR_H_WAIT_1(var->right_margin - 1) | in imxfb_activate_var()
631 HCR_H_WAIT_2(var->left_margin - 3), in imxfb_activate_var()
632 fbi->regs + LCDC_HCR); in imxfb_activate_var()
634 writel(VCR_V_WIDTH(var->vsync_len) | in imxfb_activate_var()
635 VCR_V_WAIT_1(var->lower_margin) | in imxfb_activate_var()
636 VCR_V_WAIT_2(var->upper_margin), in imxfb_activate_var()
637 fbi->regs + LCDC_VCR); in imxfb_activate_var()
639 writel(SIZE_XMAX(var->xres) | (var->yres & ymax_mask), in imxfb_activate_var()
640 fbi->regs + LCDC_SIZE); in imxfb_activate_var()
642 writel(fbi->pcr, fbi->regs + LCDC_PCR); in imxfb_activate_var()
643 if (fbi->pwmr) in imxfb_activate_var()
644 writel(fbi->pwmr, fbi->regs + LCDC_PWMR); in imxfb_activate_var()
645 writel(fbi->lscr1, fbi->regs + LCDC_LSCR1); in imxfb_activate_var()
648 if (fbi->dmacr) in imxfb_activate_var()
649 writel(fbi->dmacr, fbi->regs + LCDC_DMACR); in imxfb_activate_var()
651 if (fbi->lauscr) in imxfb_activate_var()
652 writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR); in imxfb_activate_var()
659 struct imx_fb_platform_data *pdata = dev_get_platdata(&pdev->dev); in imxfb_init_fbinfo()
660 struct fb_info *info = dev_get_drvdata(&pdev->dev); in imxfb_init_fbinfo()
661 struct imxfb_info *fbi = info->par; in imxfb_init_fbinfo()
666 info->pseudo_palette = kmalloc_array(16, sizeof(u32), GFP_KERNEL); in imxfb_init_fbinfo()
667 if (!info->pseudo_palette) in imxfb_init_fbinfo()
668 return -ENOMEM; in imxfb_init_fbinfo()
672 fbi->devtype = pdev->id_entry->driver_data; in imxfb_init_fbinfo()
674 strlcpy(info->fix.id, IMX_NAME, sizeof(info->fix.id)); in imxfb_init_fbinfo()
676 info->fix.type = FB_TYPE_PACKED_PIXELS; in imxfb_init_fbinfo()
677 info->fix.type_aux = 0; in imxfb_init_fbinfo()
678 info->fix.xpanstep = 0; in imxfb_init_fbinfo()
679 info->fix.ypanstep = 0; in imxfb_init_fbinfo()
680 info->fix.ywrapstep = 0; in imxfb_init_fbinfo()
681 info->fix.accel = FB_ACCEL_NONE; in imxfb_init_fbinfo()
683 info->var.nonstd = 0; in imxfb_init_fbinfo()
684 info->var.activate = FB_ACTIVATE_NOW; in imxfb_init_fbinfo()
685 info->var.height = -1; in imxfb_init_fbinfo()
686 info->var.width = -1; in imxfb_init_fbinfo()
687 info->var.accel_flags = 0; in imxfb_init_fbinfo()
688 info->var.vmode = FB_VMODE_NONINTERLACED; in imxfb_init_fbinfo()
690 info->fbops = &imxfb_ops; in imxfb_init_fbinfo()
691 info->flags = FBINFO_FLAG_DEFAULT | in imxfb_init_fbinfo()
694 fbi->lscr1 = pdata->lscr1; in imxfb_init_fbinfo()
695 fbi->dmacr = pdata->dmacr; in imxfb_init_fbinfo()
696 fbi->pwmr = pdata->pwmr; in imxfb_init_fbinfo()
698 np = pdev->dev.of_node; in imxfb_init_fbinfo()
699 info->var.grayscale = of_property_read_bool(np, in imxfb_init_fbinfo()
700 "cmap-greyscale"); in imxfb_init_fbinfo()
701 fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse"); in imxfb_init_fbinfo()
702 fbi->cmap_static = of_property_read_bool(np, "cmap-static"); in imxfb_init_fbinfo()
704 fbi->lscr1 = IMXFB_LSCR1_DEFAULT; in imxfb_init_fbinfo()
706 of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr); in imxfb_init_fbinfo()
708 of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1); in imxfb_init_fbinfo()
710 of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr); in imxfb_init_fbinfo()
720 struct fb_videomode *of_mode = &imxfb_mode->mode; in imxfb_of_read_mode()
724 ret = of_property_read_string(np, "model", &of_mode->name); in imxfb_of_read_mode()
726 of_mode->name = NULL; in imxfb_of_read_mode()
734 ret = of_property_read_u32(np, "bits-per-pixel", &bpp); in imxfb_of_read_mode()
739 return -EINVAL; in imxfb_of_read_mode()
744 return -EINVAL; in imxfb_of_read_mode()
747 imxfb_mode->bpp = bpp; in imxfb_of_read_mode()
748 imxfb_mode->pcr = pcr; in imxfb_of_read_mode()
751 * fsl,aus-mode is optional in imxfb_of_read_mode()
753 imxfb_mode->aus_mode = of_property_read_bool(np, "fsl,aus-mode"); in imxfb_of_read_mode()
760 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_check_fb()
762 if (!fi || fi->par == fbi) in imxfb_lcd_check_fb()
770 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_get_contrast()
772 return fbi->pwmr & 0xff; in imxfb_lcd_get_contrast()
777 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_set_contrast()
779 if (fbi->pwmr && fbi->enabled) { in imxfb_lcd_set_contrast()
785 fbi->pwmr &= ~0xff; in imxfb_lcd_set_contrast()
786 fbi->pwmr |= contrast; in imxfb_lcd_set_contrast()
788 writel(fbi->pwmr, fbi->regs + LCDC_PWMR); in imxfb_lcd_set_contrast()
796 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_get_power()
798 if (!IS_ERR(fbi->lcd_pwr) && in imxfb_lcd_get_power()
799 !regulator_is_enabled(fbi->lcd_pwr)) in imxfb_lcd_get_power()
809 if (enable == fbi->lcd_pwr_enabled) in imxfb_regulator_set()
813 ret = regulator_enable(fbi->lcd_pwr); in imxfb_regulator_set()
815 ret = regulator_disable(fbi->lcd_pwr); in imxfb_regulator_set()
818 fbi->lcd_pwr_enabled = enable; in imxfb_regulator_set()
825 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_set_power()
827 if (!IS_ERR(fbi->lcd_pwr)) in imxfb_lcd_set_power()
846 return -ENODEV; in imxfb_setup()
873 dev_info(&pdev->dev, "i.MX Framebuffer driver\n"); in imxfb_probe()
879 of_id = of_match_device(imxfb_of_dev_id, &pdev->dev); in imxfb_probe()
881 pdev->id_entry = of_id->data; in imxfb_probe()
885 return -ENODEV; in imxfb_probe()
887 pdata = dev_get_platdata(&pdev->dev); in imxfb_probe()
889 info = framebuffer_alloc(sizeof(struct imxfb_info), &pdev->dev); in imxfb_probe()
891 return -ENOMEM; in imxfb_probe()
893 fbi = info->par; in imxfb_probe()
903 fb_mode = pdata->mode[0].mode.name; in imxfb_probe()
905 fbi->mode = pdata->mode; in imxfb_probe()
906 fbi->num_modes = pdata->num_modes; in imxfb_probe()
911 display_np = of_parse_phandle(pdev->dev.of_node, "display", 0); in imxfb_probe()
913 dev_err(&pdev->dev, "No display defined in devicetree\n"); in imxfb_probe()
914 ret = -EINVAL; in imxfb_probe()
922 fbi->num_modes = 1; in imxfb_probe()
924 fbi->mode = devm_kzalloc(&pdev->dev, in imxfb_probe()
926 if (!fbi->mode) { in imxfb_probe()
927 ret = -ENOMEM; in imxfb_probe()
931 ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode); in imxfb_probe()
937 * be the same as m->bpp/8 */ in imxfb_probe()
938 m = &fbi->mode[0]; in imxfb_probe()
939 bytes_per_pixel = (m->bpp + 7) / 8; in imxfb_probe()
940 for (i = 0; i < fbi->num_modes; i++, m++) in imxfb_probe()
941 info->fix.smem_len = max_t(size_t, info->fix.smem_len, in imxfb_probe()
942 m->mode.xres * m->mode.yres * bytes_per_pixel); in imxfb_probe()
944 res = request_mem_region(res->start, resource_size(res), in imxfb_probe()
947 ret = -EBUSY; in imxfb_probe()
951 fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg"); in imxfb_probe()
952 if (IS_ERR(fbi->clk_ipg)) { in imxfb_probe()
953 ret = PTR_ERR(fbi->clk_ipg); in imxfb_probe()
964 * To avoid this issue, let's enable and disable LCDC IPG clock in imxfb_probe()
967 ret = clk_prepare_enable(fbi->clk_ipg); in imxfb_probe()
970 clk_disable_unprepare(fbi->clk_ipg); in imxfb_probe()
972 fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb"); in imxfb_probe()
973 if (IS_ERR(fbi->clk_ahb)) { in imxfb_probe()
974 ret = PTR_ERR(fbi->clk_ahb); in imxfb_probe()
978 fbi->clk_per = devm_clk_get(&pdev->dev, "per"); in imxfb_probe()
979 if (IS_ERR(fbi->clk_per)) { in imxfb_probe()
980 ret = PTR_ERR(fbi->clk_per); in imxfb_probe()
984 fbi->regs = ioremap(res->start, resource_size(res)); in imxfb_probe()
985 if (fbi->regs == NULL) { in imxfb_probe()
986 dev_err(&pdev->dev, "Cannot map frame buffer registers\n"); in imxfb_probe()
987 ret = -ENOMEM; in imxfb_probe()
991 fbi->map_size = PAGE_ALIGN(info->fix.smem_len); in imxfb_probe()
992 info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size, in imxfb_probe()
993 &fbi->map_dma, GFP_KERNEL); in imxfb_probe()
994 if (!info->screen_buffer) { in imxfb_probe()
995 dev_err(&pdev->dev, "Failed to allocate video RAM: %d\n", ret); in imxfb_probe()
996 ret = -ENOMEM; in imxfb_probe()
1000 info->fix.smem_start = fbi->map_dma; in imxfb_probe()
1002 if (pdata && pdata->init) { in imxfb_probe()
1003 ret = pdata->init(fbi->pdev); in imxfb_probe()
1009 INIT_LIST_HEAD(&info->modelist); in imxfb_probe()
1010 for (i = 0; i < fbi->num_modes; i++) in imxfb_probe()
1011 fb_add_videomode(&fbi->mode[i].mode, &info->modelist); in imxfb_probe()
1017 imxfb_check_var(&info->var, info); in imxfb_probe()
1023 ret = fb_alloc_cmap(&info->cmap, 256, 0); in imxfb_probe()
1030 dev_err(&pdev->dev, "failed to register framebuffer\n"); in imxfb_probe()
1034 fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd"); in imxfb_probe()
1035 if (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER) { in imxfb_probe()
1036 ret = -EPROBE_DEFER; in imxfb_probe()
1040 lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi, in imxfb_probe()
1047 lcd->props.max_contrast = 0xff; in imxfb_probe()
1050 fbi->pdev = pdev; in imxfb_probe()
1058 fb_dealloc_cmap(&info->cmap); in imxfb_probe()
1060 if (pdata && pdata->exit) in imxfb_probe()
1061 pdata->exit(fbi->pdev); in imxfb_probe()
1063 dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer, in imxfb_probe()
1064 fbi->map_dma); in imxfb_probe()
1066 iounmap(fbi->regs); in imxfb_probe()
1069 release_mem_region(res->start, resource_size(res)); in imxfb_probe()
1072 kfree(info->pseudo_palette); in imxfb_probe()
1082 struct imxfb_info *fbi = info->par; in imxfb_remove()
1090 fb_dealloc_cmap(&info->cmap); in imxfb_remove()
1091 pdata = dev_get_platdata(&pdev->dev); in imxfb_remove()
1092 if (pdata && pdata->exit) in imxfb_remove()
1093 pdata->exit(fbi->pdev); in imxfb_remove()
1094 dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer, in imxfb_remove()
1095 fbi->map_dma); in imxfb_remove()
1096 iounmap(fbi->regs); in imxfb_remove()
1097 release_mem_region(res->start, resource_size(res)); in imxfb_remove()
1098 kfree(info->pseudo_palette); in imxfb_remove()
1107 struct imxfb_info *fbi = info->par; in imxfb_suspend()
1117 struct imxfb_info *fbi = info->par; in imxfb_resume()