|
@@ -14,170 +14,45 @@
|
|
|
*
|
|
|
*/
|
|
|
|
|
|
-#include <drm/drm_crtc_helper.h>
|
|
|
+#include <drm/drm_crtc.h>
|
|
|
#include <drm/drm_encoder_slave.h>
|
|
|
-#include <drm/drm_atomic_helper.h>
|
|
|
|
|
|
#include "arcpgu.h"
|
|
|
|
|
|
-struct arcpgu_drm_connector {
|
|
|
- struct drm_connector connector;
|
|
|
- struct drm_encoder_slave *encoder_slave;
|
|
|
-};
|
|
|
-
|
|
|
-static int arcpgu_drm_connector_get_modes(struct drm_connector *connector)
|
|
|
-{
|
|
|
- const struct drm_encoder_slave_funcs *sfuncs;
|
|
|
- struct drm_encoder_slave *slave;
|
|
|
- struct arcpgu_drm_connector *con =
|
|
|
- container_of(connector, struct arcpgu_drm_connector, connector);
|
|
|
-
|
|
|
- slave = con->encoder_slave;
|
|
|
- if (slave == NULL) {
|
|
|
- dev_err(connector->dev->dev,
|
|
|
- "connector_get_modes: cannot find slave encoder for connector\n");
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
- sfuncs = slave->slave_funcs;
|
|
|
- if (sfuncs->get_modes == NULL)
|
|
|
- return 0;
|
|
|
-
|
|
|
- return sfuncs->get_modes(&slave->base, connector);
|
|
|
-}
|
|
|
-
|
|
|
-static enum drm_connector_status
|
|
|
-arcpgu_drm_connector_detect(struct drm_connector *connector, bool force)
|
|
|
-{
|
|
|
- enum drm_connector_status status = connector_status_unknown;
|
|
|
- const struct drm_encoder_slave_funcs *sfuncs;
|
|
|
- struct drm_encoder_slave *slave;
|
|
|
-
|
|
|
- struct arcpgu_drm_connector *con =
|
|
|
- container_of(connector, struct arcpgu_drm_connector, connector);
|
|
|
-
|
|
|
- slave = con->encoder_slave;
|
|
|
- if (slave == NULL) {
|
|
|
- dev_err(connector->dev->dev,
|
|
|
- "connector_detect: cannot find slave encoder for connector\n");
|
|
|
- return status;
|
|
|
- }
|
|
|
-
|
|
|
- sfuncs = slave->slave_funcs;
|
|
|
- if (sfuncs && sfuncs->detect)
|
|
|
- return sfuncs->detect(&slave->base, connector);
|
|
|
-
|
|
|
- dev_err(connector->dev->dev, "connector_detect: could not detect slave funcs\n");
|
|
|
- return status;
|
|
|
-}
|
|
|
-
|
|
|
-static void arcpgu_drm_connector_destroy(struct drm_connector *connector)
|
|
|
-{
|
|
|
- drm_connector_unregister(connector);
|
|
|
- drm_connector_cleanup(connector);
|
|
|
-}
|
|
|
-
|
|
|
-static const struct drm_connector_helper_funcs
|
|
|
-arcpgu_drm_connector_helper_funcs = {
|
|
|
- .get_modes = arcpgu_drm_connector_get_modes,
|
|
|
-};
|
|
|
-
|
|
|
-static const struct drm_connector_funcs arcpgu_drm_connector_funcs = {
|
|
|
- .dpms = drm_helper_connector_dpms,
|
|
|
- .reset = drm_atomic_helper_connector_reset,
|
|
|
- .detect = arcpgu_drm_connector_detect,
|
|
|
- .fill_modes = drm_helper_probe_single_connector_modes,
|
|
|
- .destroy = arcpgu_drm_connector_destroy,
|
|
|
- .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
|
|
|
- .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
|
|
|
-};
|
|
|
-
|
|
|
-static struct drm_encoder_helper_funcs arcpgu_drm_encoder_helper_funcs = {
|
|
|
- .dpms = drm_i2c_encoder_dpms,
|
|
|
- .mode_fixup = drm_i2c_encoder_mode_fixup,
|
|
|
- .mode_set = drm_i2c_encoder_mode_set,
|
|
|
- .prepare = drm_i2c_encoder_prepare,
|
|
|
- .commit = drm_i2c_encoder_commit,
|
|
|
- .detect = drm_i2c_encoder_detect,
|
|
|
-};
|
|
|
-
|
|
|
static struct drm_encoder_funcs arcpgu_drm_encoder_funcs = {
|
|
|
.destroy = drm_encoder_cleanup,
|
|
|
};
|
|
|
|
|
|
int arcpgu_drm_hdmi_init(struct drm_device *drm, struct device_node *np)
|
|
|
{
|
|
|
- struct arcpgu_drm_connector *arcpgu_connector;
|
|
|
- struct drm_i2c_encoder_driver *driver;
|
|
|
- struct drm_encoder_slave *encoder;
|
|
|
- struct drm_connector *connector;
|
|
|
- struct i2c_client *i2c_slave;
|
|
|
- int ret;
|
|
|
+ struct drm_encoder *encoder;
|
|
|
+ struct drm_bridge *bridge;
|
|
|
+
|
|
|
+ int ret = 0;
|
|
|
|
|
|
encoder = devm_kzalloc(drm->dev, sizeof(*encoder), GFP_KERNEL);
|
|
|
if (encoder == NULL)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- i2c_slave = of_find_i2c_device_by_node(np);
|
|
|
- if (!i2c_slave || !i2c_get_clientdata(i2c_slave)) {
|
|
|
- dev_err(drm->dev, "failed to find i2c slave encoder\n");
|
|
|
- return -EPROBE_DEFER;
|
|
|
- }
|
|
|
-
|
|
|
- if (i2c_slave->dev.driver == NULL) {
|
|
|
- dev_err(drm->dev, "failed to find i2c slave driver\n");
|
|
|
+ /* Locate drm bridge from the hdmi encoder DT node */
|
|
|
+ bridge = of_drm_find_bridge(np);
|
|
|
+ if (!bridge)
|
|
|
return -EPROBE_DEFER;
|
|
|
- }
|
|
|
|
|
|
- driver =
|
|
|
- to_drm_i2c_encoder_driver(to_i2c_driver(i2c_slave->dev.driver));
|
|
|
- ret = driver->encoder_init(i2c_slave, drm, encoder);
|
|
|
- if (ret) {
|
|
|
- dev_err(drm->dev, "failed to initialize i2c encoder slave\n");
|
|
|
- return ret;
|
|
|
- }
|
|
|
-
|
|
|
- encoder->base.possible_crtcs = 1;
|
|
|
- encoder->base.possible_clones = 0;
|
|
|
- ret = drm_encoder_init(drm, &encoder->base, &arcpgu_drm_encoder_funcs,
|
|
|
+ encoder->possible_crtcs = 1;
|
|
|
+ encoder->possible_clones = 0;
|
|
|
+ ret = drm_encoder_init(drm, encoder, &arcpgu_drm_encoder_funcs,
|
|
|
DRM_MODE_ENCODER_TMDS, NULL);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
|
|
|
- drm_encoder_helper_add(&encoder->base,
|
|
|
- &arcpgu_drm_encoder_helper_funcs);
|
|
|
-
|
|
|
- arcpgu_connector = devm_kzalloc(drm->dev, sizeof(*arcpgu_connector),
|
|
|
- GFP_KERNEL);
|
|
|
- if (!arcpgu_connector) {
|
|
|
- ret = -ENOMEM;
|
|
|
- goto error_encoder_cleanup;
|
|
|
- }
|
|
|
-
|
|
|
- connector = &arcpgu_connector->connector;
|
|
|
- drm_connector_helper_add(connector, &arcpgu_drm_connector_helper_funcs);
|
|
|
- ret = drm_connector_init(drm, connector, &arcpgu_drm_connector_funcs,
|
|
|
- DRM_MODE_CONNECTOR_HDMIA);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(drm->dev, "failed to initialize drm connector\n");
|
|
|
- goto error_encoder_cleanup;
|
|
|
- }
|
|
|
+ /* Link drm_bridge to encoder */
|
|
|
+ bridge->encoder = encoder;
|
|
|
+ encoder->bridge = bridge;
|
|
|
|
|
|
- ret = drm_mode_connector_attach_encoder(connector, &encoder->base);
|
|
|
- if (ret < 0) {
|
|
|
- dev_err(drm->dev, "could not attach connector to encoder\n");
|
|
|
- drm_connector_unregister(connector);
|
|
|
- goto error_connector_cleanup;
|
|
|
- }
|
|
|
-
|
|
|
- arcpgu_connector->encoder_slave = encoder;
|
|
|
-
|
|
|
- return 0;
|
|
|
-
|
|
|
-error_connector_cleanup:
|
|
|
- drm_connector_cleanup(connector);
|
|
|
+ ret = drm_bridge_attach(drm, bridge);
|
|
|
+ if (ret)
|
|
|
+ drm_encoder_cleanup(encoder);
|
|
|
|
|
|
-error_encoder_cleanup:
|
|
|
- drm_encoder_cleanup(&encoder->base);
|
|
|
return ret;
|
|
|
}
|