1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2021 Rockchip Electronics Co. Ltd.
4 *
5 * Author: Guochun Huang <hero.huang@rock-chips.com>
6 */
7
8 #include "rk628.h"
9
10 #include "rk628_combtxphy.h"
11 #include "rk628_config.h"
12 #include "panel.h"
13
lvds_write(struct rk628 * rk628,u32 reg,u32 val)14 static inline void lvds_write(struct rk628 *rk628, u32 reg, u32 val)
15 {
16 rk628_i2c_write(rk628, reg, val);
17 }
18
lvds_update_bits(struct rk628 * rk628,u32 reg,u32 mask,u32 val)19 static inline void lvds_update_bits(struct rk628 *rk628, u32 reg,
20 u32 mask, u32 val)
21 {
22 rk628_i2c_update_bits(rk628, reg, mask, val);
23 }
24
rk628_lvds_parse(struct rk628 * rk628,struct device_node * lvds_np)25 int rk628_lvds_parse(struct rk628 *rk628, struct device_node *lvds_np)
26 {
27 const char *string;
28 int ret;
29
30 if (!of_device_is_available(lvds_np))
31 return -EINVAL;
32
33 rk628->output_mode = OUTPUT_MODE_LVDS;
34
35 if (!of_property_read_string(lvds_np, "bus-format", &string)) {
36 if (!strcmp(string, "jeida_24"))
37 rk628->lvds.format = LVDS_FORMAT_JEIDA_24BIT;
38 else if (!strcmp(string, "jeida_18"))
39 rk628->lvds.format = LVDS_FORMAT_JEIDA_18BIT;
40 else if (!strcmp(string, "vesa_18"))
41 rk628->lvds.format = LVDS_FORMAT_VESA_18BIT;
42 else
43 rk628->lvds.format = LVDS_FORMAT_VESA_24BIT;
44 }
45
46 if (!of_property_read_string(lvds_np, "link-type", &string)) {
47 if (!strcmp(string, "dual_link_odd_even_pixels"))
48 rk628->lvds.link_type = LVDS_DUAL_LINK_ODD_EVEN_PIXELS;
49 else if (!strcmp(string, "dual_link_even_odd_pixels"))
50 rk628->lvds.link_type = LVDS_DUAL_LINK_EVEN_ODD_PIXELS;
51 else if (!strcmp(string, "dual_link_left_right_pixels"))
52 rk628->lvds.link_type = LVDS_DUAL_LINK_LEFT_RIGHT_PIXELS;
53 else if (!strcmp(string, "dual_link_right_left_pixels"))
54 rk628->lvds.link_type = LVDS_DUAL_LINK_RIGHT_LEFT_PIXELS;
55 else
56 rk628->lvds.link_type = LVDS_SINGLE_LINK;
57 }
58
59 ret = rk628_panel_info_get(rk628, lvds_np);
60 if (ret)
61 return ret;
62
63 return 0;
64 }
65
rk628_lvds_enable(struct rk628 * rk628)66 void rk628_lvds_enable(struct rk628 *rk628)
67 {
68 enum lvds_link_type link_type = rk628->lvds.link_type;
69 enum lvds_format format = rk628->lvds.format;
70 const struct rk628_display_mode *mode = &rk628->dst_mode;
71 u32 val, bus_width;
72
73 lvds_update_bits(rk628, GRF_SYSTEM_CON0, SW_OUTPUT_MODE_MASK,
74 SW_OUTPUT_MODE(OUTPUT_MODE_LVDS));
75
76 switch (link_type) {
77 case LVDS_DUAL_LINK_ODD_EVEN_PIXELS:
78 val = SW_LVDS_CON_CHASEL(1) | SW_LVDS_CON_STARTSEL(0) |
79 SW_LVDS_CON_DUAL_SEL(0);
80 bus_width = COMBTXPHY_MODULEA_EN | COMBTXPHY_MODULEB_EN;
81 break;
82 case LVDS_DUAL_LINK_EVEN_ODD_PIXELS:
83 val = SW_LVDS_CON_CHASEL(1) | SW_LVDS_CON_STARTSEL(1) |
84 SW_LVDS_CON_DUAL_SEL(0);
85 bus_width = COMBTXPHY_MODULEA_EN | COMBTXPHY_MODULEB_EN;
86 break;
87 case LVDS_DUAL_LINK_LEFT_RIGHT_PIXELS:
88 val = SW_LVDS_CON_CHASEL(1) | SW_LVDS_CON_STARTSEL(0) |
89 SW_LVDS_CON_DUAL_SEL(1);
90 lvds_update_bits(rk628, GRF_POST_PROC_CON,
91 SW_SPLIT_EN, SW_SPLIT_EN);
92 bus_width = COMBTXPHY_MODULEA_EN | COMBTXPHY_MODULEB_EN;
93 break;
94 case LVDS_DUAL_LINK_RIGHT_LEFT_PIXELS:
95 val = SW_LVDS_CON_CHASEL(1) | SW_LVDS_CON_STARTSEL(1) |
96 SW_LVDS_CON_DUAL_SEL(1);
97 lvds_update_bits(rk628, GRF_POST_PROC_CON,
98 SW_SPLIT_EN, SW_SPLIT_EN);
99 bus_width = COMBTXPHY_MODULEA_EN | COMBTXPHY_MODULEB_EN;
100 break;
101 case LVDS_SINGLE_LINK:
102 default:
103 val = SW_LVDS_CON_CHASEL(0) | SW_LVDS_CON_STARTSEL(0) |
104 SW_LVDS_CON_DUAL_SEL(0);
105 bus_width = COMBTXPHY_MODULEA_EN;
106 break;
107 }
108
109 val |= SW_LVDS_CON_SELECT(format) | SW_LVDS_CON_MSBSEL(0) |
110 SW_LVDS_CON_CLKINV(0);
111 lvds_write(rk628, GRF_LVDS_TX_CON, val);
112
113 bus_width |= (mode->clock / 1000) << 8;
114 rk628_combtxphy_set_bus_width(rk628, bus_width);
115 rk628_combtxphy_set_mode(rk628, PHY_MODE_VIDEO_LVDS);
116 rk628_combtxphy_power_on(rk628);
117 rk628_panel_prepare(rk628);
118 rk628_panel_enable(rk628);
119 }
120
rk628_lvds_disable(struct rk628 * rk628)121 void rk628_lvds_disable(struct rk628 *rk628)
122 {
123 rk628_panel_disable(rk628);
124 rk628_panel_unprepare(rk628);
125 rk628_combtxphy_power_off(rk628);
126 }
127