1 /* 2 * (C) Copyright 2008-2017 Fuzhou Rockchip Electronics Co., Ltd 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 */ 6 7 #include <common.h> 8 #include <dm/of_access.h> 9 #include <errno.h> 10 #include <syscon.h> 11 #include <regmap.h> 12 #include <dm/device.h> 13 #include <dm/read.h> 14 #include <dm/pinctrl.h> 15 #include <linux/media-bus-format.h> 16 17 #include "rockchip_display.h" 18 #include "rockchip_crtc.h" 19 #include "rockchip_connector.h" 20 #include "rockchip_phy.h" 21 22 #define HIWORD_UPDATE(v, h, l) (((v) << (l)) | (GENMASK(h, l) << 16)) 23 24 #define PX30_GRF_PD_VO_CON1 0x0438 25 #define PX30_RGB_DATA_SYNC_BYPASS(v) HIWORD_UPDATE(v, 3, 3) 26 #define PX30_RGB_VOP_SEL(v) HIWORD_UPDATE(v, 2, 2) 27 28 #define RK1808_GRF_PD_VO_CON1 0x0444 29 #define RK1808_RGB_DATA_SYNC_BYPASS(v) HIWORD_UPDATE(v, 3, 3) 30 31 #define RV1126_GRF_IOFUNC_CON3 0x1026c 32 #define RV1126_LCDC_IO_BYPASS(v) HIWORD_UPDATE(v, 0, 0) 33 34 #define RK3288_GRF_SOC_CON6 0x025c 35 #define RK3288_LVDS_LCDC_SEL(v) HIWORD_UPDATE(v, 3, 3) 36 #define RK3288_GRF_SOC_CON7 0x0260 37 #define RK3288_LVDS_PWRDWN(v) HIWORD_UPDATE(v, 15, 15) 38 #define RK3288_LVDS_CON_ENABLE_2(v) HIWORD_UPDATE(v, 12, 12) 39 #define RK3288_LVDS_CON_ENABLE_1(v) HIWORD_UPDATE(v, 11, 11) 40 #define RK3288_LVDS_CON_CLKINV(v) HIWORD_UPDATE(v, 8, 8) 41 #define RK3288_LVDS_CON_TTL_EN(v) HIWORD_UPDATE(v, 6, 6) 42 43 #define RK3368_GRF_SOC_CON15 0x043c 44 #define RK3368_FORCE_JETAG(v) HIWORD_UPDATE(v, 13, 13) 45 46 struct rockchip_rgb; 47 48 struct rockchip_rgb_funcs { 49 void (*prepare)(struct rockchip_rgb *rgb, int pipe); 50 void (*unprepare)(struct rockchip_rgb *rgb); 51 }; 52 53 struct rockchip_rgb { 54 int id; 55 struct udevice *dev; 56 struct regmap *grf; 57 bool data_sync_bypass; 58 struct rockchip_phy *phy; 59 const struct rockchip_rgb_funcs *funcs; 60 }; 61 62 static inline struct rockchip_rgb *state_to_rgb(struct display_state *state) 63 { 64 struct connector_state *conn_state = &state->conn_state; 65 66 return dev_get_priv(conn_state->dev); 67 } 68 69 static int rockchip_rgb_connector_prepare(struct display_state *state) 70 { 71 struct rockchip_rgb *rgb = state_to_rgb(state); 72 struct crtc_state *crtc_state = &state->crtc_state; 73 int pipe = crtc_state->crtc_id; 74 int ret; 75 76 pinctrl_select_state(rgb->dev, "default"); 77 78 if (rgb->funcs && rgb->funcs->prepare) 79 rgb->funcs->prepare(rgb, pipe); 80 81 if (rgb->phy) { 82 ret = rockchip_phy_set_mode(rgb->phy, PHY_MODE_VIDEO_TTL); 83 if (ret) { 84 dev_err(rgb->dev, "failed to set phy mode: %d\n", ret); 85 return ret; 86 } 87 88 rockchip_phy_power_on(rgb->phy); 89 } 90 91 return 0; 92 } 93 94 static void rockchip_rgb_connector_unprepare(struct display_state *state) 95 { 96 struct rockchip_rgb *rgb = state_to_rgb(state); 97 98 if (rgb->phy) 99 rockchip_phy_power_off(rgb->phy); 100 101 if (rgb->funcs && rgb->funcs->unprepare) 102 rgb->funcs->unprepare(rgb); 103 104 pinctrl_select_state(rgb->dev, "sleep"); 105 } 106 107 static int rockchip_rgb_connector_pre_init(struct display_state *state) 108 { 109 struct connector_state *conn_state = &state->conn_state; 110 111 conn_state->type = DRM_MODE_CONNECTOR_LVDS; 112 113 return 0; 114 } 115 116 static int rockchip_rgb_connector_init(struct display_state *state) 117 { 118 struct rockchip_rgb *rgb = state_to_rgb(state); 119 struct connector_state *conn_state = &state->conn_state; 120 121 rgb->phy = conn_state->phy; 122 123 conn_state->color_space = V4L2_COLORSPACE_DEFAULT; 124 conn_state->disp_info = rockchip_get_disp_info(conn_state->type, rgb->id); 125 126 switch (conn_state->bus_format) { 127 case MEDIA_BUS_FMT_RGB666_1X18: 128 conn_state->output_mode = ROCKCHIP_OUT_MODE_P666; 129 break; 130 case MEDIA_BUS_FMT_RGB565_1X16: 131 conn_state->output_mode = ROCKCHIP_OUT_MODE_P565; 132 break; 133 case MEDIA_BUS_FMT_SRGB888_3X8: 134 case MEDIA_BUS_FMT_SBGR888_3X8: 135 case MEDIA_BUS_FMT_SRBG888_3X8: 136 conn_state->output_mode = ROCKCHIP_OUT_MODE_S888; 137 break; 138 case MEDIA_BUS_FMT_SRGB888_DUMMY_4X8: 139 case MEDIA_BUS_FMT_SBGR888_DUMMY_4X8: 140 case MEDIA_BUS_FMT_SRBG888_DUMMY_4X8: 141 conn_state->output_mode = ROCKCHIP_OUT_MODE_S888_DUMMY; 142 break; 143 case MEDIA_BUS_FMT_RGB888_1X24: 144 case MEDIA_BUS_FMT_RGB666_1X24_CPADHI: 145 default: 146 conn_state->output_mode = ROCKCHIP_OUT_MODE_P888; 147 break; 148 } 149 150 return 0; 151 } 152 153 static const struct rockchip_connector_funcs rockchip_rgb_connector_funcs = { 154 .pre_init = rockchip_rgb_connector_pre_init, 155 .init = rockchip_rgb_connector_init, 156 .prepare = rockchip_rgb_connector_prepare, 157 .unprepare = rockchip_rgb_connector_unprepare, 158 }; 159 160 static int rockchip_rgb_probe(struct udevice *dev) 161 { 162 struct rockchip_rgb *rgb = dev_get_priv(dev); 163 const struct rockchip_connector *connector = 164 (const struct rockchip_connector *)dev_get_driver_data(dev); 165 166 rgb->dev = dev; 167 rgb->funcs = connector->data; 168 rgb->grf = syscon_get_regmap(dev_get_parent(dev)); 169 rgb->data_sync_bypass = dev_read_bool(dev, "rockchip,data-sync-bypass"); 170 rgb->id = of_alias_get_id(ofnode_to_np(dev->node), "rgb"); 171 if (rgb->id < 0) 172 rgb->id = 0; 173 174 return 0; 175 } 176 177 static void rv1126_rgb_prepare(struct rockchip_rgb *rgb, int pipe) 178 { 179 regmap_write(rgb->grf, RV1126_GRF_IOFUNC_CON3, 180 RV1126_LCDC_IO_BYPASS(rgb->data_sync_bypass)); 181 } 182 183 static const struct rockchip_rgb_funcs rv1126_rgb_funcs = { 184 .prepare = rv1126_rgb_prepare, 185 }; 186 187 static const struct rockchip_connector rv1126_rgb_driver_data = { 188 .funcs = &rockchip_rgb_connector_funcs, 189 .data = &rv1126_rgb_funcs, 190 }; 191 192 static void px30_rgb_prepare(struct rockchip_rgb *rgb, int pipe) 193 { 194 regmap_write(rgb->grf, PX30_GRF_PD_VO_CON1, PX30_RGB_VOP_SEL(pipe) | 195 PX30_RGB_DATA_SYNC_BYPASS(rgb->data_sync_bypass)); 196 } 197 198 static const struct rockchip_rgb_funcs px30_rgb_funcs = { 199 .prepare = px30_rgb_prepare, 200 }; 201 202 static const struct rockchip_connector px30_rgb_driver_data = { 203 .funcs = &rockchip_rgb_connector_funcs, 204 .data = &px30_rgb_funcs, 205 }; 206 207 static void rk1808_rgb_prepare(struct rockchip_rgb *rgb, int pipe) 208 { 209 regmap_write(rgb->grf, RK1808_GRF_PD_VO_CON1, 210 RK1808_RGB_DATA_SYNC_BYPASS(rgb->data_sync_bypass)); 211 } 212 213 static const struct rockchip_rgb_funcs rk1808_rgb_funcs = { 214 .prepare = rk1808_rgb_prepare, 215 }; 216 217 static const struct rockchip_connector rk1808_rgb_driver_data = { 218 .funcs = &rockchip_rgb_connector_funcs, 219 .data = &rk1808_rgb_funcs, 220 }; 221 222 static void rk3288_rgb_prepare(struct rockchip_rgb *rgb, int pipe) 223 { 224 regmap_write(rgb->grf, RK3288_GRF_SOC_CON6, RK3288_LVDS_LCDC_SEL(pipe)); 225 regmap_write(rgb->grf, RK3288_GRF_SOC_CON7, 226 RK3288_LVDS_PWRDWN(0) | RK3288_LVDS_CON_ENABLE_2(1) | 227 RK3288_LVDS_CON_ENABLE_1(1) | RK3288_LVDS_CON_CLKINV(0) | 228 RK3288_LVDS_CON_TTL_EN(1)); 229 } 230 231 static void rk3288_rgb_unprepare(struct rockchip_rgb *rgb) 232 { 233 regmap_write(rgb->grf, RK3288_GRF_SOC_CON7, 234 RK3288_LVDS_PWRDWN(1) | RK3288_LVDS_CON_ENABLE_2(0) | 235 RK3288_LVDS_CON_ENABLE_1(0) | RK3288_LVDS_CON_TTL_EN(0)); 236 } 237 238 static const struct rockchip_rgb_funcs rk3288_rgb_funcs = { 239 .prepare = rk3288_rgb_prepare, 240 .unprepare = rk3288_rgb_unprepare, 241 }; 242 243 static const struct rockchip_connector rk3288_rgb_driver_data = { 244 .funcs = &rockchip_rgb_connector_funcs, 245 .data = &rk3288_rgb_funcs, 246 }; 247 248 static void rk3368_rgb_prepare(struct rockchip_rgb *rgb, int pipe) 249 { 250 regmap_write(rgb->grf, RK3368_GRF_SOC_CON15, RK3368_FORCE_JETAG(0)); 251 } 252 253 static const struct rockchip_rgb_funcs rk3368_rgb_funcs = { 254 .prepare = rk3368_rgb_prepare, 255 }; 256 257 static const struct rockchip_connector rk3368_rgb_driver_data = { 258 .funcs = &rockchip_rgb_connector_funcs, 259 .data = &rk3368_rgb_funcs, 260 }; 261 262 static const struct rockchip_connector rockchip_rgb_driver_data = { 263 .funcs = &rockchip_rgb_connector_funcs, 264 }; 265 266 static const struct udevice_id rockchip_rgb_ids[] = { 267 { 268 .compatible = "rockchip,px30-rgb", 269 .data = (ulong)&px30_rgb_driver_data, 270 }, 271 { 272 .compatible = "rockchip,rk1808-rgb", 273 .data = (ulong)&rk1808_rgb_driver_data, 274 }, 275 { 276 .compatible = "rockchip,rk3066-rgb", 277 .data = (ulong)&rockchip_rgb_driver_data, 278 }, 279 { 280 .compatible = "rockchip,rk3128-rgb", 281 .data = (ulong)&rockchip_rgb_driver_data, 282 }, 283 { 284 .compatible = "rockchip,rk3288-rgb", 285 .data = (ulong)&rk3288_rgb_driver_data, 286 }, 287 { 288 .compatible = "rockchip,rk3308-rgb", 289 .data = (ulong)&rockchip_rgb_driver_data, 290 }, 291 { 292 .compatible = "rockchip,rk3368-rgb", 293 .data = (ulong)&rk3368_rgb_driver_data, 294 }, 295 { 296 .compatible = "rockchip,rv1108-rgb", 297 .data = (ulong)&rockchip_rgb_driver_data, 298 }, 299 { 300 .compatible = "rockchip,rv1126-rgb", 301 .data = (ulong)&rv1126_rgb_driver_data, 302 }, 303 {} 304 }; 305 306 U_BOOT_DRIVER(rockchip_rgb) = { 307 .name = "rockchip_rgb", 308 .id = UCLASS_DISPLAY, 309 .of_match = rockchip_rgb_ids, 310 .probe = rockchip_rgb_probe, 311 .priv_auto_alloc_size = sizeof(struct rockchip_rgb), 312 }; 313