| /* |
| * drivers/amlogic/drm/meson_hdmi.c |
| * |
| * Copyright (C) 2017 Amlogic, Inc. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, but WITHOUT |
| * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| * more details. |
| * |
| */ |
| |
| #include <drm/drm_modeset_helper.h> |
| #include <drm/drmP.h> |
| #include <drm/drm_edid.h> |
| #include <drm/drm_crtc_helper.h> |
| #include <drm/drm_atomic_helper.h> |
| #include <drm/drm_connector.h> |
| |
| #include <linux/component.h> |
| #include <linux/irq.h> |
| #include <linux/io.h> |
| #include <linux/delay.h> |
| #include <linux/jiffies.h> |
| #include <linux/kthread.h> |
| #include <linux/device.h> |
| |
| #include <linux/workqueue.h> |
| #include <linux/amlogic/media/vout/vout_notify.h> |
| #include <linux/amlogic/media/vout/hdmi_tx/hdmi_tx_module.h> |
| #include "meson_hdmi.h" |
| #include "meson_hdcp.h" |
| #include "meson_vpu.h" |
| |
| #define DEVICE_NAME "amhdmitx" |
| struct am_hdmi_tx am_hdmi_info; |
| |
| static struct am_vout_mode am_vout_modes[] = { |
| { "1080p60hz", VMODE_HDMI, 1920, 1080, 60, 0}, |
| { "1080p30hz", VMODE_HDMI, 1920, 1080, 30, 0}, |
| { "1080p50hz", VMODE_HDMI, 1920, 1080, 50, 0}, |
| { "1080p25hz", VMODE_HDMI, 1920, 1080, 25, 0}, |
| { "1080p24hz", VMODE_HDMI, 1920, 1080, 24, 0}, |
| { "2160p30hz", VMODE_HDMI, 3840, 2160, 30, 0}, |
| { "2160p60hz", VMODE_HDMI, 3840, 2160, 60, 0}, |
| { "2160p50hz", VMODE_HDMI, 3840, 2160, 50, 0}, |
| { "2160p25hz", VMODE_HDMI, 3840, 2160, 25, 0}, |
| { "2160p24hz", VMODE_HDMI, 3840, 2160, 24, 0}, |
| { "smpte30hz", VMODE_HDMI, 4096, 2160, 30, 0}, |
| { "smpte60hz", VMODE_HDMI, 4096, 2160, 60, 0}, |
| { "smpte50hz", VMODE_HDMI, 4096, 2160, 50, 0}, |
| { "smpte25hz", VMODE_HDMI, 4096, 2160, 25, 0}, |
| { "smpte24hz", VMODE_HDMI, 4096, 2160, 24, 0}, |
| { "1080i60hz", VMODE_HDMI, 1920, 1080, 60, DRM_MODE_FLAG_INTERLACE}, |
| { "1080i50hz", VMODE_HDMI, 1920, 1080, 50, DRM_MODE_FLAG_INTERLACE}, |
| { "720p60hz", VMODE_HDMI, 1280, 720, 60, 0}, |
| { "720p50hz", VMODE_HDMI, 1280, 720, 50, 0}, |
| { "480p60hz", VMODE_HDMI, 720, 480, 60, 0}, |
| { "480i60hz", VMODE_HDMI, 720, 480, 60, DRM_MODE_FLAG_INTERLACE}, |
| { "576p50hz", VMODE_HDMI, 720, 576, 50, 0}, |
| { "576i50hz", VMODE_HDMI, 720, 576, 50, DRM_MODE_FLAG_INTERLACE}, |
| { "480p60hz", VMODE_HDMI, 720, 480, 60, 0}, |
| }; |
| |
| char *am_meson_hdmi_get_voutmode(struct drm_display_mode *mode) |
| { |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(am_vout_modes); i++) { |
| if (am_vout_modes[i].width == mode->hdisplay && |
| am_vout_modes[i].height == mode->vdisplay && |
| am_vout_modes[i].vrefresh == mode->vrefresh && |
| am_vout_modes[i].flags == |
| (mode->flags & DRM_MODE_FLAG_INTERLACE)) |
| return am_vout_modes[i].name; |
| } |
| return NULL; |
| } |
| |
| static unsigned char default_edid[] = { |
| 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, |
| 0x31, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, |
| 0x05, 0x16, 0x01, 0x03, 0x6d, 0x32, 0x1c, 0x78, |
| 0xea, 0x5e, 0xc0, 0xa4, 0x59, 0x4a, 0x98, 0x25, |
| 0x20, 0x50, 0x54, 0x00, 0x00, 0x00, 0xd1, 0xc0, |
| 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, |
| 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x3a, |
| 0x80, 0x18, 0x71, 0x38, 0x2d, 0x40, 0x58, 0x2c, |
| 0x45, 0x00, 0xf4, 0x19, 0x11, 0x00, 0x00, 0x1e, |
| 0x00, 0x00, 0x00, 0xff, 0x00, 0x4c, 0x69, 0x6e, |
| 0x75, 0x78, 0x20, 0x23, 0x30, 0x0a, 0x20, 0x20, |
| 0x20, 0x20, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x3b, |
| 0x3d, 0x42, 0x44, 0x0f, 0x00, 0x0a, 0x20, 0x20, |
| 0x20, 0x20, 0x20, 0x20, 0x00, 0x00, 0x00, 0xfc, |
| 0x00, 0x4c, 0x69, 0x6e, 0x75, 0x78, 0x20, 0x46, |
| 0x48, 0x44, 0x0a, 0x20, 0x20, 0x20, 0x00, 0x05, |
| }; |
| |
| int am_hdmi_tx_get_modes(struct drm_connector *connector) |
| { |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(connector); |
| struct edid *edid; |
| int count = 0; |
| |
| DRM_INFO("get_edid\n"); |
| edid = drm_get_edid(connector, am_hdmi->ddc); |
| |
| if (edid) { |
| drm_mode_connector_update_edid_property(connector, edid); |
| count = drm_add_edid_modes(connector, edid); |
| kfree(edid); |
| } else { |
| DRM_INFO("edid error and load default edid\n"); |
| drm_mode_connector_update_edid_property(connector, |
| (struct edid *)default_edid); |
| count = drm_add_edid_modes(connector, |
| (struct edid *)default_edid); |
| } |
| return count; |
| } |
| |
| enum drm_mode_status am_hdmi_tx_check_mode(struct drm_connector *connector, |
| struct drm_display_mode *mode) |
| { |
| if (am_meson_hdmi_get_voutmode(mode)) |
| return MODE_OK; |
| else |
| return MODE_NOMODE; |
| } |
| |
| static struct drm_encoder *am_hdmi_connector_best_encoder |
| (struct drm_connector *connector) |
| { |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(connector); |
| |
| return &am_hdmi->encoder; |
| } |
| |
| static enum drm_connector_status am_hdmi_connector_detect |
| (struct drm_connector *connector, bool force) |
| { |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(connector); |
| |
| /* HPD rising */ |
| if (am_hdmi->hpd_flag == 1) { |
| DRM_INFO("connector_status_connected\n"); |
| return connector_status_connected; |
| } |
| /* HPD falling */ |
| if (am_hdmi->hpd_flag == 2) { |
| DRM_INFO("connector_status_disconnected\n"); |
| /* |
| *clean the hdmi info and output : todo |
| */ |
| return connector_status_disconnected; |
| } |
| /*if the status is unknown, read GPIO*/ |
| if (hdmitx_hpd_hw_op(HPD_READ_HPD_GPIO)) { |
| DRM_INFO("connector_status_connected\n"); |
| return connector_status_connected; |
| } |
| if (!(hdmitx_hpd_hw_op(HPD_READ_HPD_GPIO))) { |
| DRM_INFO("connector_status_disconnected\n"); |
| return connector_status_disconnected; |
| } |
| |
| DRM_INFO("connector_status_unknown\n"); |
| return connector_status_unknown; |
| } |
| |
| void am_hdmi_hdcp_work_state_change(struct am_hdmi_tx *am_hdmi, int stop) |
| { |
| if (am_hdmi->hdcp_tx_type == 0) { |
| DRM_INFO("hdcp not support\n"); |
| return; |
| } |
| if (am_hdmi->hdcp_work == NULL && stop != 1) { |
| am_hdmi->hdcp_work = kthread_run(am_hdcp_work, |
| (void *)am_hdmi, "kthread_hdcp_task"); |
| if (IS_ERR(am_hdmi->hdcp_work)) { |
| DRM_INFO("hdcp work create failed\n"); |
| am_hdmi->hdcp_work = NULL; |
| } |
| return; |
| } |
| if (am_hdmi->hdcp_work != NULL && stop == 1) { |
| DRM_INFO("stop hdcp work\n"); |
| kthread_stop(am_hdmi->hdcp_work); |
| am_hdmi->hdcp_work = NULL; |
| am_hdcp_disable(am_hdmi); |
| } |
| } |
| |
| static int am_hdmi_connector_set_property(struct drm_connector *connector, |
| struct drm_property *property, uint64_t val) |
| { |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(connector); |
| struct drm_connector_state *state = am_hdmi->connector.state; |
| |
| if (property == connector->content_protection_property) { |
| DRM_INFO("property:%s val: %lld\n", property->name, val); |
| /* For none atomic commit */ |
| /* atomic will be filter on drm_moder_object.c */ |
| if (val == DRM_MODE_CONTENT_PROTECTION_ENABLED) { |
| DRM_DEBUG_KMS("only drivers can set CP Enabled\n"); |
| return -EINVAL; |
| } |
| state->content_protection = val; |
| } |
| /*other parperty todo*/ |
| return 0; |
| } |
| |
| static int am_hdmi_connector_atomic_get_property |
| (struct drm_connector *connector, |
| const struct drm_connector_state *state, |
| struct drm_property *property, uint64_t *val) |
| { |
| if (property == connector->content_protection_property) { |
| DRM_INFO("get content_protection val: %d\n", |
| state->content_protection); |
| *val = state->content_protection; |
| } else { |
| DRM_DEBUG_ATOMIC("Unknown property %s\n", property->name); |
| return -EINVAL; |
| } |
| return 0; |
| } |
| |
| static void am_hdmi_connector_destroy(struct drm_connector *connector) |
| { |
| drm_connector_unregister(connector); |
| drm_connector_cleanup(connector); |
| } |
| |
| static const |
| struct drm_connector_helper_funcs am_hdmi_connector_helper_funcs = { |
| .get_modes = am_hdmi_tx_get_modes, |
| .mode_valid = am_hdmi_tx_check_mode, |
| .best_encoder = am_hdmi_connector_best_encoder, |
| }; |
| |
| static const struct drm_connector_funcs am_hdmi_connector_funcs = { |
| .dpms = drm_atomic_helper_connector_dpms, |
| .detect = am_hdmi_connector_detect, |
| .fill_modes = drm_helper_probe_single_connector_modes, |
| .set_property = am_hdmi_connector_set_property, |
| .atomic_get_property = am_hdmi_connector_atomic_get_property, |
| .destroy = am_hdmi_connector_destroy, |
| .reset = drm_atomic_helper_connector_reset, |
| .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, |
| .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, |
| }; |
| |
| void am_hdmi_encoder_mode_set(struct drm_encoder *encoder, |
| struct drm_display_mode *mode, |
| struct drm_display_mode *adjusted_mode) |
| { |
| const char attr1[16] = "rgb,8bit"; |
| const char attr2[16] = "420,8bit"; |
| int vic; |
| struct am_hdmi_tx *am_hdmi = &am_hdmi_info; |
| |
| DRM_INFO("mode : %s, adjusted_mode : %s\n", |
| mode->name, adjusted_mode->name); |
| am_hdmi->hdmi_info.vic = drm_match_cea_mode(adjusted_mode); |
| vic = am_hdmi->hdmi_info.vic; |
| DRM_INFO("the hdmi mode vic : %d\n", am_hdmi->hdmi_info.vic); |
| /* Store the display mode for plugin/DPMS poweron events */ |
| memcpy(&am_hdmi->previous_mode, adjusted_mode, |
| sizeof(am_hdmi->previous_mode)); |
| if (vic == 96 || vic == 97 || vic == 101 || vic == 102 || |
| vic == 106 || vic == 107) |
| setup_attr(attr2); |
| else |
| setup_attr(attr1); |
| } |
| |
| void am_hdmi_encoder_enable(struct drm_encoder *encoder) |
| { |
| enum vmode_e vmode = get_current_vmode(); |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(encoder); |
| |
| if (vmode == VMODE_HDMI) |
| DRM_INFO("enable\n"); |
| else |
| DRM_INFO("enable fail! vmode:%d\n", vmode); |
| |
| vout_notifier_call_chain(VOUT_EVENT_MODE_CHANGE_PRE, &vmode); |
| set_vout_vmode(vmode); |
| vout_notifier_call_chain(VOUT_EVENT_MODE_CHANGE, &vmode); |
| mdelay(1000); |
| am_hdmi_hdcp_work_state_change(am_hdmi, 0); |
| } |
| |
| void am_hdmi_encoder_disable(struct drm_encoder *encoder) |
| { |
| struct am_hdmi_tx *am_hdmi = to_am_hdmi(encoder); |
| struct drm_connector_state *state = am_hdmi->connector.state; |
| |
| state->content_protection = DRM_MODE_CONTENT_PROTECTION_UNDESIRED; |
| am_hdmi_hdcp_work_state_change(am_hdmi, 1); |
| |
| } |
| |
| static int am_hdmi_encoder_atomic_check(struct drm_encoder *encoder, |
| struct drm_crtc_state *crtc_state, |
| struct drm_connector_state *conn_state) |
| { |
| return 0; |
| } |
| |
| static const struct drm_encoder_helper_funcs |
| am_hdmi_encoder_helper_funcs = { |
| .mode_set = am_hdmi_encoder_mode_set, |
| .enable = am_hdmi_encoder_enable, |
| .disable = am_hdmi_encoder_disable, |
| .atomic_check = am_hdmi_encoder_atomic_check, |
| }; |
| |
| static const struct drm_encoder_funcs am_hdmi_encoder_funcs = { |
| .destroy = drm_encoder_cleanup, |
| }; |
| |
| static int am_hdmi_i2c_write(struct am_hdmi_tx *am_hdmi, |
| unsigned char *buf, unsigned int length) |
| { |
| struct am_hdmi_i2c *i2c = am_hdmi->i2c; |
| int stat; |
| |
| if (!i2c->is_regaddr) { |
| /* Use the first write byte as register address */ |
| i2c->slave_reg = buf[0]; |
| length--; |
| buf++; |
| i2c->is_regaddr = 1; |
| } |
| |
| while (length--) { |
| reinit_completion(&i2c->cmp); |
| |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_DATAO, *buf++); |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_ADDRESS, i2c->slave_reg++); |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_OPERATION, 1 << 4); |
| |
| stat = wait_for_completion_timeout(&i2c->cmp, HZ / 100); |
| |
| stat = 1; |
| /* Check for error condition on the bus */ |
| if (i2c->stat & 1) |
| return -EIO; |
| } |
| |
| return 0; |
| } |
| |
| static int am_hdmi_i2c_read(struct am_hdmi_tx *am_hdmi, |
| unsigned char *buf, unsigned int length) |
| { |
| struct am_hdmi_i2c *i2c = am_hdmi->i2c; |
| int stat; |
| |
| if (!i2c->is_regaddr) { |
| dev_dbg(am_hdmi->dev, "set read register address to 0\n"); |
| i2c->slave_reg = 0x00; |
| i2c->is_regaddr = 1; |
| } |
| |
| while (length--) { |
| reinit_completion(&i2c->cmp); |
| |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_ADDRESS, i2c->slave_reg++); |
| if (i2c->is_segment) |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_OPERATION, 1 << 1); |
| else |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_OPERATION, 1 << 0); |
| |
| stat = wait_for_completion_timeout(&i2c->cmp, HZ / 100); |
| |
| stat = 1; |
| |
| /* Check for error condition on the bus */ |
| if (i2c->stat & 0x1) |
| return -EIO; |
| |
| *buf++ = hdmitx_rd_reg(HDMITX_DWC_I2CM_DATAI); |
| } |
| i2c->is_segment = 0; |
| |
| return 0; |
| } |
| |
| static int am_hdmi_i2c_xfer(struct i2c_adapter *adap, |
| struct i2c_msg *msgs, int num) |
| { |
| struct am_hdmi_tx *am_hdmi = i2c_get_adapdata(adap); |
| struct am_hdmi_i2c *i2c = am_hdmi->i2c; |
| u8 addr = msgs[0].addr; |
| int i, ret = 0; |
| |
| dev_dbg(am_hdmi->dev, "xfer: num: %d, addr: %#x\n", num, addr); |
| |
| for (i = 0; i < num; i++) { |
| if (msgs[i].len == 0) { |
| dev_dbg(am_hdmi->dev, |
| "unsupported transfer %d/%d, no data\n", |
| i + 1, num); |
| return -EOPNOTSUPP; |
| } |
| } |
| |
| mutex_lock(&i2c->lock); |
| |
| /* Clear the EDID interrupt flag and unmute the interrupt */ |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_SOFTRSTZ, 0); |
| hdmitx_wr_reg(HDMITX_DWC_IH_MUTE_I2CM_STAT0, 0); |
| /* TODO */ |
| hdmitx_ddc_hw_op(DDC_MUX_DDC); |
| |
| /* Set slave device address taken from the first I2C message */ |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_SLAVE, addr); |
| |
| /* Set slave device register address on transfer */ |
| i2c->is_regaddr = 0; |
| |
| /* Set segment pointer for I2C extended read mode operation */ |
| i2c->is_segment = 0; |
| |
| for (i = 0; i < num; i++) { |
| dev_dbg(am_hdmi->dev, "xfer: num: %d/%d, len: %d, flags: %#x\n", |
| i + 1, num, msgs[i].len, msgs[i].flags); |
| if (msgs[i].addr == DDC_SEGMENT_ADDR && msgs[i].len == 1) { |
| i2c->is_segment = 1; |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_SEGADDR, |
| DDC_SEGMENT_ADDR); |
| hdmitx_wr_reg(HDMITX_DWC_I2CM_SEGPTR, *msgs[i].buf); |
| } else { |
| if (msgs[i].flags & I2C_M_RD) |
| ret = am_hdmi_i2c_read(am_hdmi, msgs[i].buf, |
| msgs[i].len); |
| else |
| ret = am_hdmi_i2c_write(am_hdmi, msgs[i].buf, |
| msgs[i].len); |
| } |
| if (ret < 0) |
| break; |
| } |
| |
| if (!ret) |
| ret = num; |
| |
| mutex_unlock(&i2c->lock); |
| |
| return ret; |
| } |
| |
| static u32 am_hdmi_i2c_func(struct i2c_adapter *adapter) |
| { |
| return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; |
| } |
| |
| static const struct i2c_algorithm am_hdmi_algorithm = { |
| .master_xfer = am_hdmi_i2c_xfer, |
| .functionality = am_hdmi_i2c_func, |
| }; |
| |
| static struct i2c_adapter *am_hdmi_i2c_adapter(struct am_hdmi_tx *am_hdmi) |
| { |
| struct i2c_adapter *adap; |
| struct am_hdmi_i2c *i2c; |
| int ret; |
| |
| i2c = devm_kzalloc(am_hdmi->priv->dev, sizeof(*i2c), GFP_KERNEL); |
| if (!i2c) { |
| ret = -ENOMEM; |
| DRM_INFO("error : %d\n", ret); |
| } |
| |
| mutex_init(&i2c->lock); |
| init_completion(&i2c->cmp); |
| |
| adap = &i2c->adap; |
| adap->class = I2C_CLASS_DDC; |
| adap->owner = THIS_MODULE; |
| adap->dev.parent = am_hdmi->priv->dev; |
| adap->dev.of_node = am_hdmi->priv->dev->of_node; |
| adap->algo = &am_hdmi_algorithm; |
| strlcpy(adap->name, "Am HDMI", sizeof(adap->name)); |
| i2c_set_adapdata(adap, am_hdmi); |
| |
| ret = i2c_add_adapter(adap); |
| if (ret) { |
| DRM_INFO("cannot add %s I2C adapter\n", |
| adap->name); |
| devm_kfree(am_hdmi->priv->dev, i2c); |
| return ERR_PTR(ret); |
| } |
| am_hdmi->i2c = i2c; |
| DRM_INFO("registered %s I2C bus driver\n", adap->name); |
| |
| return adap; |
| |
| } |
| static irqreturn_t am_hdmi_hardirq(int irq, void *dev_id) |
| { |
| unsigned int data32 = 0; |
| irqreturn_t ret = IRQ_NONE; |
| |
| data32 = hdmitx_rd_reg(HDMITX_TOP_INTR_STAT); |
| |
| /* check HPD status */ |
| if ((data32 & (1 << 1)) && (data32 & (1 << 2))) { |
| if (hdmitx_hpd_hw_op(HPD_READ_HPD_GPIO)) |
| data32 &= ~(1 << 2); |
| else |
| data32 &= ~(1 << 1); |
| } |
| |
| if ((data32 & (1 << 1)) || (data32 & (1 << 2))) { |
| ret = IRQ_WAKE_THREAD; |
| DRM_INFO("hotplug irq: %x\n", data32); |
| am_hdmi_info.hpd_flag = 0; |
| if (data32 & (1 << 1)) |
| am_hdmi_info.hpd_flag = 1;/* HPD rising */ |
| if (data32 & (1 << 2)) |
| am_hdmi_info.hpd_flag = 2;/* HPD falling */ |
| /* ack INTERNAL_INTR or else*/ |
| hdmitx_wr_reg(HDMITX_TOP_INTR_STAT_CLR, data32 | 0x7); |
| } |
| return ret; |
| } |
| |
| static irqreturn_t am_hdmi_irq(int irq, void *dev_id) |
| { |
| struct am_hdmi_tx *am_hdmi = dev_id; |
| |
| drm_helper_hpd_irq_event(am_hdmi->connector.dev); |
| return IRQ_HANDLED; |
| } |
| |
| static int amhdmitx_get_dt_info(struct am_hdmi_tx *am_hdmi) |
| { |
| struct device_node *hdcp_node; |
| unsigned char *hdcp_status; |
| int ret = 0; |
| |
| hdcp_node = of_find_node_by_path("/drm-amhdmitx"); |
| if (hdcp_node) { |
| ret = of_property_read_string(hdcp_node, "hdcp", |
| (const char **)&(hdcp_status)); |
| if (ret) { |
| DRM_INFO("not find hdcp_feature\n"); |
| } else { |
| if (memcmp(hdcp_status, "okay", 4) == 0) |
| am_hdmi->hdcp_feature = 1; |
| else |
| am_hdmi->hdcp_feature = 0; |
| DRM_INFO("hdcp_feature: %d\n", |
| am_hdmi->hdcp_feature); |
| } |
| } else { |
| DRM_INFO("not find drm_amhdmitx\n"); |
| } |
| return 0; |
| } |
| |
| |
| static const struct of_device_id am_meson_hdmi_dt_ids[] = { |
| { .compatible = "amlogic,drm-amhdmitx", }, |
| {}, |
| }; |
| |
| MODULE_DEVICE_TABLE(of, am_meson_hdmi_dt_ids); |
| |
| struct drm_connector *am_meson_hdmi_connector(void) |
| { |
| return &am_hdmi_info.connector; |
| } |
| |
| static int am_meson_hdmi_bind(struct device *dev, |
| struct device *master, void *data) |
| { |
| struct platform_device *pdev = to_platform_device(dev); |
| struct drm_device *drm = data; |
| struct meson_drm *priv = drm->dev_private; |
| struct am_hdmi_tx *am_hdmi; |
| struct drm_connector *connector; |
| struct drm_encoder *encoder; |
| int ret; |
| int irq; |
| |
| DRM_INFO("[%s] in\n", __func__); |
| am_hdmi = &am_hdmi_info; |
| memset(am_hdmi, 0, sizeof(*am_hdmi)); |
| |
| DRM_INFO("drm hdmitx init and version:%s\n", DRM_HDMITX_VER); |
| am_hdmi->priv = priv; |
| encoder = &am_hdmi->encoder; |
| connector = &am_hdmi->connector; |
| |
| /* Connector */ |
| am_hdmi->connector.polled = DRM_CONNECTOR_POLL_HPD; |
| drm_connector_helper_add(connector, |
| &am_hdmi_connector_helper_funcs); |
| |
| ret = drm_connector_init(drm, connector, &am_hdmi_connector_funcs, |
| DRM_MODE_CONNECTOR_HDMIA); |
| if (ret) { |
| dev_err(priv->dev, "Failed to init hdmi tx connector\n"); |
| return ret; |
| } |
| |
| connector->interlace_allowed = 1; |
| |
| /* Encoder */ |
| drm_encoder_helper_add(encoder, &am_hdmi_encoder_helper_funcs); |
| |
| ret = drm_encoder_init(drm, encoder, &am_hdmi_encoder_funcs, |
| DRM_MODE_ENCODER_TVDAC, "am_hdmi_encoder"); |
| if (ret) { |
| dev_err(priv->dev, "Failed to init hdmi encoder\n"); |
| return ret; |
| } |
| |
| encoder->possible_crtcs = BIT(0); |
| |
| drm_mode_connector_attach_encoder(connector, encoder); |
| |
| /*DDC init*/ |
| am_hdmi->ddc = am_hdmi_i2c_adapter(am_hdmi); |
| DRM_INFO("hdmitx:DDC init complete\n"); |
| /*Hotplug irq*/ |
| irq = platform_get_irq(pdev, 0); |
| DRM_INFO("hdmi connector irq:%d\n", irq); |
| if (irq < 0) |
| return irq; |
| hdmitx_wr_reg(HDMITX_TOP_INTR_STAT_CLR, 0x7); |
| ret = devm_request_threaded_irq(am_hdmi->priv->dev, irq, |
| am_hdmi_hardirq, am_hdmi_irq, IRQF_SHARED, |
| dev_name(am_hdmi->priv->dev), am_hdmi); |
| if (ret) { |
| dev_err(am_hdmi->priv->dev, |
| "failed to request hdmi irq: %d\n", ret); |
| } |
| |
| /*HDCP INIT*/ |
| amhdmitx_get_dt_info(am_hdmi); |
| if (am_hdmi->hdcp_feature) { |
| if (is_hdcp_hdmitx_supported(am_hdmi)) { |
| ret = am_hdcp_init(am_hdmi); |
| if (ret) |
| DRM_DEBUG_KMS("HDCP init failed, skipping.\n"); |
| } |
| } |
| DRM_INFO("[%s] out\n", __func__); |
| return 0; |
| } |
| |
| static void am_meson_hdmi_unbind(struct device *dev, |
| struct device *master, void *data) |
| { |
| am_hdmi_info.connector.funcs->destroy(&am_hdmi_info.connector); |
| am_hdmi_info.encoder.funcs->destroy(&am_hdmi_info.encoder); |
| } |
| |
| static const struct component_ops am_meson_hdmi_ops = { |
| .bind = am_meson_hdmi_bind, |
| .unbind = am_meson_hdmi_unbind, |
| }; |
| |
| static int am_meson_hdmi_probe(struct platform_device *pdev) |
| { |
| DRM_INFO("[%s] in\n", __func__); |
| return component_add(&pdev->dev, &am_meson_hdmi_ops); |
| } |
| |
| static int am_meson_hdmi_remove(struct platform_device *pdev) |
| { |
| component_del(&pdev->dev, &am_meson_hdmi_ops); |
| return 0; |
| } |
| |
| static struct platform_driver am_meson_hdmi_pltfm_driver = { |
| .probe = am_meson_hdmi_probe, |
| .remove = am_meson_hdmi_remove, |
| .driver = { |
| .name = "meson-amhdmitx", |
| .of_match_table = am_meson_hdmi_dt_ids, |
| }, |
| }; |
| |
| module_platform_driver(am_meson_hdmi_pltfm_driver); |
| |
| MODULE_AUTHOR("MultiMedia Amlogic <multimedia-sh@amlogic.com>"); |
| MODULE_DESCRIPTION("Amlogic Meson Drm HDMI driver"); |
| MODULE_LICENSE("GPL"); |