| .. | .. |
|---|
| 11 | 11 | #include <linux/platform_device.h> |
|---|
| 12 | 12 | #include <linux/regmap.h> |
|---|
| 13 | 13 | #include <linux/regulator/consumer.h> |
|---|
| 14 | | -#include <drm/drm_crtc_helper.h> |
|---|
| 14 | + |
|---|
| 15 | 15 | #include <sound/hdmi-codec.h> |
|---|
| 16 | 16 | |
|---|
| 17 | 17 | #include <drm/drm_atomic_helper.h> |
|---|
| 18 | 18 | #include <drm/drm_bridge.h> |
|---|
| 19 | 19 | #include <drm/drm_mipi_dsi.h> |
|---|
| 20 | 20 | #include <drm/drm_print.h> |
|---|
| 21 | +#include <drm/drm_probe_helper.h> |
|---|
| 21 | 22 | |
|---|
| 22 | 23 | #define EDID_SEG_SIZE 256 |
|---|
| 23 | 24 | #define EDID_LEN 32 |
|---|
| .. | .. |
|---|
| 46 | 47 | struct gpio_desc *enable_gpio; |
|---|
| 47 | 48 | |
|---|
| 48 | 49 | bool power_on; |
|---|
| 50 | + bool sleep; |
|---|
| 49 | 51 | |
|---|
| 50 | 52 | struct regulator_bulk_data supplies[2]; |
|---|
| 51 | 53 | |
|---|
| .. | .. |
|---|
| 93 | 95 | { 1920, 1080, 60, 4, 1 }, /* 1080P 24bit 60Hz 4lane 1port */ |
|---|
| 94 | 96 | { 1920, 1080, 30, 3, 1 }, /* 1080P 24bit 30Hz 3lane 1port */ |
|---|
| 95 | 97 | { 1920, 1080, 24, 3, 1 }, |
|---|
| 96 | | - { 1280, 720, 60, 4, 1 }, |
|---|
| 97 | | - { 1280, 720, 30, 4, 1 }, |
|---|
| 98 | 98 | { 720, 480, 60, 4, 1 }, |
|---|
| 99 | 99 | { 720, 576, 50, 2, 1 }, |
|---|
| 100 | 100 | { 640, 480, 60, 2, 1 }, |
|---|
| .. | .. |
|---|
| 230 | 230 | case 640: |
|---|
| 231 | 231 | regmap_write(lt9611->regmap, 0x8326, 0x14); |
|---|
| 232 | 232 | break; |
|---|
| 233 | | - case 1280: |
|---|
| 234 | | - regmap_write(lt9611->regmap, 0x8326, 0x1c); |
|---|
| 235 | | - break; |
|---|
| 236 | 233 | case 1920: |
|---|
| 237 | | - if (drm_mode_vrefresh(mode) == 30) |
|---|
| 238 | | - regmap_write(lt9611->regmap, 0x8326, 0x1c); |
|---|
| 239 | | - else |
|---|
| 240 | | - regmap_write(lt9611->regmap, 0x8326, 0x37); |
|---|
| 234 | + regmap_write(lt9611->regmap, 0x8326, 0x37); |
|---|
| 241 | 235 | break; |
|---|
| 242 | 236 | case 3840: |
|---|
| 243 | 237 | regmap_multi_reg_write(lt9611->regmap, reg_cfg2, ARRAY_SIZE(reg_cfg2)); |
|---|
| .. | .. |
|---|
| 443 | 437 | regmap_write(lt9611->regmap, 0x8203, val); |
|---|
| 444 | 438 | regmap_write(lt9611->regmap, 0x8207, 0xff); /* clear */ |
|---|
| 445 | 439 | regmap_write(lt9611->regmap, 0x8207, 0x3f); |
|---|
| 440 | +} |
|---|
| 441 | + |
|---|
| 442 | +static void lt9611_sleep_setup(struct lt9611 *lt9611) |
|---|
| 443 | +{ |
|---|
| 444 | + const struct reg_sequence sleep_setup[] = { |
|---|
| 445 | + { 0x8024, 0x76 }, |
|---|
| 446 | + { 0x8023, 0x01 }, |
|---|
| 447 | + { 0x8157, 0x03 }, /* set addr pin as output */ |
|---|
| 448 | + { 0x8149, 0x0b }, |
|---|
| 449 | + { 0x8151, 0x30 }, /* disable IRQ */ |
|---|
| 450 | + { 0x8102, 0x48 }, /* MIPI Rx power down */ |
|---|
| 451 | + { 0x8123, 0x80 }, |
|---|
| 452 | + { 0x8130, 0x00 }, |
|---|
| 453 | + { 0x8100, 0x01 }, /* bandgap power down */ |
|---|
| 454 | + { 0x8101, 0x00 }, /* system clk power down */ |
|---|
| 455 | + }; |
|---|
| 456 | + |
|---|
| 457 | + regmap_multi_reg_write(lt9611->regmap, |
|---|
| 458 | + sleep_setup, ARRAY_SIZE(sleep_setup)); |
|---|
| 459 | + lt9611->sleep = true; |
|---|
| 446 | 460 | } |
|---|
| 447 | 461 | |
|---|
| 448 | 462 | static int lt9611_power_on(struct lt9611 *lt9611) |
|---|
| .. | .. |
|---|
| 762 | 776 | |
|---|
| 763 | 777 | dsi->lanes = 4; |
|---|
| 764 | 778 | dsi->format = MIPI_DSI_FMT_RGB888; |
|---|
| 765 | | - dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST; |
|---|
| 779 | + dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_SYNC_PULSE | |
|---|
| 780 | + MIPI_DSI_MODE_VIDEO_HSE; |
|---|
| 766 | 781 | |
|---|
| 767 | 782 | ret = mipi_dsi_attach(dsi); |
|---|
| 768 | 783 | if (ret < 0) { |
|---|
| .. | .. |
|---|
| 801 | 816 | |
|---|
| 802 | 817 | drm_connector_helper_add(<9611->connector, |
|---|
| 803 | 818 | <9611_bridge_connector_helper_funcs); |
|---|
| 804 | | - drm_connector_attach_encoder(<9611->connector, bridge->encoder); |
|---|
| 805 | 819 | |
|---|
| 806 | 820 | if (!bridge->encoder) { |
|---|
| 807 | 821 | DRM_ERROR("Parent encoder object not found"); |
|---|
| 808 | 822 | return -ENODEV; |
|---|
| 809 | 823 | } |
|---|
| 810 | 824 | |
|---|
| 825 | + drm_connector_attach_encoder(<9611->connector, bridge->encoder); |
|---|
| 826 | + |
|---|
| 811 | 827 | return 0; |
|---|
| 812 | 828 | } |
|---|
| 813 | 829 | |
|---|
| 814 | | -static int lt9611_bridge_attach(struct drm_bridge *bridge) |
|---|
| 830 | +static int lt9611_bridge_attach(struct drm_bridge *bridge, |
|---|
| 831 | + enum drm_bridge_attach_flags flags) |
|---|
| 815 | 832 | { |
|---|
| 816 | 833 | struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 817 | 834 | int ret; |
|---|
| 835 | + |
|---|
| 836 | + if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)) { |
|---|
| 837 | + ret = lt9611_connector_init(bridge, lt9611); |
|---|
| 838 | + if (ret < 0) |
|---|
| 839 | + return ret; |
|---|
| 840 | + } |
|---|
| 818 | 841 | |
|---|
| 819 | 842 | /* Attach primary DSI */ |
|---|
| 820 | 843 | lt9611->dsi0 = lt9611_attach_dsi(lt9611, lt9611->dsi0_node); |
|---|
| .. | .. |
|---|
| 830 | 853 | } |
|---|
| 831 | 854 | } |
|---|
| 832 | 855 | |
|---|
| 833 | | - ret = lt9611_connector_init(bridge, lt9611); |
|---|
| 834 | | - |
|---|
| 835 | | - return ret; |
|---|
| 856 | + return 0; |
|---|
| 836 | 857 | |
|---|
| 837 | 858 | err_unregister_dsi0: |
|---|
| 838 | 859 | lt9611_bridge_detach(bridge); |
|---|
| .. | .. |
|---|
| 843 | 864 | } |
|---|
| 844 | 865 | |
|---|
| 845 | 866 | static enum drm_mode_status lt9611_bridge_mode_valid(struct drm_bridge *bridge, |
|---|
| 867 | + const struct drm_display_info *info, |
|---|
| 846 | 868 | const struct drm_display_mode *mode) |
|---|
| 847 | 869 | { |
|---|
| 848 | 870 | struct lt9611_mode *lt9611_mode = lt9611_find_mode(mode); |
|---|
| 871 | + struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 849 | 872 | |
|---|
| 850 | | - return lt9611_mode ? MODE_OK : MODE_BAD; |
|---|
| 873 | + if (!lt9611_mode) |
|---|
| 874 | + return MODE_BAD; |
|---|
| 875 | + else if (lt9611_mode->intfs > 1 && !lt9611->dsi1) |
|---|
| 876 | + return MODE_PANEL; |
|---|
| 877 | + else |
|---|
| 878 | + return MODE_OK; |
|---|
| 851 | 879 | } |
|---|
| 852 | 880 | |
|---|
| 853 | 881 | static void lt9611_bridge_pre_enable(struct drm_bridge *bridge) |
|---|
| 854 | 882 | { |
|---|
| 855 | 883 | struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 856 | 884 | |
|---|
| 885 | + if (!lt9611->sleep) |
|---|
| 886 | + return; |
|---|
| 887 | + |
|---|
| 857 | 888 | lt9611_reset(lt9611); |
|---|
| 858 | 889 | regmap_write(lt9611->regmap, 0x80ee, 0x01); |
|---|
| 859 | | - lt9611_enable_hpd_interrupts(lt9611); |
|---|
| 860 | 890 | |
|---|
| 891 | + lt9611->sleep = false; |
|---|
| 861 | 892 | } |
|---|
| 862 | 893 | |
|---|
| 863 | 894 | static void lt9611_bridge_post_disable(struct drm_bridge *bridge) |
|---|
| 864 | 895 | { |
|---|
| 896 | + struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 897 | + |
|---|
| 898 | + lt9611_sleep_setup(lt9611); |
|---|
| 865 | 899 | } |
|---|
| 866 | 900 | |
|---|
| 867 | 901 | static void lt9611_bridge_mode_set(struct drm_bridge *bridge, |
|---|
| 868 | | - struct drm_display_mode *mode, |
|---|
| 869 | | - struct drm_display_mode *adj_mode) |
|---|
| 902 | + const struct drm_display_mode *mode, |
|---|
| 903 | + const struct drm_display_mode *adj_mode) |
|---|
| 870 | 904 | { |
|---|
| 871 | 905 | struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 872 | 906 | struct hdmi_avi_infoframe avi_frame; |
|---|
| .. | .. |
|---|
| 879 | 913 | lt9611_mipi_video_setup(lt9611, mode); |
|---|
| 880 | 914 | lt9611_pcr_setup(lt9611, mode); |
|---|
| 881 | 915 | |
|---|
| 882 | | - ret = drm_hdmi_avi_infoframe_from_display_mode(&avi_frame, mode, false); |
|---|
| 916 | + ret = drm_hdmi_avi_infoframe_from_display_mode(&avi_frame, |
|---|
| 917 | + <9611->connector, |
|---|
| 918 | + mode); |
|---|
| 883 | 919 | if (!ret) |
|---|
| 884 | 920 | lt9611->vic = avi_frame.video_code; |
|---|
| 921 | +} |
|---|
| 922 | + |
|---|
| 923 | +static enum drm_connector_status lt9611_bridge_detect(struct drm_bridge *bridge) |
|---|
| 924 | +{ |
|---|
| 925 | + struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 926 | + unsigned int reg_val = 0; |
|---|
| 927 | + int connected; |
|---|
| 928 | + |
|---|
| 929 | + regmap_read(lt9611->regmap, 0x825e, ®_val); |
|---|
| 930 | + connected = reg_val & BIT(2); |
|---|
| 931 | + |
|---|
| 932 | + lt9611->status = connected ? connector_status_connected : |
|---|
| 933 | + connector_status_disconnected; |
|---|
| 934 | + |
|---|
| 935 | + return lt9611->status; |
|---|
| 936 | +} |
|---|
| 937 | + |
|---|
| 938 | +static struct edid *lt9611_bridge_get_edid(struct drm_bridge *bridge, |
|---|
| 939 | + struct drm_connector *connector) |
|---|
| 940 | +{ |
|---|
| 941 | + struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 942 | + |
|---|
| 943 | + lt9611_power_on(lt9611); |
|---|
| 944 | + return drm_do_get_edid(connector, lt9611_get_edid_block, lt9611); |
|---|
| 945 | +} |
|---|
| 946 | + |
|---|
| 947 | +static void lt9611_bridge_hpd_enable(struct drm_bridge *bridge) |
|---|
| 948 | +{ |
|---|
| 949 | + struct lt9611 *lt9611 = bridge_to_lt9611(bridge); |
|---|
| 950 | + |
|---|
| 951 | + lt9611_enable_hpd_interrupts(lt9611); |
|---|
| 885 | 952 | } |
|---|
| 886 | 953 | |
|---|
| 887 | 954 | static const struct drm_bridge_funcs lt9611_bridge_funcs = { |
|---|
| .. | .. |
|---|
| 892 | 959 | .disable = lt9611_bridge_disable, |
|---|
| 893 | 960 | .post_disable = lt9611_bridge_post_disable, |
|---|
| 894 | 961 | .mode_set = lt9611_bridge_mode_set, |
|---|
| 962 | + .detect = lt9611_bridge_detect, |
|---|
| 963 | + .get_edid = lt9611_bridge_get_edid, |
|---|
| 964 | + .hpd_enable = lt9611_bridge_hpd_enable, |
|---|
| 895 | 965 | }; |
|---|
| 896 | 966 | |
|---|
| 897 | 967 | static int lt9611_parse_dt(struct device *dev, |
|---|
| .. | .. |
|---|
| 1058 | 1128 | |
|---|
| 1059 | 1129 | lt9611->dev = &client->dev; |
|---|
| 1060 | 1130 | lt9611->client = client; |
|---|
| 1131 | + lt9611->sleep = false; |
|---|
| 1061 | 1132 | |
|---|
| 1062 | 1133 | lt9611->regmap = devm_regmap_init_i2c(client, <9611_regmap_config); |
|---|
| 1063 | 1134 | if (IS_ERR(lt9611->regmap)) { |
|---|
| .. | .. |
|---|
| 1095 | 1166 | |
|---|
| 1096 | 1167 | ret = devm_request_threaded_irq(dev, client->irq, NULL, |
|---|
| 1097 | 1168 | lt9611_irq_thread_handler, |
|---|
| 1098 | | - IRQF_TRIGGER_FALLING | IRQF_ONESHOT, |
|---|
| 1099 | | - "lt9611", lt9611); |
|---|
| 1169 | + IRQF_ONESHOT, "lt9611", lt9611); |
|---|
| 1100 | 1170 | if (ret) { |
|---|
| 1101 | 1171 | dev_err(dev, "failed to request irq\n"); |
|---|
| 1102 | 1172 | goto err_disable_regulators; |
|---|
| .. | .. |
|---|
| 1106 | 1176 | |
|---|
| 1107 | 1177 | lt9611->bridge.funcs = <9611_bridge_funcs; |
|---|
| 1108 | 1178 | lt9611->bridge.of_node = client->dev.of_node; |
|---|
| 1179 | + lt9611->bridge.ops = DRM_BRIDGE_OP_DETECT | DRM_BRIDGE_OP_EDID | |
|---|
| 1180 | + DRM_BRIDGE_OP_HPD | DRM_BRIDGE_OP_MODES; |
|---|
| 1181 | + lt9611->bridge.type = DRM_MODE_CONNECTOR_HDMIA; |
|---|
| 1109 | 1182 | |
|---|
| 1110 | 1183 | drm_bridge_add(<9611->bridge); |
|---|
| 1111 | 1184 | |
|---|