static void arc_pgu_crtc_enable(struct drm_crtc *crtc) { struct arcpgu_drm_private *arcpgu = crtc_to_arcpgu_priv(crtc); clk_prepare_enable(arcpgu->clk); arc_pgu_write(arcpgu, ARCPGU_REG_CTRL, arc_pgu_read(arcpgu, ARCPGU_REG_CTRL) | ARCPGU_CTRL_ENABLE_MASK); }
static void arc_pgu_crtc_disable(struct drm_crtc *crtc) { struct arcpgu_drm_private *arcpgu = crtc_to_arcpgu_priv(crtc); if (!crtc->primary->fb) return; clk_disable_unprepare(arcpgu->clk); arc_pgu_write(arcpgu, ARCPGU_REG_CTRL, arc_pgu_read(arcpgu, ARCPGU_REG_CTRL) & ~ARCPGU_CTRL_ENABLE_MASK); }
static void arc_pgu_crtc_mode_set_nofb(struct drm_crtc *crtc) { struct arcpgu_drm_private *arcpgu = crtc_to_arcpgu_priv(crtc); struct drm_display_mode *m = &crtc->state->adjusted_mode; u32 val; arc_pgu_write(arcpgu, ARCPGU_REG_FMT, ENCODE_PGU_XY(m->crtc_htotal, m->crtc_vtotal)); arc_pgu_write(arcpgu, ARCPGU_REG_HSYNC, ENCODE_PGU_XY(m->crtc_hsync_start - m->crtc_hdisplay, m->crtc_hsync_end - m->crtc_hdisplay)); arc_pgu_write(arcpgu, ARCPGU_REG_VSYNC, ENCODE_PGU_XY(m->crtc_vsync_start - m->crtc_vdisplay, m->crtc_vsync_end - m->crtc_vdisplay)); arc_pgu_write(arcpgu, ARCPGU_REG_ACTIVE, ENCODE_PGU_XY(m->crtc_hblank_end - m->crtc_hblank_start, m->crtc_vblank_end - m->crtc_vblank_start)); val = arc_pgu_read(arcpgu, ARCPGU_REG_CTRL); if (m->flags & DRM_MODE_FLAG_PVSYNC) val |= ARCPGU_CTRL_VS_POL_MASK << ARCPGU_CTRL_VS_POL_OFST; else val &= ~(ARCPGU_CTRL_VS_POL_MASK << ARCPGU_CTRL_VS_POL_OFST); if (m->flags & DRM_MODE_FLAG_PHSYNC) val |= ARCPGU_CTRL_HS_POL_MASK << ARCPGU_CTRL_HS_POL_OFST; else val &= ~(ARCPGU_CTRL_HS_POL_MASK << ARCPGU_CTRL_HS_POL_OFST); arc_pgu_write(arcpgu, ARCPGU_REG_CTRL, val); arc_pgu_write(arcpgu, ARCPGU_REG_STRIDE, 0); arc_pgu_write(arcpgu, ARCPGU_REG_START_SET, 1); arc_pgu_set_pxl_fmt(crtc); clk_set_rate(arcpgu->clk, m->crtc_clock * 1000); }
static void arc_pgu_set_pxl_fmt(struct drm_crtc *crtc) { struct arcpgu_drm_private *arcpgu = crtc_to_arcpgu_priv(crtc); uint32_t pixel_format = crtc->primary->state->fb->pixel_format; struct simplefb_format *format = NULL; int i; for (i = 0; i < ARRAY_SIZE(supported_formats); i++) { if (supported_formats[i].fourcc == pixel_format) format = &supported_formats[i]; } if (WARN_ON(!format)) return; if (format->fourcc == DRM_FORMAT_RGB888) arc_pgu_write(arcpgu, ARCPGU_REG_CTRL, arc_pgu_read(arcpgu, ARCPGU_REG_CTRL) | ARCPGU_MODE_RGB888_MASK); }
static int arcpgu_load(struct drm_device *drm) { struct platform_device *pdev = to_platform_device(drm->dev); struct arcpgu_drm_private *arcpgu; struct device_node *encoder_node; struct resource *res; int ret; arcpgu = devm_kzalloc(&pdev->dev, sizeof(*arcpgu), GFP_KERNEL); if (arcpgu == NULL) return -ENOMEM; drm->dev_private = arcpgu; arcpgu->clk = devm_clk_get(drm->dev, "pxlclk"); if (IS_ERR(arcpgu->clk)) return PTR_ERR(arcpgu->clk); arcpgu_setup_mode_config(drm); res = platform_get_resource(pdev, IORESOURCE_MEM, 0); arcpgu->regs = devm_ioremap_resource(&pdev->dev, res); if (IS_ERR(arcpgu->regs)) return PTR_ERR(arcpgu->regs); dev_info(drm->dev, "arc_pgu ID: 0x%x\n", arc_pgu_read(arcpgu, ARCPGU_REG_ID)); /* Get the optional framebuffer memory resource */ ret = of_reserved_mem_device_init(drm->dev); if (ret && ret != -ENODEV) return ret; if (dma_set_mask_and_coherent(drm->dev, DMA_BIT_MASK(32))) return -ENODEV; if (arc_pgu_setup_crtc(drm) < 0) return -ENODEV; /* find the encoder node and initialize it */ encoder_node = of_parse_phandle(drm->dev->of_node, "encoder-slave", 0); if (encoder_node) { ret = arcpgu_drm_hdmi_init(drm, encoder_node); of_node_put(encoder_node); if (ret < 0) return ret; } else { ret = arcpgu_drm_sim_init(drm, NULL); if (ret < 0) return ret; } drm_mode_config_reset(drm); drm_kms_helper_poll_init(drm); arcpgu->fbdev = drm_fbdev_cma_init(drm, 16, drm->mode_config.num_crtc, drm->mode_config.num_connector); if (IS_ERR(arcpgu->fbdev)) { ret = PTR_ERR(arcpgu->fbdev); arcpgu->fbdev = NULL; return -ENODEV; } platform_set_drvdata(pdev, arcpgu); return 0; }