1// SPDX-License-Identifier: GPL-2.0-only 2/* 3 * Copyright (c) 2015, The Linux Foundation. All rights reserved. 4 */ 5 6#include "drm/drm_bridge_connector.h" 7 8#include "msm_kms.h" 9#include "dsi.h" 10 11#define DSI_CLOCK_MASTER DSI_0 12#define DSI_CLOCK_SLAVE DSI_1 13 14#define DSI_LEFT DSI_0 15#define DSI_RIGHT DSI_1 16 17/* According to the current drm framework sequence, take the encoder of 18 * DSI_1 as master encoder 19 */ 20#define DSI_ENCODER_MASTER DSI_1 21#define DSI_ENCODER_SLAVE DSI_0 22 23struct msm_dsi_manager { 24 struct msm_dsi *dsi[DSI_MAX]; 25 26 bool is_bonded_dsi; 27 bool is_sync_needed; 28 int master_dsi_link_id; 29}; 30 31static struct msm_dsi_manager msm_dsim_glb; 32 33#define IS_BONDED_DSI() (msm_dsim_glb.is_bonded_dsi) 34#define IS_SYNC_NEEDED() (msm_dsim_glb.is_sync_needed) 35#define IS_MASTER_DSI_LINK(id) (msm_dsim_glb.master_dsi_link_id == id) 36 37static inline struct msm_dsi *dsi_mgr_get_dsi(int id) 38{ 39 return msm_dsim_glb.dsi[id]; 40} 41 42static inline struct msm_dsi *dsi_mgr_get_other_dsi(int id) 43{ 44 return msm_dsim_glb.dsi[(id + 1) % DSI_MAX]; 45} 46 47static int dsi_mgr_parse_of(struct device_node *np, int id) 48{ 49 struct msm_dsi_manager *msm_dsim = &msm_dsim_glb; 50 51 /* We assume 2 dsi nodes have the same information of bonded dsi and 52 * sync-mode, and only one node specifies master in case of bonded mode. 53 */ 54 if (!msm_dsim->is_bonded_dsi) 55 msm_dsim->is_bonded_dsi = of_property_read_bool(np, "qcom,dual-dsi-mode"); 56 57 if (msm_dsim->is_bonded_dsi) { 58 if (of_property_read_bool(np, "qcom,master-dsi")) 59 msm_dsim->master_dsi_link_id = id; 60 if (!msm_dsim->is_sync_needed) 61 msm_dsim->is_sync_needed = of_property_read_bool( 62 np, "qcom,sync-dual-dsi"); 63 } 64 65 return 0; 66} 67 68static int dsi_mgr_setup_components(int id) 69{ 70 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 71 struct msm_dsi *other_dsi = dsi_mgr_get_other_dsi(id); 72 struct msm_dsi *clk_master_dsi = dsi_mgr_get_dsi(DSI_CLOCK_MASTER); 73 struct msm_dsi *clk_slave_dsi = dsi_mgr_get_dsi(DSI_CLOCK_SLAVE); 74 int ret; 75 76 if (!IS_BONDED_DSI()) { 77 ret = msm_dsi_host_register(msm_dsi->host); 78 if (ret) 79 return ret; 80 81 msm_dsi_phy_set_usecase(msm_dsi->phy, MSM_DSI_PHY_STANDALONE); 82 msm_dsi_host_set_phy_mode(msm_dsi->host, msm_dsi->phy); 83 } else if (other_dsi) { 84 struct msm_dsi *master_link_dsi = IS_MASTER_DSI_LINK(id) ? 85 msm_dsi : other_dsi; 86 struct msm_dsi *slave_link_dsi = IS_MASTER_DSI_LINK(id) ? 87 other_dsi : msm_dsi; 88 /* Register slave host first, so that slave DSI device 89 * has a chance to probe, and do not block the master 90 * DSI device's probe. 91 * Also, do not check defer for the slave host, 92 * because only master DSI device adds the panel to global 93 * panel list. The panel's device is the master DSI device. 94 */ 95 ret = msm_dsi_host_register(slave_link_dsi->host); 96 if (ret) 97 return ret; 98 ret = msm_dsi_host_register(master_link_dsi->host); 99 if (ret) 100 return ret; 101 102 /* PLL0 is to drive both 2 DSI link clocks in bonded DSI mode. */ 103 msm_dsi_phy_set_usecase(clk_master_dsi->phy, 104 MSM_DSI_PHY_MASTER); 105 msm_dsi_phy_set_usecase(clk_slave_dsi->phy, 106 MSM_DSI_PHY_SLAVE); 107 msm_dsi_host_set_phy_mode(msm_dsi->host, msm_dsi->phy); 108 msm_dsi_host_set_phy_mode(other_dsi->host, other_dsi->phy); 109 } 110 111 return 0; 112} 113 114static int enable_phy(struct msm_dsi *msm_dsi, 115 struct msm_dsi_phy_shared_timings *shared_timings) 116{ 117 struct msm_dsi_phy_clk_request clk_req; 118 bool is_bonded_dsi = IS_BONDED_DSI(); 119 120 msm_dsi_host_get_phy_clk_req(msm_dsi->host, &clk_req, is_bonded_dsi); 121 122 return msm_dsi_phy_enable(msm_dsi->phy, &clk_req, shared_timings); 123} 124 125static int 126dsi_mgr_phy_enable(int id, 127 struct msm_dsi_phy_shared_timings shared_timings[DSI_MAX]) 128{ 129 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 130 struct msm_dsi *mdsi = dsi_mgr_get_dsi(DSI_CLOCK_MASTER); 131 struct msm_dsi *sdsi = dsi_mgr_get_dsi(DSI_CLOCK_SLAVE); 132 int ret; 133 134 /* In case of bonded DSI, some registers in PHY1 have been programmed 135 * during PLL0 clock's set_rate. The PHY1 reset called by host1 here 136 * will silently reset those PHY1 registers. Therefore we need to reset 137 * and enable both PHYs before any PLL clock operation. 138 */ 139 if (IS_BONDED_DSI() && mdsi && sdsi) { 140 if (!mdsi->phy_enabled && !sdsi->phy_enabled) { 141 msm_dsi_host_reset_phy(mdsi->host); 142 msm_dsi_host_reset_phy(sdsi->host); 143 144 ret = enable_phy(mdsi, 145 &shared_timings[DSI_CLOCK_MASTER]); 146 if (ret) 147 return ret; 148 ret = enable_phy(sdsi, 149 &shared_timings[DSI_CLOCK_SLAVE]); 150 if (ret) { 151 msm_dsi_phy_disable(mdsi->phy); 152 return ret; 153 } 154 } 155 } else { 156 msm_dsi_host_reset_phy(msm_dsi->host); 157 ret = enable_phy(msm_dsi, &shared_timings[id]); 158 if (ret) 159 return ret; 160 } 161 162 msm_dsi->phy_enabled = true; 163 164 return 0; 165} 166 167static void dsi_mgr_phy_disable(int id) 168{ 169 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 170 struct msm_dsi *mdsi = dsi_mgr_get_dsi(DSI_CLOCK_MASTER); 171 struct msm_dsi *sdsi = dsi_mgr_get_dsi(DSI_CLOCK_SLAVE); 172 173 /* disable DSI phy 174 * In bonded dsi configuration, the phy should be disabled for the 175 * first controller only when the second controller is disabled. 176 */ 177 msm_dsi->phy_enabled = false; 178 if (IS_BONDED_DSI() && mdsi && sdsi) { 179 if (!mdsi->phy_enabled && !sdsi->phy_enabled) { 180 msm_dsi_phy_disable(sdsi->phy); 181 msm_dsi_phy_disable(mdsi->phy); 182 } 183 } else { 184 msm_dsi_phy_disable(msm_dsi->phy); 185 } 186} 187 188struct dsi_bridge { 189 struct drm_bridge base; 190 int id; 191}; 192 193#define to_dsi_bridge(x) container_of(x, struct dsi_bridge, base) 194 195static int dsi_mgr_bridge_get_id(struct drm_bridge *bridge) 196{ 197 struct dsi_bridge *dsi_bridge = to_dsi_bridge(bridge); 198 return dsi_bridge->id; 199} 200 201static void msm_dsi_manager_set_split_display(u8 id) 202{ 203 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 204 struct msm_dsi *other_dsi = dsi_mgr_get_other_dsi(id); 205 struct msm_drm_private *priv = msm_dsi->dev->dev_private; 206 struct msm_kms *kms = priv->kms; 207 struct msm_dsi *master_dsi, *slave_dsi; 208 209 if (IS_BONDED_DSI() && !IS_MASTER_DSI_LINK(id)) { 210 master_dsi = other_dsi; 211 slave_dsi = msm_dsi; 212 } else { 213 master_dsi = msm_dsi; 214 slave_dsi = other_dsi; 215 } 216 217 if (!msm_dsi->external_bridge || !IS_BONDED_DSI()) 218 return; 219 220 /* 221 * Set split display info to kms once bonded DSI panel is connected to 222 * both hosts. 223 */ 224 if (other_dsi && other_dsi->external_bridge && kms->funcs->set_split_display) { 225 kms->funcs->set_split_display(kms, master_dsi->encoder, 226 slave_dsi->encoder, 227 msm_dsi_is_cmd_mode(msm_dsi)); 228 } 229} 230 231static int dsi_mgr_bridge_power_on(struct drm_bridge *bridge) 232{ 233 int id = dsi_mgr_bridge_get_id(bridge); 234 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 235 struct msm_dsi *msm_dsi1 = dsi_mgr_get_dsi(DSI_1); 236 struct mipi_dsi_host *host = msm_dsi->host; 237 struct msm_dsi_phy_shared_timings phy_shared_timings[DSI_MAX]; 238 bool is_bonded_dsi = IS_BONDED_DSI(); 239 int ret; 240 241 DBG("id=%d", id); 242 243 ret = dsi_mgr_phy_enable(id, phy_shared_timings); 244 if (ret) 245 goto phy_en_fail; 246 247 ret = msm_dsi_host_power_on(host, &phy_shared_timings[id], is_bonded_dsi, msm_dsi->phy); 248 if (ret) { 249 pr_err("%s: power on host %d failed, %d\n", __func__, id, ret); 250 goto host_on_fail; 251 } 252 253 if (is_bonded_dsi && msm_dsi1) { 254 ret = msm_dsi_host_power_on(msm_dsi1->host, 255 &phy_shared_timings[DSI_1], is_bonded_dsi, msm_dsi1->phy); 256 if (ret) { 257 pr_err("%s: power on host1 failed, %d\n", 258 __func__, ret); 259 goto host1_on_fail; 260 } 261 } 262 263 /* 264 * Enable before preparing the panel, disable after unpreparing, so 265 * that the panel can communicate over the DSI link. 266 */ 267 msm_dsi_host_enable_irq(host); 268 if (is_bonded_dsi && msm_dsi1) 269 msm_dsi_host_enable_irq(msm_dsi1->host); 270 271 return 0; 272 273host1_on_fail: 274 msm_dsi_host_power_off(host); 275host_on_fail: 276 dsi_mgr_phy_disable(id); 277phy_en_fail: 278 return ret; 279} 280 281static void dsi_mgr_bridge_power_off(struct drm_bridge *bridge) 282{ 283 int id = dsi_mgr_bridge_get_id(bridge); 284 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 285 struct msm_dsi *msm_dsi1 = dsi_mgr_get_dsi(DSI_1); 286 struct mipi_dsi_host *host = msm_dsi->host; 287 bool is_bonded_dsi = IS_BONDED_DSI(); 288 289 msm_dsi_host_disable_irq(host); 290 if (is_bonded_dsi && msm_dsi1) { 291 msm_dsi_host_disable_irq(msm_dsi1->host); 292 msm_dsi_host_power_off(msm_dsi1->host); 293 } 294 msm_dsi_host_power_off(host); 295 dsi_mgr_phy_disable(id); 296} 297 298static void dsi_mgr_bridge_pre_enable(struct drm_bridge *bridge) 299{ 300 int id = dsi_mgr_bridge_get_id(bridge); 301 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 302 struct msm_dsi *msm_dsi1 = dsi_mgr_get_dsi(DSI_1); 303 struct mipi_dsi_host *host = msm_dsi->host; 304 bool is_bonded_dsi = IS_BONDED_DSI(); 305 int ret; 306 307 DBG("id=%d", id); 308 if (!msm_dsi_device_connected(msm_dsi)) 309 return; 310 311 /* Do nothing with the host if it is slave-DSI in case of bonded DSI */ 312 if (is_bonded_dsi && !IS_MASTER_DSI_LINK(id)) 313 return; 314 315 ret = dsi_mgr_bridge_power_on(bridge); 316 if (ret) { 317 dev_err(&msm_dsi->pdev->dev, "Power on failed: %d\n", ret); 318 return; 319 } 320 321 ret = msm_dsi_host_enable(host); 322 if (ret) { 323 pr_err("%s: enable host %d failed, %d\n", __func__, id, ret); 324 goto host_en_fail; 325 } 326 327 if (is_bonded_dsi && msm_dsi1) { 328 ret = msm_dsi_host_enable(msm_dsi1->host); 329 if (ret) { 330 pr_err("%s: enable host1 failed, %d\n", __func__, ret); 331 goto host1_en_fail; 332 } 333 } 334 335 return; 336 337host1_en_fail: 338 msm_dsi_host_disable(host); 339host_en_fail: 340 dsi_mgr_bridge_power_off(bridge); 341} 342 343void msm_dsi_manager_tpg_enable(void) 344{ 345 struct msm_dsi *m_dsi = dsi_mgr_get_dsi(DSI_0); 346 struct msm_dsi *s_dsi = dsi_mgr_get_dsi(DSI_1); 347 348 /* if dual dsi, trigger tpg on master first then slave */ 349 if (m_dsi) { 350 msm_dsi_host_test_pattern_en(m_dsi->host); 351 if (IS_BONDED_DSI() && s_dsi) 352 msm_dsi_host_test_pattern_en(s_dsi->host); 353 } 354} 355 356static void dsi_mgr_bridge_post_disable(struct drm_bridge *bridge) 357{ 358 int id = dsi_mgr_bridge_get_id(bridge); 359 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 360 struct msm_dsi *msm_dsi1 = dsi_mgr_get_dsi(DSI_1); 361 struct mipi_dsi_host *host = msm_dsi->host; 362 bool is_bonded_dsi = IS_BONDED_DSI(); 363 int ret; 364 365 DBG("id=%d", id); 366 367 if (!msm_dsi_device_connected(msm_dsi)) 368 return; 369 370 /* 371 * Do nothing with the host if it is slave-DSI in case of bonded DSI. 372 * It is safe to call dsi_mgr_phy_disable() here because a single PHY 373 * won't be diabled until both PHYs request disable. 374 */ 375 if (is_bonded_dsi && !IS_MASTER_DSI_LINK(id)) 376 goto disable_phy; 377 378 ret = msm_dsi_host_disable(host); 379 if (ret) 380 pr_err("%s: host %d disable failed, %d\n", __func__, id, ret); 381 382 if (is_bonded_dsi && msm_dsi1) { 383 ret = msm_dsi_host_disable(msm_dsi1->host); 384 if (ret) 385 pr_err("%s: host1 disable failed, %d\n", __func__, ret); 386 } 387 388 msm_dsi_host_disable_irq(host); 389 if (is_bonded_dsi && msm_dsi1) 390 msm_dsi_host_disable_irq(msm_dsi1->host); 391 392 /* Save PHY status if it is a clock source */ 393 msm_dsi_phy_pll_save_state(msm_dsi->phy); 394 395 ret = msm_dsi_host_power_off(host); 396 if (ret) 397 pr_err("%s: host %d power off failed,%d\n", __func__, id, ret); 398 399 if (is_bonded_dsi && msm_dsi1) { 400 ret = msm_dsi_host_power_off(msm_dsi1->host); 401 if (ret) 402 pr_err("%s: host1 power off failed, %d\n", 403 __func__, ret); 404 } 405 406disable_phy: 407 dsi_mgr_phy_disable(id); 408} 409 410static void dsi_mgr_bridge_mode_set(struct drm_bridge *bridge, 411 const struct drm_display_mode *mode, 412 const struct drm_display_mode *adjusted_mode) 413{ 414 int id = dsi_mgr_bridge_get_id(bridge); 415 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 416 struct msm_dsi *other_dsi = dsi_mgr_get_other_dsi(id); 417 struct mipi_dsi_host *host = msm_dsi->host; 418 bool is_bonded_dsi = IS_BONDED_DSI(); 419 420 DBG("set mode: " DRM_MODE_FMT, DRM_MODE_ARG(mode)); 421 422 if (is_bonded_dsi && !IS_MASTER_DSI_LINK(id)) 423 return; 424 425 msm_dsi_host_set_display_mode(host, adjusted_mode); 426 if (is_bonded_dsi && other_dsi) 427 msm_dsi_host_set_display_mode(other_dsi->host, adjusted_mode); 428} 429 430static enum drm_mode_status dsi_mgr_bridge_mode_valid(struct drm_bridge *bridge, 431 const struct drm_display_info *info, 432 const struct drm_display_mode *mode) 433{ 434 int id = dsi_mgr_bridge_get_id(bridge); 435 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 436 struct mipi_dsi_host *host = msm_dsi->host; 437 struct platform_device *pdev = msm_dsi->pdev; 438 struct dev_pm_opp *opp; 439 unsigned long byte_clk_rate; 440 441 byte_clk_rate = dsi_byte_clk_get_rate(host, IS_BONDED_DSI(), mode); 442 443 opp = dev_pm_opp_find_freq_ceil(&pdev->dev, &byte_clk_rate); 444 if (!IS_ERR(opp)) { 445 dev_pm_opp_put(opp); 446 } else if (PTR_ERR(opp) == -ERANGE) { 447 /* 448 * An empty table is created by devm_pm_opp_set_clkname() even 449 * if there is none. Thus find_freq_ceil will still return 450 * -ERANGE in such case. 451 */ 452 if (dev_pm_opp_get_opp_count(&pdev->dev) != 0) 453 return MODE_CLOCK_RANGE; 454 } else { 455 return MODE_ERROR; 456 } 457 458 return msm_dsi_host_check_dsc(host, mode); 459} 460 461static const struct drm_bridge_funcs dsi_mgr_bridge_funcs = { 462 .pre_enable = dsi_mgr_bridge_pre_enable, 463 .post_disable = dsi_mgr_bridge_post_disable, 464 .mode_set = dsi_mgr_bridge_mode_set, 465 .mode_valid = dsi_mgr_bridge_mode_valid, 466}; 467 468/* initialize bridge */ 469struct drm_bridge *msm_dsi_manager_bridge_init(u8 id) 470{ 471 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 472 struct drm_bridge *bridge = NULL; 473 struct dsi_bridge *dsi_bridge; 474 struct drm_encoder *encoder; 475 int ret; 476 477 dsi_bridge = devm_kzalloc(msm_dsi->dev->dev, 478 sizeof(*dsi_bridge), GFP_KERNEL); 479 if (!dsi_bridge) { 480 ret = -ENOMEM; 481 goto fail; 482 } 483 484 dsi_bridge->id = id; 485 486 encoder = msm_dsi->encoder; 487 488 bridge = &dsi_bridge->base; 489 bridge->funcs = &dsi_mgr_bridge_funcs; 490 491 drm_bridge_add(bridge); 492 493 ret = drm_bridge_attach(encoder, bridge, NULL, 0); 494 if (ret) 495 goto fail; 496 497 return bridge; 498 499fail: 500 if (bridge) 501 msm_dsi_manager_bridge_destroy(bridge); 502 503 return ERR_PTR(ret); 504} 505 506int msm_dsi_manager_ext_bridge_init(u8 id) 507{ 508 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 509 struct drm_device *dev = msm_dsi->dev; 510 struct drm_encoder *encoder; 511 struct drm_bridge *int_bridge, *ext_bridge; 512 int ret; 513 514 int_bridge = msm_dsi->bridge; 515 ext_bridge = devm_drm_of_get_bridge(&msm_dsi->pdev->dev, 516 msm_dsi->pdev->dev.of_node, 1, 0); 517 if (IS_ERR(ext_bridge)) 518 return PTR_ERR(ext_bridge); 519 520 msm_dsi->external_bridge = ext_bridge; 521 522 encoder = msm_dsi->encoder; 523 524 /* 525 * Try first to create the bridge without it creating its own 526 * connector.. currently some bridges support this, and others 527 * do not (and some support both modes) 528 */ 529 ret = drm_bridge_attach(encoder, ext_bridge, int_bridge, 530 DRM_BRIDGE_ATTACH_NO_CONNECTOR); 531 if (ret == -EINVAL) { 532 /* 533 * link the internal dsi bridge to the external bridge, 534 * connector is created by the next bridge. 535 */ 536 ret = drm_bridge_attach(encoder, ext_bridge, int_bridge, 0); 537 if (ret < 0) 538 return ret; 539 } else { 540 struct drm_connector *connector; 541 542 /* We are in charge of the connector, create one now. */ 543 connector = drm_bridge_connector_init(dev, encoder); 544 if (IS_ERR(connector)) { 545 DRM_ERROR("Unable to create bridge connector\n"); 546 return PTR_ERR(connector); 547 } 548 549 ret = drm_connector_attach_encoder(connector, encoder); 550 if (ret < 0) 551 return ret; 552 } 553 554 /* The pipeline is ready, ping encoders if necessary */ 555 msm_dsi_manager_set_split_display(id); 556 557 return 0; 558} 559 560void msm_dsi_manager_bridge_destroy(struct drm_bridge *bridge) 561{ 562 drm_bridge_remove(bridge); 563} 564 565int msm_dsi_manager_cmd_xfer(int id, const struct mipi_dsi_msg *msg) 566{ 567 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 568 struct msm_dsi *msm_dsi0 = dsi_mgr_get_dsi(DSI_0); 569 struct mipi_dsi_host *host = msm_dsi->host; 570 bool is_read = (msg->rx_buf && msg->rx_len); 571 bool need_sync = (IS_SYNC_NEEDED() && !is_read); 572 int ret; 573 574 if (!msg->tx_buf || !msg->tx_len) 575 return 0; 576 577 /* In bonded master case, panel requires the same commands sent to 578 * both DSI links. Host issues the command trigger to both links 579 * when DSI_1 calls the cmd transfer function, no matter it happens 580 * before or after DSI_0 cmd transfer. 581 */ 582 if (need_sync && (id == DSI_0)) 583 return is_read ? msg->rx_len : msg->tx_len; 584 585 if (need_sync && msm_dsi0) { 586 ret = msm_dsi_host_xfer_prepare(msm_dsi0->host, msg); 587 if (ret) { 588 pr_err("%s: failed to prepare non-trigger host, %d\n", 589 __func__, ret); 590 return ret; 591 } 592 } 593 ret = msm_dsi_host_xfer_prepare(host, msg); 594 if (ret) { 595 pr_err("%s: failed to prepare host, %d\n", __func__, ret); 596 goto restore_host0; 597 } 598 599 ret = is_read ? msm_dsi_host_cmd_rx(host, msg) : 600 msm_dsi_host_cmd_tx(host, msg); 601 602 msm_dsi_host_xfer_restore(host, msg); 603 604restore_host0: 605 if (need_sync && msm_dsi0) 606 msm_dsi_host_xfer_restore(msm_dsi0->host, msg); 607 608 return ret; 609} 610 611bool msm_dsi_manager_cmd_xfer_trigger(int id, u32 dma_base, u32 len) 612{ 613 struct msm_dsi *msm_dsi = dsi_mgr_get_dsi(id); 614 struct msm_dsi *msm_dsi0 = dsi_mgr_get_dsi(DSI_0); 615 struct mipi_dsi_host *host = msm_dsi->host; 616 617 if (IS_SYNC_NEEDED() && (id == DSI_0)) 618 return false; 619 620 if (IS_SYNC_NEEDED() && msm_dsi0) 621 msm_dsi_host_cmd_xfer_commit(msm_dsi0->host, dma_base, len); 622 623 msm_dsi_host_cmd_xfer_commit(host, dma_base, len); 624 625 return true; 626} 627 628int msm_dsi_manager_register(struct msm_dsi *msm_dsi) 629{ 630 struct msm_dsi_manager *msm_dsim = &msm_dsim_glb; 631 int id = msm_dsi->id; 632 int ret; 633 634 if (id >= DSI_MAX) { 635 pr_err("%s: invalid id %d\n", __func__, id); 636 return -EINVAL; 637 } 638 639 if (msm_dsim->dsi[id]) { 640 pr_err("%s: dsi%d already registered\n", __func__, id); 641 return -EBUSY; 642 } 643 644 msm_dsim->dsi[id] = msm_dsi; 645 646 ret = dsi_mgr_parse_of(msm_dsi->pdev->dev.of_node, id); 647 if (ret) { 648 pr_err("%s: failed to parse OF DSI info\n", __func__); 649 goto fail; 650 } 651 652 ret = dsi_mgr_setup_components(id); 653 if (ret) { 654 pr_err("%s: failed to register mipi dsi host for DSI %d: %d\n", 655 __func__, id, ret); 656 goto fail; 657 } 658 659 return 0; 660 661fail: 662 msm_dsim->dsi[id] = NULL; 663 return ret; 664} 665 666void msm_dsi_manager_unregister(struct msm_dsi *msm_dsi) 667{ 668 struct msm_dsi_manager *msm_dsim = &msm_dsim_glb; 669 670 if (msm_dsi->host) 671 msm_dsi_host_unregister(msm_dsi->host); 672 673 if (msm_dsi->id >= 0) 674 msm_dsim->dsi[msm_dsi->id] = NULL; 675} 676 677bool msm_dsi_is_bonded_dsi(struct msm_dsi *msm_dsi) 678{ 679 return IS_BONDED_DSI(); 680} 681 682bool msm_dsi_is_master_dsi(struct msm_dsi *msm_dsi) 683{ 684 return IS_MASTER_DSI_LINK(msm_dsi->id); 685} 686