Lines Matching +full:imx1 +full:- +full:clock
14 * linux-arm-kernel@lists.arm.linux.org.uk
31 #include <linux/dma-mapping.h>
63 #define DRIVER_NAME "imx-fb"
135 /* Used fb-mode. Can be set on kernel command line, therefore file-static. */
199 .name = "imx1-fb",
202 .name = "imx21-fb",
212 .compatible = "fsl,imx1-fb",
215 .compatible = "fsl,imx21-fb",
225 return fbi->devtype == IMX1_FB; in is_imx1_fb()
274 chan >>= 16 - bf->length; in chan_to_field()
275 return chan << bf->offset; in chan_to_field()
281 struct imxfb_info *fbi = info->par; in imxfb_setpalettereg()
284 #define CNVT_TOHW(val,width) ((((val)<<(width))+0x7FFF-(val))>>16) in imxfb_setpalettereg()
285 if (regno < fbi->palette_size) { in imxfb_setpalettereg()
290 writel(val, fbi->regs + 0x800 + (regno << 2)); in imxfb_setpalettereg()
299 struct imxfb_info *fbi = info->par; in imxfb_setcolreg()
309 if (fbi->cmap_inverse) { in imxfb_setcolreg()
310 red = 0xffff - red; in imxfb_setcolreg()
311 green = 0xffff - green; in imxfb_setcolreg()
312 blue = 0xffff - blue; in imxfb_setcolreg()
319 if (info->var.grayscale) in imxfb_setcolreg()
323 switch (info->fix.visual) { in imxfb_setcolreg()
326 * 12 or 16-bit True Colour. We encode the RGB value in imxfb_setcolreg()
330 u32 *pal = info->pseudo_palette; in imxfb_setcolreg()
332 val = chan_to_field(red, &info->var.red); in imxfb_setcolreg()
333 val |= chan_to_field(green, &info->var.green); in imxfb_setcolreg()
334 val |= chan_to_field(blue, &info->var.blue); in imxfb_setcolreg()
356 return &fbi->mode[0]; in imxfb_find_mode()
358 for (i = 0, m = &fbi->mode[0]; i < fbi->num_modes; i++, m++) { in imxfb_find_mode()
359 if (!strcmp(m->mode.name, fb_mode)) in imxfb_find_mode()
373 struct imxfb_info *fbi = info->par; in imxfb_check_var()
380 if (var->xres < MIN_XRES) in imxfb_check_var()
381 var->xres = MIN_XRES; in imxfb_check_var()
382 if (var->yres < MIN_YRES) in imxfb_check_var()
383 var->yres = MIN_YRES; in imxfb_check_var()
387 return -EINVAL; in imxfb_check_var()
389 var->xres = imxfb_mode->mode.xres; in imxfb_check_var()
390 var->yres = imxfb_mode->mode.yres; in imxfb_check_var()
391 var->bits_per_pixel = imxfb_mode->bpp; in imxfb_check_var()
392 var->pixclock = imxfb_mode->mode.pixclock; in imxfb_check_var()
393 var->hsync_len = imxfb_mode->mode.hsync_len; in imxfb_check_var()
394 var->left_margin = imxfb_mode->mode.left_margin; in imxfb_check_var()
395 var->right_margin = imxfb_mode->mode.right_margin; in imxfb_check_var()
396 var->vsync_len = imxfb_mode->mode.vsync_len; in imxfb_check_var()
397 var->upper_margin = imxfb_mode->mode.upper_margin; in imxfb_check_var()
398 var->lower_margin = imxfb_mode->mode.lower_margin; in imxfb_check_var()
399 var->sync = imxfb_mode->mode.sync; in imxfb_check_var()
400 var->xres_virtual = max(var->xres_virtual, var->xres); in imxfb_check_var()
401 var->yres_virtual = max(var->yres_virtual, var->yres); in imxfb_check_var()
403 pr_debug("var->bits_per_pixel=%d\n", var->bits_per_pixel); in imxfb_check_var()
405 lcd_clk = clk_get_rate(fbi->clk_per); in imxfb_check_var()
407 tmp = var->pixclock * (unsigned long long)lcd_clk; in imxfb_check_var()
416 if (--pcr > 0x3F) { in imxfb_check_var()
418 printk(KERN_WARNING "Must limit pixel clock to %luHz\n", in imxfb_check_var()
422 switch (var->bits_per_pixel) { in imxfb_check_var()
434 if (imxfb_mode->pcr & PCR_TFT) in imxfb_check_var()
446 pcr |= imxfb_mode->pcr & ~(0x3f | (7 << 25)); in imxfb_check_var()
448 fbi->pcr = pcr; in imxfb_check_var()
450 * The LCDC AUS Mode Control Register does not exist on imx1. in imxfb_check_var()
452 if (!is_imx1_fb(fbi) && imxfb_mode->aus_mode) in imxfb_check_var()
453 fbi->lauscr = LAUSCR_AUS_MODE; in imxfb_check_var()
455 if (imxfb_mode->pcr & PCR_TFT) in imxfb_check_var()
456 fbi->panel_type = PANEL_TYPE_TFT; in imxfb_check_var()
457 else if (imxfb_mode->pcr & PCR_COLOR) in imxfb_check_var()
458 fbi->panel_type = PANEL_TYPE_CSTN; in imxfb_check_var()
460 fbi->panel_type = PANEL_TYPE_MONOCHROME; in imxfb_check_var()
466 var->red = rgb->red; in imxfb_check_var()
467 var->green = rgb->green; in imxfb_check_var()
468 var->blue = rgb->blue; in imxfb_check_var()
469 var->transp = rgb->transp; in imxfb_check_var()
472 var->red.length, var->green.length, var->blue.length, in imxfb_check_var()
473 var->transp.length); in imxfb_check_var()
476 var->red.offset, var->green.offset, var->blue.offset, in imxfb_check_var()
477 var->transp.offset); in imxfb_check_var()
488 struct imxfb_info *fbi = info->par; in imxfb_set_par()
489 struct fb_var_screeninfo *var = &info->var; in imxfb_set_par()
491 if (var->bits_per_pixel == 16 || var->bits_per_pixel == 32) in imxfb_set_par()
492 info->fix.visual = FB_VISUAL_TRUECOLOR; in imxfb_set_par()
493 else if (!fbi->cmap_static) in imxfb_set_par()
494 info->fix.visual = FB_VISUAL_PSEUDOCOLOR; in imxfb_set_par()
501 info->fix.visual = FB_VISUAL_STATIC_PSEUDOCOLOR; in imxfb_set_par()
504 info->fix.line_length = var->xres_virtual * var->bits_per_pixel / 8; in imxfb_set_par()
505 fbi->palette_size = var->bits_per_pixel == 8 ? 256 : 16; in imxfb_set_par()
516 if (fbi->enabled) in imxfb_enable_controller()
521 writel(fbi->map_dma, fbi->regs + LCDC_SSA); in imxfb_enable_controller()
524 writel(0x00000000, fbi->regs + LCDC_POS); in imxfb_enable_controller()
527 writel(readl(fbi->regs + LCDC_CPOS) & ~(CPOS_CC0 | CPOS_CC1), in imxfb_enable_controller()
528 fbi->regs + LCDC_CPOS); in imxfb_enable_controller()
534 writel(RMCR_LCDC_EN_MX1, fbi->regs + LCDC_RMCR); in imxfb_enable_controller()
536 ret = clk_prepare_enable(fbi->clk_ipg); in imxfb_enable_controller()
540 ret = clk_prepare_enable(fbi->clk_ahb); in imxfb_enable_controller()
544 ret = clk_prepare_enable(fbi->clk_per); in imxfb_enable_controller()
548 fbi->enabled = true; in imxfb_enable_controller()
552 clk_disable_unprepare(fbi->clk_ahb); in imxfb_enable_controller()
554 clk_disable_unprepare(fbi->clk_ipg); in imxfb_enable_controller()
556 writel(0, fbi->regs + LCDC_RMCR); in imxfb_enable_controller()
563 if (!fbi->enabled) in imxfb_disable_controller()
568 clk_disable_unprepare(fbi->clk_per); in imxfb_disable_controller()
569 clk_disable_unprepare(fbi->clk_ahb); in imxfb_disable_controller()
570 clk_disable_unprepare(fbi->clk_ipg); in imxfb_disable_controller()
571 fbi->enabled = false; in imxfb_disable_controller()
573 writel(0, fbi->regs + LCDC_RMCR); in imxfb_disable_controller()
578 struct imxfb_info *fbi = info->par; in imxfb_blank()
612 struct imxfb_info *fbi = info->par; in imxfb_activate_var()
617 var->xres, var->hsync_len, in imxfb_activate_var()
618 var->left_margin, var->right_margin); in imxfb_activate_var()
620 var->yres, var->vsync_len, in imxfb_activate_var()
621 var->upper_margin, var->lower_margin); in imxfb_activate_var()
623 if (fbi->panel_type == PANEL_TYPE_TFT) in imxfb_activate_var()
625 else if (fbi->panel_type == PANEL_TYPE_CSTN) in imxfb_activate_var()
631 if (var->xres < 16 || var->xres > 1024) in imxfb_activate_var()
633 info->fix.id, var->xres); in imxfb_activate_var()
634 if (var->hsync_len < 1 || var->hsync_len > 64) in imxfb_activate_var()
636 info->fix.id, var->hsync_len); in imxfb_activate_var()
637 if (var->left_margin < left_margin_low || var->left_margin > 255) in imxfb_activate_var()
639 info->fix.id, var->left_margin); in imxfb_activate_var()
640 if (var->right_margin < 1 || var->right_margin > 255) in imxfb_activate_var()
642 info->fix.id, var->right_margin); in imxfb_activate_var()
643 if (var->yres < 1 || var->yres > ymax_mask) in imxfb_activate_var()
645 info->fix.id, var->yres); in imxfb_activate_var()
646 if (var->vsync_len > 100) in imxfb_activate_var()
648 info->fix.id, var->vsync_len); in imxfb_activate_var()
649 if (var->upper_margin > 63) in imxfb_activate_var()
651 info->fix.id, var->upper_margin); in imxfb_activate_var()
652 if (var->lower_margin > 255) in imxfb_activate_var()
654 info->fix.id, var->lower_margin); in imxfb_activate_var()
658 writel(VPW_VPW(var->xres * var->bits_per_pixel / 8 / 4), in imxfb_activate_var()
659 fbi->regs + LCDC_VPW); in imxfb_activate_var()
661 writel(HCR_H_WIDTH(var->hsync_len - 1) | in imxfb_activate_var()
662 HCR_H_WAIT_1(var->right_margin - 1) | in imxfb_activate_var()
663 HCR_H_WAIT_2(var->left_margin - left_margin_low), in imxfb_activate_var()
664 fbi->regs + LCDC_HCR); in imxfb_activate_var()
666 writel(VCR_V_WIDTH(var->vsync_len) | in imxfb_activate_var()
667 VCR_V_WAIT_1(var->lower_margin) | in imxfb_activate_var()
668 VCR_V_WAIT_2(var->upper_margin), in imxfb_activate_var()
669 fbi->regs + LCDC_VCR); in imxfb_activate_var()
671 writel(SIZE_XMAX(var->xres) | (var->yres & ymax_mask), in imxfb_activate_var()
672 fbi->regs + LCDC_SIZE); in imxfb_activate_var()
674 writel(fbi->pcr, fbi->regs + LCDC_PCR); in imxfb_activate_var()
675 if (fbi->pwmr) in imxfb_activate_var()
676 writel(fbi->pwmr, fbi->regs + LCDC_PWMR); in imxfb_activate_var()
677 writel(fbi->lscr1, fbi->regs + LCDC_LSCR1); in imxfb_activate_var()
680 if (fbi->dmacr) in imxfb_activate_var()
681 writel(fbi->dmacr, fbi->regs + LCDC_DMACR); in imxfb_activate_var()
683 if (fbi->lauscr) in imxfb_activate_var()
684 writel(fbi->lauscr, fbi->regs + LCDC_LAUSCR); in imxfb_activate_var()
692 struct imxfb_info *fbi = info->par; in imxfb_init_fbinfo()
697 info->pseudo_palette = devm_kmalloc_array(&pdev->dev, 16, in imxfb_init_fbinfo()
699 if (!info->pseudo_palette) in imxfb_init_fbinfo()
700 return -ENOMEM; in imxfb_init_fbinfo()
704 fbi->devtype = pdev->id_entry->driver_data; in imxfb_init_fbinfo()
706 strscpy(info->fix.id, IMX_NAME, sizeof(info->fix.id)); in imxfb_init_fbinfo()
708 info->fix.type = FB_TYPE_PACKED_PIXELS; in imxfb_init_fbinfo()
709 info->fix.type_aux = 0; in imxfb_init_fbinfo()
710 info->fix.xpanstep = 0; in imxfb_init_fbinfo()
711 info->fix.ypanstep = 0; in imxfb_init_fbinfo()
712 info->fix.ywrapstep = 0; in imxfb_init_fbinfo()
713 info->fix.accel = FB_ACCEL_NONE; in imxfb_init_fbinfo()
715 info->var.nonstd = 0; in imxfb_init_fbinfo()
716 info->var.activate = FB_ACTIVATE_NOW; in imxfb_init_fbinfo()
717 info->var.height = -1; in imxfb_init_fbinfo()
718 info->var.width = -1; in imxfb_init_fbinfo()
719 info->var.accel_flags = 0; in imxfb_init_fbinfo()
720 info->var.vmode = FB_VMODE_NONINTERLACED; in imxfb_init_fbinfo()
722 info->fbops = &imxfb_ops; in imxfb_init_fbinfo()
723 info->flags = FBINFO_READS_FAST; in imxfb_init_fbinfo()
725 np = pdev->dev.of_node; in imxfb_init_fbinfo()
726 info->var.grayscale = of_property_read_bool(np, in imxfb_init_fbinfo()
727 "cmap-greyscale"); in imxfb_init_fbinfo()
728 fbi->cmap_inverse = of_property_read_bool(np, "cmap-inverse"); in imxfb_init_fbinfo()
729 fbi->cmap_static = of_property_read_bool(np, "cmap-static"); in imxfb_init_fbinfo()
731 fbi->lscr1 = IMXFB_LSCR1_DEFAULT; in imxfb_init_fbinfo()
733 of_property_read_u32(np, "fsl,lpccr", &fbi->pwmr); in imxfb_init_fbinfo()
735 of_property_read_u32(np, "fsl,lscr1", &fbi->lscr1); in imxfb_init_fbinfo()
737 of_property_read_u32(np, "fsl,dmacr", &fbi->dmacr); in imxfb_init_fbinfo()
746 struct fb_videomode *of_mode = &imxfb_mode->mode; in imxfb_of_read_mode()
750 ret = of_property_read_string(np, "model", &of_mode->name); in imxfb_of_read_mode()
752 of_mode->name = NULL; in imxfb_of_read_mode()
760 ret = of_property_read_u32(np, "bits-per-pixel", &bpp); in imxfb_of_read_mode()
765 return -EINVAL; in imxfb_of_read_mode()
770 return -EINVAL; in imxfb_of_read_mode()
773 imxfb_mode->bpp = bpp; in imxfb_of_read_mode()
774 imxfb_mode->pcr = pcr; in imxfb_of_read_mode()
777 * fsl,aus-mode is optional in imxfb_of_read_mode()
779 imxfb_mode->aus_mode = of_property_read_bool(np, "fsl,aus-mode"); in imxfb_of_read_mode()
786 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_check_fb()
788 if (!fi || fi->par == fbi) in imxfb_lcd_check_fb()
796 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_get_contrast()
798 return fbi->pwmr & 0xff; in imxfb_lcd_get_contrast()
803 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_set_contrast()
805 if (fbi->pwmr && fbi->enabled) { in imxfb_lcd_set_contrast()
811 fbi->pwmr &= ~0xff; in imxfb_lcd_set_contrast()
812 fbi->pwmr |= contrast; in imxfb_lcd_set_contrast()
814 writel(fbi->pwmr, fbi->regs + LCDC_PWMR); in imxfb_lcd_set_contrast()
822 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_get_power()
824 if (!IS_ERR(fbi->lcd_pwr) && in imxfb_lcd_get_power()
825 !regulator_is_enabled(fbi->lcd_pwr)) in imxfb_lcd_get_power()
835 if (enable == fbi->lcd_pwr_enabled) in imxfb_regulator_set()
839 ret = regulator_enable(fbi->lcd_pwr); in imxfb_regulator_set()
841 ret = regulator_disable(fbi->lcd_pwr); in imxfb_regulator_set()
844 fbi->lcd_pwr_enabled = enable; in imxfb_regulator_set()
851 struct imxfb_info *fbi = dev_get_drvdata(&lcddev->dev); in imxfb_lcd_set_power()
853 if (!IS_ERR(fbi->lcd_pwr)) in imxfb_lcd_set_power()
872 return -ENODEV; in imxfb_setup()
898 dev_info(&pdev->dev, "i.MX Framebuffer driver\n"); in imxfb_probe()
904 of_id = of_match_device(imxfb_of_dev_id, &pdev->dev); in imxfb_probe()
906 pdev->id_entry = of_id->data; in imxfb_probe()
908 info = framebuffer_alloc(sizeof(struct imxfb_info), &pdev->dev); in imxfb_probe()
910 return -ENOMEM; in imxfb_probe()
912 fbi = info->par; in imxfb_probe()
922 display_np = of_parse_phandle(pdev->dev.of_node, "display", 0); in imxfb_probe()
924 dev_err(&pdev->dev, "No display defined in devicetree\n"); in imxfb_probe()
925 ret = -EINVAL; in imxfb_probe()
933 fbi->num_modes = 1; in imxfb_probe()
935 fbi->mode = devm_kzalloc(&pdev->dev, in imxfb_probe()
937 if (!fbi->mode) { in imxfb_probe()
938 ret = -ENOMEM; in imxfb_probe()
943 ret = imxfb_of_read_mode(&pdev->dev, display_np, fbi->mode); in imxfb_probe()
949 * be the same as m->bpp/8 */ in imxfb_probe()
950 m = &fbi->mode[0]; in imxfb_probe()
951 bytes_per_pixel = (m->bpp + 7) / 8; in imxfb_probe()
952 for (i = 0; i < fbi->num_modes; i++, m++) in imxfb_probe()
953 info->fix.smem_len = max_t(size_t, info->fix.smem_len, in imxfb_probe()
954 m->mode.xres * m->mode.yres * bytes_per_pixel); in imxfb_probe()
956 fbi->clk_ipg = devm_clk_get(&pdev->dev, "ipg"); in imxfb_probe()
957 if (IS_ERR(fbi->clk_ipg)) { in imxfb_probe()
958 ret = PTR_ERR(fbi->clk_ipg); in imxfb_probe()
969 * To avoid this issue, let's enable and disable LCDC IPG clock in imxfb_probe()
972 ret = clk_prepare_enable(fbi->clk_ipg); in imxfb_probe()
975 clk_disable_unprepare(fbi->clk_ipg); in imxfb_probe()
977 fbi->clk_ahb = devm_clk_get(&pdev->dev, "ahb"); in imxfb_probe()
978 if (IS_ERR(fbi->clk_ahb)) { in imxfb_probe()
979 ret = PTR_ERR(fbi->clk_ahb); in imxfb_probe()
983 fbi->clk_per = devm_clk_get(&pdev->dev, "per"); in imxfb_probe()
984 if (IS_ERR(fbi->clk_per)) { in imxfb_probe()
985 ret = PTR_ERR(fbi->clk_per); in imxfb_probe()
989 fbi->regs = devm_platform_ioremap_resource(pdev, 0); in imxfb_probe()
990 if (IS_ERR(fbi->regs)) { in imxfb_probe()
991 ret = PTR_ERR(fbi->regs); in imxfb_probe()
995 fbi->map_size = PAGE_ALIGN(info->fix.smem_len); in imxfb_probe()
996 info->screen_buffer = dma_alloc_wc(&pdev->dev, fbi->map_size, in imxfb_probe()
997 &fbi->map_dma, GFP_KERNEL); in imxfb_probe()
998 if (!info->screen_buffer) { in imxfb_probe()
999 dev_err(&pdev->dev, "Failed to allocate video RAM\n"); in imxfb_probe()
1000 ret = -ENOMEM; in imxfb_probe()
1004 info->fix.smem_start = fbi->map_dma; in imxfb_probe()
1006 INIT_LIST_HEAD(&info->modelist); in imxfb_probe()
1007 for (i = 0; i < fbi->num_modes; i++) in imxfb_probe()
1008 fb_add_videomode(&fbi->mode[i].mode, &info->modelist); in imxfb_probe()
1014 imxfb_check_var(&info->var, info); in imxfb_probe()
1020 ret = fb_alloc_cmap(&info->cmap, 256, 0); in imxfb_probe()
1027 dev_err(&pdev->dev, "failed to register framebuffer\n"); in imxfb_probe()
1031 fbi->lcd_pwr = devm_regulator_get(&pdev->dev, "lcd"); in imxfb_probe()
1032 if (PTR_ERR(fbi->lcd_pwr) == -EPROBE_DEFER) { in imxfb_probe()
1033 ret = -EPROBE_DEFER; in imxfb_probe()
1037 lcd = devm_lcd_device_register(&pdev->dev, "imxfb-lcd", &pdev->dev, fbi, in imxfb_probe()
1044 lcd->props.max_contrast = 0xff; in imxfb_probe()
1047 fbi->pdev = pdev; in imxfb_probe()
1054 fb_dealloc_cmap(&info->cmap); in imxfb_probe()
1056 dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer, in imxfb_probe()
1057 fbi->map_dma); in imxfb_probe()
1066 struct imxfb_info *fbi = info->par; in imxfb_remove()
1071 fb_dealloc_cmap(&info->cmap); in imxfb_remove()
1072 dma_free_wc(&pdev->dev, fbi->map_size, info->screen_buffer, in imxfb_remove()
1073 fbi->map_dma); in imxfb_remove()
1080 struct imxfb_info *fbi = info->par; in imxfb_suspend()
1090 struct imxfb_info *fbi = info->par; in imxfb_resume()