drm/tegra: Update Tegra DRM to align with v5.10

Update the Tegra DRM driver to Linux v5.10 with the 'Host1x/Tegra UAPI'
series [0] applied. This driver is built as an external module for
testing and development with upstream Linux kernels.

[0] https://patchwork.ozlabs.org/project/linux-tegra/list/?series=215770

Bug 3205478

Change-Id: I901aa45779e56cbbef6c58fd9d3bb50ea6bfd472
Signed-off-by: Jon Hunter <jonathanh@nvidia.com>
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nvidia/+/2460064
Reviewed-by: Shanker Donthineni <sdonthineni@nvidia.com>
Reviewed-by: Mikko Perttunen <mperttunen@nvidia.com>
Reviewed-by: mobile promotions <svcmobile_promotions@nvidia.com>
GVS: Gerrit_Virtual_Submit
Tested-by: mobile promotions <svcmobile_promotions@nvidia.com>
This commit is contained in:
Jon Hunter
2020-12-15 11:56:18 +00:00
committed by Laxman Dewangan
parent b8c2d943ed
commit d088bfa37d
8 changed files with 139 additions and 140 deletions

View File

@@ -86,7 +86,7 @@ static int tegra_drm_open(struct drm_device *drm, struct drm_file *filp)
if (!fpriv) if (!fpriv)
return -ENOMEM; return -ENOMEM;
idr_init(&fpriv->legacy_contexts); idr_init_base(&fpriv->legacy_contexts, 1);
xa_init_flags(&fpriv->contexts, XA_FLAGS_ALLOC1); xa_init_flags(&fpriv->contexts, XA_FLAGS_ALLOC1);
mutex_init(&fpriv->lock); mutex_init(&fpriv->lock);
filp->driver_priv = fpriv; filp->driver_priv = fpriv;

View File

