|
7 | 7 |
|
8 | 8 | #include <drm/drm_atomic_helper.h> |
9 | 9 | #include <drm/drm_atomic.h> |
| 10 | +#if defined(__arm__) || defined(__aarch64__) |
10 | 11 | #include <asm/neon.h> |
| 12 | +#endif |
11 | 13 | #include <linux/delay.h> |
12 | 14 | #include "phytium_display_drv.h" |
13 | 15 | #include "pe220x_reg.h" |
@@ -56,6 +58,10 @@ static const unsigned int pe220x_primary_formats[] = { |
56 | 58 | DRM_FORMAT_NV21, |
57 | 59 | }; |
58 | 60 |
|
| 61 | +static const unsigned int pe220x_bmc_primary_formats[] = { |
| 62 | + DRM_FORMAT_XRGB8888, |
| 63 | +}; |
| 64 | + |
59 | 65 | static uint64_t pe220x_primary_formats_modifiers[] = { |
60 | 66 | DRM_FORMAT_MOD_LINEAR, |
61 | 67 | DRM_FORMAT_MOD_INVALID |
@@ -109,49 +115,76 @@ void pe220x_dc_hw_reset(struct drm_crtc *crtc) |
109 | 115 | int config = 0; |
110 | 116 | int phys_pipe = phytium_crtc->phys_pipe; |
111 | 117 |
|
112 | | - /* disable pixel clock for bmc mode */ |
113 | | - if (phys_pipe == 0) |
114 | | - pe220x_dc_hw_disable(crtc); |
115 | | - |
116 | 118 | config = phytium_readl_reg(priv, 0, PE220X_DC_CLOCK_CONTROL); |
117 | | - config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); |
118 | 119 |
|
119 | | - if (phys_pipe == 0) { |
120 | | - phytium_writel_reg(priv, config | DC0_CORE_RESET, |
121 | | - 0, PE220X_DC_CLOCK_CONTROL); |
122 | | - udelay(20); |
123 | | - phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, |
124 | | - 0, PE220X_DC_CLOCK_CONTROL); |
125 | | - udelay(20); |
126 | | - phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, |
127 | | - 0, PE220X_DC_CLOCK_CONTROL); |
128 | | - udelay(20); |
129 | | - phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, |
130 | | - 0, PE220X_DC_CLOCK_CONTROL); |
131 | | - udelay(20); |
132 | | - phytium_writel_reg(priv, config | DC0_CORE_RESET, |
133 | | - 0, PE220X_DC_CLOCK_CONTROL); |
134 | | - udelay(20); |
135 | | - phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
136 | | - udelay(20); |
| 120 | + if (priv->info.bmc_mode) { |
| 121 | + pe220x_dc_hw_disable(crtc); |
| 122 | + config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AHB_RESET)); |
| 123 | + if (phys_pipe == 0) { |
| 124 | + phytium_writel_reg(priv, config | DC0_CORE_RESET, |
| 125 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 126 | + udelay(20); |
| 127 | + phytium_writel_reg(priv, config | DC0_CORE_RESET | AHB_RESET, |
| 128 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 129 | + udelay(20); |
| 130 | + phytium_writel_reg(priv, config | DC0_CORE_RESET, |
| 131 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 132 | + udelay(20); |
| 133 | + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
| 134 | + udelay(20); |
| 135 | + } else { |
| 136 | + phytium_writel_reg(priv, config | DC1_CORE_RESET, |
| 137 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 138 | + udelay(20); |
| 139 | + phytium_writel_reg(priv, config | DC1_CORE_RESET | AHB_RESET, |
| 140 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 141 | + udelay(20); |
| 142 | + phytium_writel_reg(priv, config | DC1_CORE_RESET, |
| 143 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 144 | + udelay(20); |
| 145 | + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
| 146 | + udelay(20); |
| 147 | + } |
| 148 | + |
137 | 149 | } else { |
138 | | - phytium_writel_reg(priv, config | DC1_CORE_RESET, |
139 | | - 0, PE220X_DC_CLOCK_CONTROL); |
140 | | - udelay(20); |
141 | | - phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, |
142 | | - 0, PE220X_DC_CLOCK_CONTROL); |
143 | | - udelay(20); |
144 | | - phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, |
145 | | - 0, PE220X_DC_CLOCK_CONTROL); |
146 | | - udelay(20); |
147 | | - phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, |
148 | | - 0, PE220X_DC_CLOCK_CONTROL); |
149 | | - udelay(20); |
150 | | - phytium_writel_reg(priv, config | DC1_CORE_RESET, |
151 | | - 0, PE220X_DC_CLOCK_CONTROL); |
152 | | - udelay(20); |
153 | | - phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
154 | | - udelay(20); |
| 150 | + config &= (~(DC0_CORE_RESET | DC1_CORE_RESET | AXI_RESET | AHB_RESET)); |
| 151 | + if (phys_pipe == 0) { |
| 152 | + phytium_writel_reg(priv, config | DC0_CORE_RESET, |
| 153 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 154 | + udelay(20); |
| 155 | + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, |
| 156 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 157 | + udelay(20); |
| 158 | + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET | AHB_RESET, |
| 159 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 160 | + udelay(20); |
| 161 | + phytium_writel_reg(priv, config | DC0_CORE_RESET | AXI_RESET, |
| 162 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 163 | + udelay(20); |
| 164 | + phytium_writel_reg(priv, config | DC0_CORE_RESET, |
| 165 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 166 | + udelay(20); |
| 167 | + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
| 168 | + udelay(20); |
| 169 | + } else { |
| 170 | + phytium_writel_reg(priv, config | DC1_CORE_RESET, |
| 171 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 172 | + udelay(20); |
| 173 | + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, |
| 174 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 175 | + udelay(20); |
| 176 | + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET | AHB_RESET, |
| 177 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 178 | + udelay(20); |
| 179 | + phytium_writel_reg(priv, config | DC1_CORE_RESET | AXI_RESET, |
| 180 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 181 | + udelay(20); |
| 182 | + phytium_writel_reg(priv, config | DC1_CORE_RESET, |
| 183 | + 0, PE220X_DC_CLOCK_CONTROL); |
| 184 | + udelay(20); |
| 185 | + phytium_writel_reg(priv, config, 0, PE220X_DC_CLOCK_CONTROL); |
| 186 | + udelay(20); |
| 187 | + } |
155 | 188 | } |
156 | 189 | } |
157 | 190 |
|
@@ -216,6 +249,15 @@ void pe220x_dc_hw_plane_get_primary_format(const uint64_t **format_modifiers, |
216 | 249 | *format_count = ARRAY_SIZE(pe220x_primary_formats); |
217 | 250 | } |
218 | 251 |
|
| 252 | +void pe220x_dc_bmc_hw_plane_get_primary_format(const uint64_t **format_modifiers, |
| 253 | + const uint32_t **formats, |
| 254 | + uint32_t *format_count) |
| 255 | +{ |
| 256 | + *format_modifiers = pe220x_primary_formats_modifiers; |
| 257 | + *formats = pe220x_bmc_primary_formats; |
| 258 | + *format_count = ARRAY_SIZE(pe220x_bmc_primary_formats); |
| 259 | +} |
| 260 | + |
219 | 261 | void pe220x_dc_hw_plane_get_cursor_format(const uint64_t **format_modifiers, |
220 | 262 | const uint32_t **formats, |
221 | 263 | uint32_t *format_count) |
|
0 commit comments