|
|
@@ -23,10 +23,12 @@
|
|
|
|
|
|
#include <drm/drmP.h>
|
|
|
#include <drm/drm_crtc_helper.h>
|
|
|
+#include <drm/drm_fb_cma_helper.h>
|
|
|
#include <drm/drm_gem_cma_helper.h>
|
|
|
|
|
|
#include "fsl_dcu_drm_crtc.h"
|
|
|
#include "fsl_dcu_drm_drv.h"
|
|
|
+#include "fsl_tcon.h"
|
|
|
|
|
|
static bool fsl_dcu_drm_is_volatile_reg(struct device *dev, unsigned int reg)
|
|
|
{
|
|
|
@@ -62,46 +64,55 @@ static int fsl_dcu_drm_irq_init(struct drm_device *dev)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-static int fsl_dcu_load(struct drm_device *drm, unsigned long flags)
|
|
|
+static int fsl_dcu_load(struct drm_device *dev, unsigned long flags)
|
|
|
{
|
|
|
- struct device *dev = drm->dev;
|
|
|
- struct fsl_dcu_drm_device *fsl_dev = drm->dev_private;
|
|
|
+ struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
|
|
|
int ret;
|
|
|
|
|
|
ret = fsl_dcu_drm_modeset_init(fsl_dev);
|
|
|
if (ret < 0) {
|
|
|
- dev_err(dev, "failed to initialize mode setting\n");
|
|
|
+ dev_err(dev->dev, "failed to initialize mode setting\n");
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- ret = drm_vblank_init(drm, drm->mode_config.num_crtc);
|
|
|
+ ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
|
|
|
if (ret < 0) {
|
|
|
- dev_err(dev, "failed to initialize vblank\n");
|
|
|
+ dev_err(dev->dev, "failed to initialize vblank\n");
|
|
|
goto done;
|
|
|
}
|
|
|
- drm->vblank_disable_allowed = true;
|
|
|
+ dev->vblank_disable_allowed = true;
|
|
|
|
|
|
- ret = fsl_dcu_drm_irq_init(drm);
|
|
|
+ ret = fsl_dcu_drm_irq_init(dev);
|
|
|
if (ret < 0)
|
|
|
goto done;
|
|
|
- drm->irq_enabled = true;
|
|
|
+ dev->irq_enabled = true;
|
|
|
|
|
|
- fsl_dcu_fbdev_init(drm);
|
|
|
+ fsl_dcu_fbdev_init(dev);
|
|
|
|
|
|
return 0;
|
|
|
done:
|
|
|
- if (ret) {
|
|
|
- drm_mode_config_cleanup(drm);
|
|
|
- drm_vblank_cleanup(drm);
|
|
|
- drm_irq_uninstall(drm);
|
|
|
- drm->dev_private = NULL;
|
|
|
- }
|
|
|
+ drm_kms_helper_poll_fini(dev);
|
|
|
+
|
|
|
+ if (fsl_dev->fbdev)
|
|
|
+ drm_fbdev_cma_fini(fsl_dev->fbdev);
|
|
|
+
|
|
|
+ drm_mode_config_cleanup(dev);
|
|
|
+ drm_vblank_cleanup(dev);
|
|
|
+ drm_irq_uninstall(dev);
|
|
|
+ dev->dev_private = NULL;
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
static int fsl_dcu_unload(struct drm_device *dev)
|
|
|
{
|
|
|
+ struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
|
|
|
+
|
|
|
+ drm_kms_helper_poll_fini(dev);
|
|
|
+
|
|
|
+ if (fsl_dev->fbdev)
|
|
|
+ drm_fbdev_cma_fini(fsl_dev->fbdev);
|
|
|
+
|
|
|
drm_mode_config_cleanup(dev);
|
|
|
drm_vblank_cleanup(dev);
|
|
|
drm_irq_uninstall(dev);
|
|
|
@@ -157,6 +168,13 @@ static void fsl_dcu_drm_disable_vblank(struct drm_device *dev,
|
|
|
regmap_write(fsl_dev->regmap, DCU_INT_MASK, value);
|
|
|
}
|
|
|
|
|
|
+static void fsl_dcu_drm_lastclose(struct drm_device *dev)
|
|
|
+{
|
|
|
+ struct fsl_dcu_drm_device *fsl_dev = dev->dev_private;
|
|
|
+
|
|
|
+ drm_fbdev_cma_restore_mode(fsl_dev->fbdev);
|
|
|
+}
|
|
|
+
|
|
|
static const struct file_operations fsl_dcu_drm_fops = {
|
|
|
.owner = THIS_MODULE,
|
|
|
.open = drm_open,
|
|
|
@@ -174,6 +192,7 @@ static const struct file_operations fsl_dcu_drm_fops = {
|
|
|
static struct drm_driver fsl_dcu_drm_driver = {
|
|
|
.driver_features = DRIVER_HAVE_IRQ | DRIVER_GEM | DRIVER_MODESET
|
|
|
| DRIVER_PRIME | DRIVER_ATOMIC,
|
|
|
+ .lastclose = fsl_dcu_drm_lastclose,
|
|
|
.load = fsl_dcu_load,
|
|
|
.unload = fsl_dcu_unload,
|
|
|
.irq_handler = fsl_dcu_drm_irq,
|
|
|
@@ -197,9 +216,9 @@ static struct drm_driver fsl_dcu_drm_driver = {
|
|
|
.fops = &fsl_dcu_drm_fops,
|
|
|
.name = "fsl-dcu-drm",
|
|
|
.desc = "Freescale DCU DRM",
|
|
|
- .date = "20150213",
|
|
|
+ .date = "20160425",
|
|
|
.major = 1,
|
|
|
- .minor = 0,
|
|
|
+ .minor = 1,
|
|
|
};
|
|
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
|
@@ -283,6 +302,9 @@ static int fsl_dcu_drm_probe(struct platform_device *pdev)
|
|
|
struct resource *res;
|
|
|
void __iomem *base;
|
|
|
struct drm_driver *driver = &fsl_dcu_drm_driver;
|
|
|
+ struct clk *pix_clk_in;
|
|
|
+ char pix_clk_name[32];
|
|
|
+ const char *pix_clk_in_name;
|
|
|
const struct of_device_id *id;
|
|
|
int ret;
|
|
|
|
|
|
@@ -290,6 +312,11 @@ static int fsl_dcu_drm_probe(struct platform_device *pdev)
|
|
|
if (!fsl_dev)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
+ id = of_match_node(fsl_dcu_of_match, pdev->dev.of_node);
|
|
|
+ if (!id)
|
|
|
+ return -ENODEV;
|
|
|
+ fsl_dev->soc = id->data;
|
|
|
+
|
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
if (!res) {
|
|
|
dev_err(dev, "could not get memory IO resource\n");
|
|
|
@@ -308,39 +335,54 @@ static int fsl_dcu_drm_probe(struct platform_device *pdev)
|
|
|
return -ENXIO;
|
|
|
}
|
|
|
|
|
|
+ fsl_dev->regmap = devm_regmap_init_mmio(dev, base,
|
|
|
+ &fsl_dcu_regmap_config);
|
|
|
+ if (IS_ERR(fsl_dev->regmap)) {
|
|
|
+ dev_err(dev, "regmap init failed\n");
|
|
|
+ return PTR_ERR(fsl_dev->regmap);
|
|
|
+ }
|
|
|
+
|
|
|
fsl_dev->clk = devm_clk_get(dev, "dcu");
|
|
|
if (IS_ERR(fsl_dev->clk)) {
|
|
|
- ret = PTR_ERR(fsl_dev->clk);
|
|
|
dev_err(dev, "failed to get dcu clock\n");
|
|
|
- return ret;
|
|
|
- }
|
|
|
- ret = clk_prepare(fsl_dev->clk);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(dev, "failed to prepare dcu clk\n");
|
|
|
- return ret;
|
|
|
+ return PTR_ERR(fsl_dev->clk);
|
|
|
}
|
|
|
- ret = clk_enable(fsl_dev->clk);
|
|
|
+ ret = clk_prepare_enable(fsl_dev->clk);
|
|
|
if (ret < 0) {
|
|
|
dev_err(dev, "failed to enable dcu clk\n");
|
|
|
- clk_unprepare(fsl_dev->clk);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
- fsl_dev->regmap = devm_regmap_init_mmio(dev, base,
|
|
|
- &fsl_dcu_regmap_config);
|
|
|
- if (IS_ERR(fsl_dev->regmap)) {
|
|
|
- dev_err(dev, "regmap init failed\n");
|
|
|
- return PTR_ERR(fsl_dev->regmap);
|
|
|
+ pix_clk_in = devm_clk_get(dev, "pix");
|
|
|
+ if (IS_ERR(pix_clk_in)) {
|
|
|
+ /* legancy binding, use dcu clock as pixel clock input */
|
|
|
+ pix_clk_in = fsl_dev->clk;
|
|
|
}
|
|
|
|
|
|
- id = of_match_node(fsl_dcu_of_match, pdev->dev.of_node);
|
|
|
- if (!id)
|
|
|
- return -ENODEV;
|
|
|
- fsl_dev->soc = id->data;
|
|
|
+ pix_clk_in_name = __clk_get_name(pix_clk_in);
|
|
|
+ snprintf(pix_clk_name, sizeof(pix_clk_name), "%s_pix", pix_clk_in_name);
|
|
|
+ fsl_dev->pix_clk = clk_register_divider(dev, pix_clk_name,
|
|
|
+ pix_clk_in_name, 0, base + DCU_DIV_RATIO,
|
|
|
+ 0, 8, CLK_DIVIDER_ROUND_CLOSEST, NULL);
|
|
|
+ if (IS_ERR(fsl_dev->pix_clk)) {
|
|
|
+ dev_err(dev, "failed to register pix clk\n");
|
|
|
+ ret = PTR_ERR(fsl_dev->pix_clk);
|
|
|
+ goto disable_clk;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = clk_prepare_enable(fsl_dev->pix_clk);
|
|
|
+ if (ret < 0) {
|
|
|
+ dev_err(dev, "failed to enable pix clk\n");
|
|
|
+ goto unregister_pix_clk;
|
|
|
+ }
|
|
|
+
|
|
|
+ fsl_dev->tcon = fsl_tcon_init(dev);
|
|
|
|
|
|
drm = drm_dev_alloc(driver, dev);
|
|
|
- if (!drm)
|
|
|
- return -ENOMEM;
|
|
|
+ if (!drm) {
|
|
|
+ ret = -ENOMEM;
|
|
|
+ goto disable_pix_clk;
|
|
|
+ }
|
|
|
|
|
|
fsl_dev->dev = dev;
|
|
|
fsl_dev->drm = drm;
|
|
|
@@ -360,6 +402,12 @@ static int fsl_dcu_drm_probe(struct platform_device *pdev)
|
|
|
|
|
|
unref:
|
|
|
drm_dev_unref(drm);
|
|
|
+disable_pix_clk:
|
|
|
+ clk_disable_unprepare(fsl_dev->pix_clk);
|
|
|
+unregister_pix_clk:
|
|
|
+ clk_unregister(fsl_dev->pix_clk);
|
|
|
+disable_clk:
|
|
|
+ clk_disable_unprepare(fsl_dev->clk);
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
@@ -367,6 +415,9 @@ static int fsl_dcu_drm_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct fsl_dcu_drm_device *fsl_dev = platform_get_drvdata(pdev);
|
|
|
|
|
|
+ clk_disable_unprepare(fsl_dev->clk);
|
|
|
+ clk_disable_unprepare(fsl_dev->pix_clk);
|
|
|
+ clk_unregister(fsl_dev->pix_clk);
|
|
|
drm_put_dev(fsl_dev->drm);
|
|
|
|
|
|
return 0;
|