@@ -12,6 +12,7 @@
#include <linux/gpio/consumer.h> #include <linux/gpio/consumer.h>
#include <drm/drm_atomic.h> #include <drm/drm_atomic.h>
#include <drm/drm_bridge.h>
#include <drm/drm_edid.h> #include <drm/drm_edid.h>
#include <drm/drm_encoder.h> #include <drm/drm_encoder.h>
#include <drm/drm_fb_helper.h> #include <drm/drm_fb_helper.h>
@@ -124,6 +125,7 @@ struct tegra_output {
struct device_node *of_node; struct device_node *of_node;
struct device *dev; struct device *dev;
struct drm_bridge *bridge;
struct drm_panel *panel; struct drm_panel *panel;
struct i2c_adapter *ddc; struct i2c_adapter *ddc;
const struct edid *edid; const struct edid *edid;

View File

@@ -690,11 +690,11 @@ static int tegra_dsi_pad_calibrate(struct tegra_dsi *dsi)
DSI_PAD_PREEMP_PD(0x03) | DSI_PAD_PREEMP_PU(0x3); DSI_PAD_PREEMP_PD(0x03) | DSI_PAD_PREEMP_PU(0x3);
tegra_dsi_writel(dsi, value, DSI_PAD_CONTROL_3); tegra_dsi_writel(dsi, value, DSI_PAD_CONTROL_3);
err = tegra_mipi_calibrate(dsi->mipi); err = tegra_mipi_start_calibration(dsi->mipi);
if (err < 0) if (err < 0)
return err; return err;
return tegra_mipi_wait(dsi->mipi); return tegra_mipi_finish_calibration(dsi->mipi);
} }
static void tegra_dsi_set_timeout(struct tegra_dsi *dsi, unsigned long bclk, static void tegra_dsi_set_timeout(struct tegra_dsi *dsi, unsigned long bclk,
@@ -1494,10 +1494,8 @@ static int tegra_dsi_host_attach(struct mipi_dsi_host *host,
if (IS_ERR(output->panel)) if (IS_ERR(output->panel))
output->panel = NULL; output->panel = NULL;
if (output->panel && output->connector.dev) { if (output->panel && output->connector.dev)
drm_panel_attach(output->panel, &output->connector);
drm_helper_hpd_irq_event(output->connector.dev); drm_helper_hpd_irq_event(output->connector.dev);
}
} }
return 0; return 0;

View File

@@ -12,6 +12,7 @@
#include <linux/dma-buf.h> #include <linux/dma-buf.h>
#include <linux/iommu.h> #include <linux/iommu.h>
#include <linux/version.h>
#include <drm/drm_drv.h> #include <drm/drm_drv.h>
#include <drm/drm_prime.h> #include <drm/drm_prime.h>
@@ -98,8 +99,8 @@ static struct sg_table *tegra_bo_pin(struct device *dev, struct host1x_bo *bo,
* the SG table needs to be copied to avoid overwriting any * the SG table needs to be copied to avoid overwriting any
* other potential users of the original SG table. * other potential users of the original SG table.
*/ */
err = sg_alloc_table_from_sg(sgt, obj->sgt->sgl, obj->sgt->nents, err = sg_alloc_table_from_sg(sgt, obj->sgt->sgl,
GFP_KERNEL); obj->sgt->orig_nents, GFP_KERNEL);
if (err < 0) if (err < 0)
goto free; goto free;
} else { } else {
@@ -196,8 +197,7 @@ static int tegra_bo_iommu_map(struct tegra_drm *tegra, struct tegra_bo *bo)
bo->iova = bo->mm->start; bo->iova = bo->mm->start;
bo->size = iommu_map_sg(tegra->domain, bo->iova, bo->sgt->sgl, bo->size = iommu_map_sgtable(tegra->domain, bo->iova, bo->sgt, prot);
bo->sgt->nents, prot);
if (!bo->size) { if (!bo->size) {
dev_err(tegra->drm->dev, "failed to map buffer\n"); dev_err(tegra->drm->dev, "failed to map buffer\n");
err = -ENOMEM; err = -ENOMEM;
@@ -264,8 +264,7 @@ free:
static void tegra_bo_free(struct drm_device *drm, struct tegra_bo *bo) static void tegra_bo_free(struct drm_device *drm, struct tegra_bo *bo)
{ {
if (bo->pages) { if (bo->pages) {
dma_unmap_sg(drm->dev, bo->sgt->sgl, bo->sgt->nents, dma_unmap_sgtable(drm->dev, bo->sgt, DMA_FROM_DEVICE, 0);
DMA_FROM_DEVICE);
drm_gem_put_pages(&bo->gem, bo->pages, true, true); drm_gem_put_pages(&bo->gem, bo->pages, true, true);
sg_free_table(bo->sgt); sg_free_table(bo->sgt);
kfree(bo->sgt); kfree(bo->sgt);
@@ -284,18 +283,19 @@ static int tegra_bo_get_pages(struct drm_device *drm, struct tegra_bo *bo)
bo->num_pages = bo->gem.size >> PAGE_SHIFT; bo->num_pages = bo->gem.size >> PAGE_SHIFT;
#if LINUX_VERSION_CODE >= KERNEL_VERSION(5, 10, 0)
bo->sgt = drm_prime_pages_to_sg(bo->gem.dev, bo->pages, bo->num_pages);
#else
bo->sgt = drm_prime_pages_to_sg(bo->pages, bo->num_pages); bo->sgt = drm_prime_pages_to_sg(bo->pages, bo->num_pages);
#endif
if (IS_ERR(bo->sgt)) { if (IS_ERR(bo->sgt)) {
err = PTR_ERR(bo->sgt); err = PTR_ERR(bo->sgt);
goto put_pages; goto put_pages;
} }
err = dma_map_sg(drm->dev, bo->sgt->sgl, bo->sgt->nents, err = dma_map_sgtable(drm->dev, bo->sgt, DMA_FROM_DEVICE, 0);
DMA_FROM_DEVICE); if (err)
if (err == 0) {
err = -EFAULT;
goto free_sgt; goto free_sgt;
}
return 0; return 0;
@@ -572,7 +572,7 @@ tegra_gem_prime_map_dma_buf(struct dma_buf_attachment *attach,
goto free; goto free;
} }
if (dma_map_sg(attach->dev, sgt->sgl, sgt->nents, dir) == 0) if (dma_map_sgtable(attach->dev, sgt, dir, 0))
goto free; goto free;
return sgt; return sgt;
@@ -591,7 +591,7 @@ static void tegra_gem_prime_unmap_dma_buf(struct dma_buf_attachment *attach,
struct tegra_bo *bo = to_tegra_bo(gem); struct tegra_bo *bo = to_tegra_bo(gem);
if (bo->pages) if (bo->pages)
dma_unmap_sg(attach->dev, sgt->sgl, sgt->nents, dir); dma_unmap_sgtable(attach->dev, sgt, dir, 0);
sg_free_table(sgt); sg_free_table(sgt);
kfree(sgt); kfree(sgt);
@@ -610,8 +610,7 @@ static int tegra_gem_prime_begin_cpu_access(struct dma_buf *buf,
struct drm_device *drm = gem->dev; struct drm_device *drm = gem->dev;
if (bo->pages) if (bo->pages)
dma_sync_sg_for_cpu(drm->dev, bo->sgt->sgl, bo->sgt->nents, dma_sync_sgtable_for_cpu(drm->dev, bo->sgt, DMA_FROM_DEVICE);
DMA_FROM_DEVICE);
return 0; return 0;
} }
@@ -624,8 +623,7 @@ static int tegra_gem_prime_end_cpu_access(struct dma_buf *buf,
struct drm_device *drm = gem->dev; struct drm_device *drm = gem->dev;
if (bo->pages) if (bo->pages)
dma_sync_sg_for_device(drm->dev, bo->sgt->sgl, bo->sgt->nents, dma_sync_sgtable_for_device(drm->dev, bo->sgt, DMA_TO_DEVICE);
DMA_TO_DEVICE);
return 0; return 0;
} }

View File

@@ -5,6 +5,7 @@
*/ */
#include <drm/drm_atomic_helper.h> #include <drm/drm_atomic_helper.h>
#include <drm/drm_of.h>
#include <drm/drm_panel.h> #include <drm/drm_panel.h>
#include <drm/drm_simple_kms_helper.h> #include <drm/drm_simple_kms_helper.h>
@@ -99,27 +100,37 @@ int tegra_output_probe(struct tegra_output *output)
if (!output->of_node) if (!output->of_node)
output->of_node = output->dev->of_node; output->of_node = output->dev->of_node;
err = drm_of_find_panel_or_bridge(output->of_node, -1, -1,
&output->panel, &output->bridge);
if (err && err != -ENODEV)
return err;
panel = of_parse_phandle(output->of_node, "nvidia,panel", 0); panel = of_parse_phandle(output->of_node, "nvidia,panel", 0);
if (panel) { if (panel) {
/*
* Don't mix nvidia,panel phandle with the graph in a
* device-tree.
*/
WARN_ON(output->panel || output->bridge);
output->panel = of_drm_find_panel(panel); output->panel = of_drm_find_panel(panel);
of_node_put(panel);
if (IS_ERR(output->panel)) if (IS_ERR(output->panel))
return PTR_ERR(output->panel); return PTR_ERR(output->panel);
of_node_put(panel);
} }
output->edid = of_get_property(output->of_node, "nvidia,edid", &size); output->edid = of_get_property(output->of_node, "nvidia,edid", &size);
ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0); ddc = of_parse_phandle(output->of_node, "nvidia,ddc-i2c-bus", 0);
if (ddc) { if (ddc) {
output->ddc = of_find_i2c_adapter_by_node(ddc); output->ddc = of_get_i2c_adapter_by_node(ddc);
of_node_put(ddc);
if (!output->ddc) { if (!output->ddc) {
err = -EPROBE_DEFER; err = -EPROBE_DEFER;
of_node_put(ddc);
return err; return err;
} }
of_node_put(ddc);
} }
output->hpd_gpio = devm_gpiod_get_from_of_node(output->dev, output->hpd_gpio = devm_gpiod_get_from_of_node(output->dev,
@@ -173,19 +184,12 @@ void tegra_output_remove(struct tegra_output *output)
free_irq(output->hpd_irq, output); free_irq(output->hpd_irq, output);
if (output->ddc) if (output->ddc)
put_device(&output->ddc->dev); i2c_put_adapter(output->ddc);
} }
int tegra_output_init(struct drm_device *drm, struct tegra_output *output) int tegra_output_init(struct drm_device *drm, struct tegra_output *output)
{ {
int connector_type; int connector_type;
int err;
if (output->panel) {
err = drm_panel_attach(output->panel, &output->connector);
if (err < 0)
return err;
}
/* /*
* The connector is now registered and ready to receive hotplug events * The connector is now registered and ready to receive hotplug events
@@ -220,9 +224,6 @@ void tegra_output_exit(struct tegra_output *output)
*/ */
if (output->hpd_gpio) if (output->hpd_gpio)
disable_irq(output->hpd_irq); disable_irq(output->hpd_irq);
if (output->panel)
drm_panel_detach(output->panel);
} }
void tegra_output_find_possible_crtcs(struct tegra_output *output, void tegra_output_find_possible_crtcs(struct tegra_output *output,

View File

@@ -131,12 +131,9 @@ static int tegra_dc_pin(struct tegra_dc *dc, struct tegra_plane_state *state)
} }
if (sgt) { if (sgt) {
err = dma_map_sg(dc->dev, sgt->sgl, sgt->nents, err = dma_map_sgtable(dc->dev, sgt, DMA_TO_DEVICE, 0);
DMA_TO_DEVICE); if (err)
if (err == 0) {
err = -ENOMEM;
goto unpin; goto unpin;
}
/* /*
* The display controller needs contiguous memory, so * The display controller needs contiguous memory, so
@@ -144,7 +141,7 @@ static int tegra_dc_pin(struct tegra_dc *dc, struct tegra_plane_state *state)
* map its SG table to a single contiguous chunk of * map its SG table to a single contiguous chunk of
* I/O virtual memory. * I/O virtual memory.
*/ */
if (err > 1) { if (sgt->nents > 1) {
err = -EINVAL; err = -EINVAL;
goto unpin; goto unpin;
} }
@@ -166,8 +163,7 @@ unpin:
struct sg_table *sgt = state->sgt[i]; struct sg_table *sgt = state->sgt[i];
if (sgt) if (sgt)
dma_unmap_sg(dc->dev, sgt->sgl, sgt->nents, dma_unmap_sgtable(dc->dev, sgt, DMA_TO_DEVICE, 0);
DMA_TO_DEVICE);
host1x_bo_unpin(dc->dev, &bo->base, sgt); host1x_bo_unpin(dc->dev, &bo->base, sgt);
state->iova[i] = DMA_MAPPING_ERROR; state->iova[i] = DMA_MAPPING_ERROR;
@@ -186,8 +182,7 @@ static void tegra_dc_unpin(struct tegra_dc *dc, struct tegra_plane_state *state)
struct sg_table *sgt = state->sgt[i]; struct sg_table *sgt = state->sgt[i];
if (sgt) if (sgt)
dma_unmap_sg(dc->dev, sgt->sgl, sgt->nents, dma_unmap_sgtable(dc->dev, sgt, DMA_TO_DEVICE, 0);
DMA_TO_DEVICE);
host1x_bo_unpin(dc->dev, &bo->base, sgt); host1x_bo_unpin(dc->dev, &bo->base, sgt);
state->iova[i] = DMA_MAPPING_ERROR; state->iova[i] = DMA_MAPPING_ERROR;

View File

@@ -7,7 +7,7 @@
#include <linux/clk.h> #include <linux/clk.h>
#include <drm/drm_atomic_helper.h> #include <drm/drm_atomic_helper.h>
#include <drm/drm_panel.h> #include <drm/drm_bridge_connector.h>
#include <drm/drm_simple_kms_helper.h> #include <drm/drm_simple_kms_helper.h>
#include "drm.h" #include "drm.h"
@@ -85,45 +85,13 @@ static void tegra_dc_write_regs(struct tegra_dc *dc,
tegra_dc_writel(dc, table[i].value, table[i].offset); tegra_dc_writel(dc, table[i].value, table[i].offset);
} }
static const struct drm_connector_funcs tegra_rgb_connector_funcs = {
.reset = drm_atomic_helper_connector_reset,
.detect = tegra_output_connector_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = tegra_output_connector_destroy,
.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
};
static enum drm_mode_status
tegra_rgb_connector_mode_valid(struct drm_connector *connector,
struct drm_display_mode *mode)
{
/*
* FIXME: For now, always assume that the mode is okay. There are
* unresolved issues with clk_round_rate(), which doesn't always
* reliably report whether a frequency can be set or not.
*/
return MODE_OK;
}
static const struct drm_connector_helper_funcs tegra_rgb_connector_helper_funcs = {
.get_modes = tegra_output_connector_get_modes,
.mode_valid = tegra_rgb_connector_mode_valid,
};
static void tegra_rgb_encoder_disable(struct drm_encoder *encoder) static void tegra_rgb_encoder_disable(struct drm_encoder *encoder)
{ {
struct tegra_output *output = encoder_to_output(encoder); struct tegra_output *output = encoder_to_output(encoder);
struct tegra_rgb *rgb = to_rgb(output); struct tegra_rgb *rgb = to_rgb(output);
if (output->panel)
drm_panel_disable(output->panel);
tegra_dc_write_regs(rgb->dc, rgb_disable, ARRAY_SIZE(rgb_disable)); tegra_dc_write_regs(rgb->dc, rgb_disable, ARRAY_SIZE(rgb_disable));
tegra_dc_commit(rgb->dc); tegra_dc_commit(rgb->dc);
if (output->panel)
drm_panel_unprepare(output->panel);
} }
static void tegra_rgb_encoder_enable(struct drm_encoder *encoder) static void tegra_rgb_encoder_enable(struct drm_encoder *encoder)
@@ -132,9 +100,6 @@ static void tegra_rgb_encoder_enable(struct drm_encoder *encoder)
struct tegra_rgb *rgb = to_rgb(output); struct tegra_rgb *rgb = to_rgb(output);
u32 value; u32 value;
if (output->panel)
drm_panel_prepare(output->panel);
tegra_dc_write_regs(rgb->dc, rgb_enable, ARRAY_SIZE(rgb_enable)); tegra_dc_write_regs(rgb->dc, rgb_enable, ARRAY_SIZE(rgb_enable));
value = DE_SELECT_ACTIVE | DE_CONTROL_NORMAL; value = DE_SELECT_ACTIVE | DE_CONTROL_NORMAL;
@@ -156,9 +121,6 @@ static void tegra_rgb_encoder_enable(struct drm_encoder *encoder)
tegra_dc_writel(rgb->dc, value, DC_DISP_SHIFT_CLOCK_OPTIONS); tegra_dc_writel(rgb->dc, value, DC_DISP_SHIFT_CLOCK_OPTIONS);
tegra_dc_commit(rgb->dc); tegra_dc_commit(rgb->dc);
if (output->panel)
drm_panel_enable(output->panel);
} }
static int static int
@@ -267,24 +229,68 @@ int tegra_dc_rgb_remove(struct tegra_dc *dc)
int tegra_dc_rgb_init(struct drm_device *drm, struct tegra_dc *dc) int tegra_dc_rgb_init(struct drm_device *drm, struct tegra_dc *dc)
{ {
struct tegra_output *output = dc->rgb; struct tegra_output *output = dc->rgb;
struct drm_connector *connector;
int err; int err;
if (!dc->rgb) if (!dc->rgb)
return -ENODEV; return -ENODEV;
drm_connector_init(drm, &output->connector, &tegra_rgb_connector_funcs,
DRM_MODE_CONNECTOR_LVDS);
drm_connector_helper_add(&output->connector,
&tegra_rgb_connector_helper_funcs);
output->connector.dpms = DRM_MODE_DPMS_OFF;
drm_simple_encoder_init(drm, &output->encoder, DRM_MODE_ENCODER_LVDS); drm_simple_encoder_init(drm, &output->encoder, DRM_MODE_ENCODER_LVDS);
drm_encoder_helper_add(&output->encoder, drm_encoder_helper_add(&output->encoder,
&tegra_rgb_encoder_helper_funcs); &tegra_rgb_encoder_helper_funcs);
drm_connector_attach_encoder(&output->connector, /*
&output->encoder); * Wrap directly-connected panel into DRM bridge in order to let
drm_connector_register(&output->connector); * DRM core to handle panel for us.
*/
if (output->panel) {
output->bridge = devm_drm_panel_bridge_add(output->dev,
output->panel);
if (IS_ERR(output->bridge)) {
dev_err(output->dev,
"failed to wrap panel into bridge: %pe\n",
output->bridge);
return PTR_ERR(output->bridge);
}
output->panel = NULL;
}
/*
* Tegra devices that have LVDS panel utilize LVDS encoder bridge
* for converting up to 28 LCD LVTTL lanes into 5/4 LVDS lanes that
* go to display panel's receiver.
*
* Encoder usually have a power-down control which needs to be enabled
* in order to transmit data to the panel. Historically devices that
* use an older device-tree version didn't model the bridge, assuming
* that encoder is turned ON by default, while today's DRM allows us
* to model LVDS encoder properly.
*
* Newer device-trees utilize LVDS encoder bridge, which provides
* us with a connector and handles the display panel.
*
* For older device-trees we wrapped panel into the panel-bridge.
*/
if (output->bridge) {
err = drm_bridge_attach(&output->encoder, output->bridge,
NULL, DRM_BRIDGE_ATTACH_NO_CONNECTOR);
if (err) {
dev_err(output->dev, "failed to attach bridge: %d\n",
err);
return err;
}
connector = drm_bridge_connector_init(drm, &output->encoder);
if (IS_ERR(connector)) {
dev_err(output->dev,
"failed to initialize bridge connector: %pe\n",
connector);
return PTR_ERR(connector);
}
drm_connector_attach_encoder(connector, &output->encoder);
}
err = tegra_output_init(drm, output); err = tegra_output_init(drm, output);
if (err < 0) { if (err < 0) {

View File

@@ -396,7 +396,6 @@ struct tegra_sor;
struct tegra_sor_ops { struct tegra_sor_ops {
const char *name; const char *name;
int (*probe)(struct tegra_sor *sor); int (*probe)(struct tegra_sor *sor);
int (*remove)(struct tegra_sor *sor);
void (*audio_enable)(struct tegra_sor *sor); void (*audio_enable)(struct tegra_sor *sor);
void (*audio_disable)(struct tegra_sor *sor); void (*audio_disable)(struct tegra_sor *sor);
}; };
@@ -2938,6 +2937,24 @@ static const struct drm_encoder_helper_funcs tegra_sor_dp_helpers = {
.atomic_check = tegra_sor_encoder_atomic_check, .atomic_check = tegra_sor_encoder_atomic_check,
}; };
static void tegra_sor_disable_regulator(void *data)
{
struct regulator *reg = data;
regulator_disable(reg);
}
static int tegra_sor_enable_regulator(struct tegra_sor *sor, struct regulator *reg)
{
int err;
err = regulator_enable(reg);
if (err)
return err;
return devm_add_action_or_reset(sor->dev, tegra_sor_disable_regulator, reg);
}
static int tegra_sor_hdmi_probe(struct tegra_sor *sor) static int tegra_sor_hdmi_probe(struct tegra_sor *sor)
{ {
int err; int err;
@@ -2949,7 +2966,7 @@ static int tegra_sor_hdmi_probe(struct tegra_sor *sor)
return PTR_ERR(sor->avdd_io_supply); return PTR_ERR(sor->avdd_io_supply);
} }
err = regulator_enable(sor->avdd_io_supply); err = tegra_sor_enable_regulator(sor, sor->avdd_io_supply);
if (err < 0) { if (err < 0) {
dev_err(sor->dev, "failed to enable AVDD I/O supply: %d\n", dev_err(sor->dev, "failed to enable AVDD I/O supply: %d\n",
err); err);
@@ -2963,7 +2980,7 @@ static int tegra_sor_hdmi_probe(struct tegra_sor *sor)
return PTR_ERR(sor->vdd_pll_supply); return PTR_ERR(sor->vdd_pll_supply);
} }
err = regulator_enable(sor->vdd_pll_supply); err = tegra_sor_enable_regulator(sor, sor->vdd_pll_supply);
if (err < 0) { if (err < 0) {
dev_err(sor->dev, "failed to enable VDD PLL supply: %d\n", dev_err(sor->dev, "failed to enable VDD PLL supply: %d\n",
err); err);
@@ -2977,7 +2994,7 @@ static int tegra_sor_hdmi_probe(struct tegra_sor *sor)
return PTR_ERR(sor->hdmi_supply); return PTR_ERR(sor->hdmi_supply);
} }
err = regulator_enable(sor->hdmi_supply); err = tegra_sor_enable_regulator(sor, sor->hdmi_supply);
if (err < 0) { if (err < 0) {
dev_err(sor->dev, "failed to enable HDMI supply: %d\n", err); dev_err(sor->dev, "failed to enable HDMI supply: %d\n", err);
return err; return err;
@@ -2988,19 +3005,9 @@ static int tegra_sor_hdmi_probe(struct tegra_sor *sor)
return 0; return 0;
} }
static int tegra_sor_hdmi_remove(struct tegra_sor *sor)
{
regulator_disable(sor->hdmi_supply);
regulator_disable(sor->vdd_pll_supply);
regulator_disable(sor->avdd_io_supply);
return 0;
}
static const struct tegra_sor_ops tegra_sor_hdmi_ops = { static const struct tegra_sor_ops tegra_sor_hdmi_ops = {
.name = "HDMI", .name = "HDMI",
.probe = tegra_sor_hdmi_probe, .probe = tegra_sor_hdmi_probe,
.remove = tegra_sor_hdmi_remove,
.audio_enable = tegra_sor_hdmi_audio_enable, .audio_enable = tegra_sor_hdmi_audio_enable,
.audio_disable = tegra_sor_hdmi_audio_disable, .audio_disable = tegra_sor_hdmi_audio_disable,
}; };
@@ -3013,7 +3020,7 @@ static int tegra_sor_dp_probe(struct tegra_sor *sor)
if (IS_ERR(sor->avdd_io_supply)) if (IS_ERR(sor->avdd_io_supply))
return PTR_ERR(sor->avdd_io_supply); return PTR_ERR(sor->avdd_io_supply);
err = regulator_enable(sor->avdd_io_supply); err = tegra_sor_enable_regulator(sor, sor->avdd_io_supply);
if (err < 0) if (err < 0)
return err; return err;
@@ -3021,25 +3028,16 @@ static int tegra_sor_dp_probe(struct tegra_sor *sor)
if (IS_ERR(sor->vdd_pll_supply)) if (IS_ERR(sor->vdd_pll_supply))
return PTR_ERR(sor->vdd_pll_supply); return PTR_ERR(sor->vdd_pll_supply);
err = regulator_enable(sor->vdd_pll_supply); err = tegra_sor_enable_regulator(sor, sor->vdd_pll_supply);
if (err < 0) if (err < 0)
return err; return err;
return 0; return 0;
} }
static int tegra_sor_dp_remove(struct tegra_sor *sor)
{
regulator_disable(sor->vdd_pll_supply);
regulator_disable(sor->avdd_io_supply);
return 0;
}
static const struct tegra_sor_ops tegra_sor_dp_ops = { static const struct tegra_sor_ops tegra_sor_dp_ops = {
.name = "DP", .name = "DP",
.probe = tegra_sor_dp_probe, .probe = tegra_sor_dp_probe,
.remove = tegra_sor_dp_remove,
}; };
static int tegra_sor_init(struct host1x_client *client) static int tegra_sor_init(struct host1x_client *client)
@@ -3141,6 +3139,7 @@ static int tegra_sor_init(struct host1x_client *client)
if (err < 0) { if (err < 0) {
dev_err(sor->dev, "failed to deassert SOR reset: %d\n", dev_err(sor->dev, "failed to deassert SOR reset: %d\n",
err); err);
clk_disable_unprepare(sor->clk);
return err; return err;
} }
@@ -3148,12 +3147,17 @@ static int tegra_sor_init(struct host1x_client *client)
} }
err = clk_prepare_enable(sor->clk_safe); err = clk_prepare_enable(sor->clk_safe);
if (err < 0) if (err < 0) {
clk_disable_unprepare(sor->clk);
return err; return err;
}
err = clk_prepare_enable(sor->clk_dp); err = clk_prepare_enable(sor->clk_dp);
if (err < 0) if (err < 0) {
clk_disable_unprepare(sor->clk_safe);
clk_disable_unprepare(sor->clk);
return err; return err;
}
return 0; return 0;
} }
@@ -3724,7 +3728,12 @@ static int tegra_sor_probe(struct platform_device *pdev)
if (!sor->aux) if (!sor->aux)
return -EPROBE_DEFER; return -EPROBE_DEFER;
sor->output.ddc = &sor->aux->ddc; if (get_device(&sor->aux->ddc.dev)) {
if (try_module_get(sor->aux->ddc.owner))
sor->output.ddc = &sor->aux->ddc;
else
put_device(&sor->aux->ddc.dev);
}
} }
if (!sor->aux) { if (!sor->aux) {
@@ -3755,17 +3764,16 @@ static int tegra_sor_probe(struct platform_device *pdev)
return err; return err;
err = tegra_output_probe(&sor->output); err = tegra_output_probe(&sor->output);
if (err < 0) { if (err < 0)
dev_err(&pdev->dev, "failed to probe output: %d\n", err); return dev_err_probe(&pdev->dev, err,
return err; "failed to probe output\n");
}
if (sor->ops && sor->ops->probe) { if (sor->ops && sor->ops->probe) {
err = sor->ops->probe(sor); err = sor->ops->probe(sor);
if (err < 0) { if (err < 0) {
dev_err(&pdev->dev, "failed to probe %s: %d\n", dev_err(&pdev->dev, "failed to probe %s: %d\n",
sor->ops->name, err); sor->ops->name, err);
goto output; goto remove;
} }
} }
@@ -3946,9 +3954,6 @@ unregister:
rpm_disable: rpm_disable:
pm_runtime_disable(&pdev->dev); pm_runtime_disable(&pdev->dev);
remove: remove:
if (sor->ops && sor->ops->remove)
sor->ops->remove(sor);
output:
tegra_output_remove(&sor->output); tegra_output_remove(&sor->output);
return err; return err;
} }
@@ -3967,12 +3972,6 @@ static int tegra_sor_remove(struct platform_device *pdev)
pm_runtime_disable(&pdev->dev); pm_runtime_disable(&pdev->dev);
if (sor->ops && sor->ops->remove) {
err = sor->ops->remove(sor);
if (err < 0)
dev_err(&pdev->dev, "failed to remove SOR: %d\n", err);
}
tegra_output_remove(&sor->output); tegra_output_remove(&sor->output);
return 0; return 0;