1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (C) 2023, STMicroelectronics - All Rights Reserved
* Author(s): Raphaël GALLAIS-POU <raphael.gallais-pou@foss.st.com> for STMicroelectronics.
*/
#include <drm/drm_atomic_helper.h>
#include <drm/drm_bridge.h>
#include <drm/drm_device.h>
#include <drm/drm_of.h>
#include <drm/drm_panel.h>
#include <drm/drm_print.h>
#include <drm/drm_probe_helper.h>
#include <linux/clk.h>
#include <linux/clk-provider.h>
#include <linux/io.h>
#include <linux/iopoll.h>
#include <linux/media-bus-format.h>
#include <linux/module.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/reset.h>
/* LVDS Host registers */
#define LVDS_CR 0x0000 /* configuration register */
#define LVDS_DMLCR0 0x0004 /* data mapping lsb configuration register 0 */
#define LVDS_DMMCR0 0x0008 /* data mapping msb configuration register 0 */
#define LVDS_DMLCR1 0x000C /* data mapping lsb configuration register 1 */
#define LVDS_DMMCR1 0x0010 /* data mapping msb configuration register 1 */
#define LVDS_DMLCR2 0x0014 /* data mapping lsb configuration register 2 */
#define LVDS_DMMCR2 0x0018 /* data mapping msb configuration register 2 */
#define LVDS_DMLCR3 0x001C /* data mapping lsb configuration register 3 */
#define LVDS_DMMCR3 0x0020 /* data mapping msb configuration register 3 */
#define LVDS_DMLCR4 0x0024 /* data mapping lsb configuration register 4 */
#define LVDS_DMMCR4 0x0028 /* data mapping msb configuration register 4 */
#define LVDS_CDL1CR 0x002C /* channel distrib link 1 configuration register */
#define LVDS_CDL2CR 0x0030 /* channel distrib link 2 configuration register */
#define CDL1CR_DEFAULT 0x04321 /* Default value for CDL1CR */
#define CDL2CR_DEFAULT 0x59876 /* Default value for CDL2CR */
#define LVDS_DMLCR(bit) (LVDS_DMLCR0 + 0x8 * (bit))
#define LVDS_DMMCR(bit) (LVDS_DMMCR0 + 0x8 * (bit))
/* LVDS Wrapper registers */
#define LVDS_WCLKCR 0x11B0 /* Wrapper clock control register */
#define LVDS_HWCFGR 0x1FF0 /* HW configuration register */
#define LVDS_VERR 0x1FF4 /* Version register */
#define LVDS_IPIDR 0x1FF8 /* Identification register */
#define LVDS_SIDR 0x1FFC /* Size Identification register */
/* Bitfield description */
#define CR_LVDSEN BIT(0) /* LVDS PHY Enable */
#define CR_HSPOL BIT(1) /* Horizontal Synchronization Polarity */
#define CR_VSPOL BIT(2) /* Vertical Synchronization Polarity */
#define CR_DEPOL BIT(3) /* Data Enable Polarity */
#define CR_CI BIT(4) /* Control Internal (software controlled bit) */
#define CR_LKMOD BIT(5) /* Link Mode, for both Links */
#define CR_LKPHA BIT(6) /* Link Phase, for both Links */
#define CR_LK1POL GENMASK(20, 16) /* Link-1 output Polarity */
#define CR_LK2POL GENMASK(25, 21) /* Link-2 output Polarity */
#define DMMCR_MAP0 GENMASK(4, 0) /* Mapping for bit 0 of datalane x */
#define DMMCR_MAP1 GENMASK(9, 5) /* Mapping for bit 1 of datalane x */
#define DMMCR_MAP2 GENMASK(14, 10) /* Mapping for bit 2 of datalane x */
#define DMMCR_MAP3 GENMASK(19, 15) /* Mapping for bit 3 of datalane x */
#define DMLCR_MAP4 GENMASK(4, 0) /* Mapping for bit 4 of datalane x */
#define DMLCR_MAP5 GENMASK(9, 5) /* Mapping for bit 5 of datalane x */
#define DMLCR_MAP6 GENMASK(14, 10) /* Mapping for bit 6 of datalane x */
#define CDLCR_DISTR0 GENMASK(3, 0) /* Channel distribution for lane 0 */
#define CDLCR_DISTR1 GENMASK(7, 4) /* Channel distribution for lane 1 */
#define CDLCR_DISTR2 GENMASK(11, 8) /* Channel distribution for lane 2 */
#define CDLCR_DISTR3 GENMASK(15, 12) /* Channel distribution for lane 3 */
#define CDLCR_DISTR4 GENMASK(19, 16) /* Channel distribution for lane 4 */
#define PHY_GCR_BIT_CLK_OUT BIT(0) /* BIT clock enable */
#define PHY_GCR_LS_CLK_OUT BIT(4) /* LS clock enable */
#define PHY_GCR_DP_CLK_OUT BIT(8) /* DP clock enable */
#define PHY_GCR_RSTZ BIT(24) /* LVDS PHY digital reset */
#define PHY_GCR_DIV_RSTN BIT(25) /* Output divider reset */
#define PHY_SCR_TX_EN BIT(16) /* Transmission mode enable */
/* Current mode driver enable */
#define PHY_CMCR_CM_EN_DL (BIT(28) | BIT(20) | BIT(12) | BIT(4))
#define PHY_CMCR_CM_EN_DL4 BIT(4)
/* Bias enable */
#define PHY_BCR1_EN_BIAS_DL (BIT(16) | BIT(12) | BIT(8) | BIT(4) | BIT(0))
#define PHY_BCR2_BIAS_EN BIT(28)
/* Voltage mode driver enable */
#define PHY_BCR3_VM_EN_DL (BIT(16) | BIT(12) | BIT(8) | BIT(4) | BIT(0))
#define PHY_DCR_POWER_OK BIT(12)
#define PHY_CFGCR_EN_DIG_DL GENMASK(4, 0) /* LVDS PHY digital lane enable */
#define PHY_PLLCR1_PLL_EN BIT(0) /* LVDS PHY PLL enable */
#define PHY_PLLCR1_EN_SD BIT(1) /* LVDS PHY PLL sigma-delta signal enable */
#define PHY_PLLCR1_EN_TWG BIT(2) /* LVDS PHY PLL triangular wave generator enable */
#define PHY_PLLCR1_DIV_EN BIT(8) /* LVDS PHY PLL dividers enable */
#define PHY_PLLCR2_NDIV GENMASK(25, 16) /* NDIV mask value */
#define PHY_PLLCR2_BDIV GENMASK(9, 0) /* BDIV mask value */
#define PHY_PLLSR_PLL_LOCK BIT(0) /* LVDS PHY PLL lock status */
#define PHY_PLLSDCR1_MDIV GENMASK(9, 0) /* MDIV mask value */
#define PHY_PLLTESTCR_TDIV GENMASK(25, 16) /* TDIV mask value */
#define PHY_PLLTESTCR_CLK_EN BIT(0) /* Test clock enable */
#define PHY_PLLTESTCR_EN BIT(8) /* Test divider output enable */
#define WCLKCR_SECND_CLKPIX_SEL BIT(0) /* Pixel clock selection */
#define WCLKCR_SRCSEL BIT(8) /* Source selection for the pixel clock */
/* Sleep & timeout for pll lock/unlock */
#define SLEEP_US 1000
#define TIMEOUT_US 200000
/*
* The link phase defines whether an ODD pixel is carried over together with
* the next EVEN pixel or together with the previous EVEN pixel.
*
* LVDS_DUAL_LINK_EVEN_ODD_PIXELS (LKPHA = 0)
*
* ,--------. ,--------. ,--------. ,--------. ,---------.
* | ODD LK \/ PIXEL 3 \/ PIXEL 1 \/ PIXEL' 1 \/ PIXEL' 3 |
* | EVEN LK /\ PIXEL 2 /\ PIXEL' 0 /\ PIXEL' 2 /\ PIXEL' 4 |
* `--------' `--------' `--------' `--------' `---------'
*
* LVDS_DUAL_LINK_ODD_EVEN_PIXELS (LKPHA = 1)
*
* ,--------. ,--------. ,--------. ,--------. ,---------.
* | ODD LK \/ PIXEL 3 \/ PIXEL 1 \/ PIXEL' 1 \/ PIXEL' 3 |
* | EVEN LK /\ PIXEL 4 /\ PIXEL 2 /\ PIXEL' 0 /\ PIXEL' 2 |
* `--------' `--------' `--------' `--------' `---------'
*
*/
enum lvds_link_type {
LVDS_SINGLE_LINK_PRIMARY = 0,
LVDS_SINGLE_LINK_SECONDARY,
LVDS_DUAL_LINK_EVEN_ODD_PIXELS,
LVDS_DUAL_LINK_ODD_EVEN_PIXELS,
};
enum lvds_pixel {
PIX_R_0 = 0,
PIX_R_1,
PIX_R_2,
PIX_R_3,
PIX_R_4,
PIX_R_5,
PIX_R_6,
PIX_R_7,
PIX_G_0,
PIX_G_1,
PIX_G_2,
PIX_G_3,
PIX_G_4,
PIX_G_5,
PIX_G_6,
PIX_G_7,
PIX_B_0,
PIX_B_1,
PIX_B_2,
PIX_B_3,
PIX_B_4,
PIX_B_5,
PIX_B_6,
PIX_B_7,
PIX_H_S,
PIX_V_S,
PIX_D_E,
PIX_C_E,
PIX_C_I,
PIX_TOG,
PIX_ONE,
PIX_ZER,
};
struct phy_reg_offsets {
u32 GCR; /* Global Control Register */
u32 CMCR1; /* Current Mode Control Register 1 */
u32 CMCR2; /* Current Mode Control Register 2 */
u32 SCR; /* Serial Control Register */
u32 BCR1; /* Bias Control Register 1 */
u32 BCR2; /* Bias Control Register 2 */
u32 BCR3; /* Bias Control Register 3 */
u32 MPLCR; /* Monitor PLL Lock Control Register */
u32 DCR; /* Debug Control Register */
u32 SSR1; /* Spare Status Register 1 */
u32 CFGCR; /* Configuration Control Register */
u32 PLLCR1; /* PLL_MODE 1 Control Register */
u32 PLLCR2; /* PLL_MODE 2 Control Register */
u32 PLLSR; /* PLL Status Register */
u32 PLLSDCR1; /* PLL_SD_1 Control Register */
u32 PLLSDCR2; /* PLL_SD_2 Control Register */
u32 PLLTWGCR1;/* PLL_TWG_1 Control Register */
u32 PLLTWGCR2;/* PLL_TWG_2 Control Register */
u32 PLLCPCR; /* PLL_CP Control Register */
u32 PLLTESTCR;/* PLL_TEST Control Register */
};
struct lvds_phy_info {
u32 base;
struct phy_reg_offsets ofs;
};
static struct lvds_phy_info lvds_phy_16ff_primary = {
.base = 0x1000,
.ofs = {
.GCR = 0x0,
.CMCR1 = 0xC,
.CMCR2 = 0x10,
.SCR = 0x20,
.BCR1 = 0x2C,
.BCR2 = 0x30,
.BCR3 = 0x34,
.MPLCR = 0x64,
.DCR = 0x84,
.SSR1 = 0x88,
.CFGCR = 0xA0,
.PLLCR1 = 0xC0,
.PLLCR2 = 0xC4,
.PLLSR = 0xC8,
.PLLSDCR1 = 0xCC,
.PLLSDCR2 = 0xD0,
.PLLTWGCR1 = 0xD4,
.PLLTWGCR2 = 0xD8,
.PLLCPCR = 0xE0,
.PLLTESTCR = 0xE8,
}
};
static struct lvds_phy_info lvds_phy_16ff_secondary = {
.base = 0x1100,
.ofs = {
.GCR = 0x0,
.CMCR1 = 0xC,
.CMCR2 = 0x10,
.SCR = 0x20,
.BCR1 = 0x2C,
.BCR2 = 0x30,
.BCR3 = 0x34,
.MPLCR = 0x64,
.DCR = 0x84,
.SSR1 = 0x88,
.CFGCR = 0xA0,
.PLLCR1 = 0xC0,
.PLLCR2 = 0xC4,
.PLLSR = 0xC8,
.PLLSDCR1 = 0xCC,
.PLLSDCR2 = 0xD0,
.PLLTWGCR1 = 0xD4,
.PLLTWGCR2 = 0xD8,
.PLLCPCR = 0xE0,
.PLLTESTCR = 0xE8,
}
};
struct stm_lvds {
void __iomem *base;
struct device *dev;
struct clk *pclk; /* APB peripheral clock */
struct clk *pllref_clk; /* Reference clock for the internal PLL */
struct clk_hw lvds_ck_px; /* Pixel clock */
u32 pixel_clock_rate; /* Pixel clock rate */
struct lvds_phy_info *primary;
struct lvds_phy_info *secondary;
struct drm_bridge lvds_bridge;
struct drm_bridge *next_bridge;
struct drm_connector connector;
struct drm_encoder *encoder;
struct drm_panel *panel;
u32 hw_version;
u32 link_type;
};
#define bridge_to_stm_lvds(b) \
container_of(b, struct stm_lvds, lvds_bridge)
#define connector_to_stm_lvds(c) \
container_of(c, struct stm_lvds, connector)
#define lvds_is_dual_link(lvds) \
({ \
typeof(lvds) __lvds = (lvds); \
__lvds == LVDS_DUAL_LINK_EVEN_ODD_PIXELS || \
__lvds == LVDS_DUAL_LINK_ODD_EVEN_PIXELS; \
})
static inline void lvds_write(struct stm_lvds *lvds, u32 reg, u32 val)
{
writel(val, lvds->base + reg);
}
static inline u32 lvds_read(struct stm_lvds *lvds, u32 reg)
{
return readl(lvds->base + reg);
}
static inline void lvds_set(struct stm_lvds *lvds, u32 reg, u32 mask)
{
lvds_write(lvds, reg, lvds_read(lvds, reg) | mask);
}
static inline void lvds_clear(struct stm_lvds *lvds, u32 reg, u32 mask)
{
lvds_write(lvds, reg, lvds_read(lvds, reg) & ~mask);
}
/*
* Expected JEIDA-RGB888 data to be sent in LSB format
* bit6 ............................bit0
* CHAN0 {ONE, ONE, ZERO, ZERO, ZERO, ONE, ONE}
* CHAN1 {G2, R7, R6, R5, R4, R3, R2}
* CHAN2 {B3, B2, G7, G6, G5, G4, G3}
* CHAN3 {DE, VS, HS, B7, B6, B5, B4}
* CHAN4 {CE, B1, B0, G1, G0, R1, R0}
*/
static enum lvds_pixel lvds_bitmap_jeida_rgb888[5][7] = {
{ PIX_ONE, PIX_ONE, PIX_ZER, PIX_ZER, PIX_ZER, PIX_ONE, PIX_ONE },
{ PIX_G_2, PIX_R_7, PIX_R_6, PIX_R_5, PIX_R_4, PIX_R_3, PIX_R_2 },
{ PIX_B_3, PIX_B_2, PIX_G_7, PIX_G_6, PIX_G_5, PIX_G_4, PIX_G_3 },
{ PIX_D_E, PIX_V_S, PIX_H_S, PIX_B_7, PIX_B_6, PIX_B_5, PIX_B_4 },
{ PIX_C_E, PIX_B_1, PIX_B_0, PIX_G_1, PIX_G_0, PIX_R_1, PIX_R_0 }
};
/*
* Expected VESA-RGB888 data to be sent in LSB format
* bit6 ............................bit0
* CHAN0 {ONE, ONE, ZERO, ZERO, ZERO, ONE, ONE}
* CHAN1 {G0, R5, R4, R3, R2, R1, R0}
* CHAN2 {B1, B0, G5, G4, G3, G2, G1}
* CHAN3 {DE, VS, HS, B5, B4, B3, B2}
* CHAN4 {CE, B7, B6, G7, G6, R7, R6}
*/
static enum lvds_pixel lvds_bitmap_vesa_rgb888[5][7] = {
{ PIX_ONE, PIX_ONE, PIX_ZER, PIX_ZER, PIX_ZER, PIX_ONE, PIX_ONE },
{ PIX_G_0, PIX_R_5, PIX_R_4, PIX_R_3, PIX_R_2, PIX_R_1, PIX_R_0 },
{ PIX_B_1, PIX_B_0, PIX_G_5, PIX_G_4, PIX_G_3, PIX_G_2, PIX_G_1 },
{ PIX_D_E, PIX_V_S, PIX_H_S, PIX_B_5, PIX_B_4, PIX_B_3, PIX_B_2 },
{ PIX_C_E, PIX_B_7, PIX_B_6, PIX_G_7, PIX_G_6, PIX_R_7, PIX_R_6 }
};
/*
* Clocks and PHY related functions
*/
static int lvds_pll_enable(struct stm_lvds *lvds, struct lvds_phy_info *phy)
{
struct drm_device *drm = lvds->lvds_bridge.dev;
u32 lvds_gcr;
int val, ret;
/*
* PLL lock timing control for the monitor unmask after startup (pll_en)
* Adjusted value so that the masking window is opened at start-up
*/
lvds_write(lvds, phy->base + phy->ofs.MPLCR, (0x200 - 0x160) << 16);
/* Enable bias */
lvds_write(lvds, phy->base + phy->ofs.BCR2, PHY_BCR2_BIAS_EN);
/* Enable DP, LS, BIT clock output */
lvds_gcr = PHY_GCR_DP_CLK_OUT | PHY_GCR_LS_CLK_OUT | PHY_GCR_BIT_CLK_OUT;
lvds_set(lvds, phy->base + phy->ofs.GCR, lvds_gcr);
/* Power up all output dividers */
lvds_set(lvds, phy->base + phy->ofs.PLLTESTCR, PHY_PLLTESTCR_EN);
lvds_set(lvds, phy->base + phy->ofs.PLLCR1, PHY_PLLCR1_DIV_EN);
/* Set PHY in serial transmission mode */
lvds_set(lvds, phy->base + phy->ofs.SCR, PHY_SCR_TX_EN);
/* Enable the LVDS PLL & wait for its lock */
lvds_set(lvds, phy->base + phy->ofs.PLLCR1, PHY_PLLCR1_PLL_EN);
ret = readl_poll_timeout_atomic(lvds->base + phy->base + phy->ofs.PLLSR,
val, val & PHY_PLLSR_PLL_LOCK,
SLEEP_US, TIMEOUT_US);
if (ret)
drm_err(drm, "!TIMEOUT! waiting PLL, let's continue\n");
/* WCLKCR_SECND_CLKPIX_SEL is for dual link */
lvds_write(lvds, LVDS_WCLKCR, WCLKCR_SECND_CLKPIX_SEL);
lvds_set(lvds, phy->ofs.PLLTESTCR, PHY_PLLTESTCR_CLK_EN);
return ret;
}
static int pll_get_clkout_khz(int clkin_khz, int bdiv, int mdiv, int ndiv)
{
int divisor = ndiv * bdiv;
/* Prevents from division by 0 */
if (!divisor)
return 0;
return clkin_khz * mdiv / divisor;
}
#define TDIV 70
#define NDIV_MIN 2
#define NDIV_MAX 6
#define BDIV_MIN 2
#define BDIV_MAX 6
#define MDIV_MIN 1
#define MDIV_MAX 1023
static int lvds_pll_get_params(struct stm_lvds *lvds,
unsigned int clkin_khz, unsigned int clkout_khz,
unsigned int *bdiv, unsigned int *mdiv, unsigned int *ndiv)
{
int delta, best_delta; /* all in khz */
int i, o, n;
/* Early checks preventing division by 0 & odd results */
if (clkin_khz <= 0 || clkout_khz <= 0)
return -EINVAL;
best_delta = 1000000; /* big started value (1000000khz) */
for (i = NDIV_MIN; i <= NDIV_MAX; i++) {
for (o = BDIV_MIN; o <= BDIV_MAX; o++) {
n = DIV_ROUND_CLOSEST(i * o * clkout_khz, clkin_khz);
/* Check ndiv according to vco range */
if (n < MDIV_MIN || n > MDIV_MAX)
continue;
/* Check if new delta is better & saves parameters */
delta = pll_get_clkout_khz(clkin_khz, i, n, o) - clkout_khz;
if (delta < 0)
delta = -delta;
if (delta < best_delta) {
*ndiv = i;
*mdiv = n;
*bdiv = o;
best_delta = delta;
}
/* fast return in case of "perfect result" */
if (!delta)
return 0;
}
}
return 0;
}
static void lvds_pll_config(struct stm_lvds *lvds, struct lvds_phy_info *phy)
{
unsigned int pll_in_khz, bdiv = 0, mdiv = 0, ndiv = 0;
struct clk_hw *hwclk;
int multiplier;
/*
* The LVDS PHY includes a low power low jitter high performance and
* highly configuration Phase Locked Loop supporting integer and
* fractional multiplication ratios and Spread Spectrum Clocking. In
* integer mode, the only software supported feature for now, the PLL is
* made of a pre-divider NDIV, a feedback multiplier MDIV, followed by
* several post-dividers, each one with a specific application.
*
* ,------. ,-----. ,-----.
* Fref --> | NDIV | -Fpdf-> | PFD | --> | VCO | --------> Fvco
* `------' ,-> | | `-----' |
* | `-----' |
* | ,------. |
* `-------- | MDIV | <-----'
* `------'
*
* From the output of the VCO, the clock can be optionally extracted on
* the RCC clock observer, with a divider TDIV, for testing purpose, or
* is passed through a programmable post-divider BDIV. Finally, the
* frequency can be divided further with two fixed dividers.
*
* ,--------.
* ,-----> | DP div | ----------------> Fdp
* ,------. | `--------'
* Fvco --> | BDIV | ------------------------------------> Fbit
* | `------' ,------. |
* `-------------> | TDIV | --.---------------------> ClkObs
* '------' | ,--------.
* `--> | LS div | ------> Fls
* '--------'
*
* The LS and DP clock dividers operate at a fixed ratio of 7 and 3.5
* respectively with regards to fbit. LS divider converts the bit clock
* to a pixel clock per lane per clock sample (Fls). This is useful
* when used to generate a dot clock for the display unit RGB output,
* and DP divider is.
*/
hwclk = __clk_get_hw(lvds->pllref_clk);
if (!hwclk)
return;
pll_in_khz = clk_hw_get_rate(hwclk) / 1000;
if (lvds_is_dual_link(lvds->link_type))
multiplier = 2;
else
multiplier = 1;
lvds_pll_get_params(lvds, pll_in_khz,
lvds->pixel_clock_rate * 7 / 1000 / multiplier,
&bdiv, &mdiv, &ndiv);
/* Set BDIV, MDIV and NDIV */
lvds_write(lvds, phy->base + phy->ofs.PLLCR2, ndiv << 16);
lvds_set(lvds, phy->base + phy->ofs.PLLCR2, bdiv);
lvds_write(lvds, phy->base + phy->ofs.PLLSDCR1, mdiv);
/* Hardcode TDIV as dynamic values are not yet implemented */
lvds_write(lvds, phy->base + phy->ofs.PLLTESTCR, TDIV << 16);
/*
* For now, PLL just needs to be in integer mode
* Fractional and spread spectrum clocking are not yet implemented
*
* PLL integer mode:
* - PMRY_PLL_TWG_STEP = PMRY_PLL_SD_INT_RATIO
* - EN_TWG = 0
* - EN_SD = 0
* - DOWN_SPREAD = 0
*
* PLL fractional mode:
* - EN_TWG = 0
* - EN_SD = 1
* - DOWN_SPREAD = 0
*
* Spread Spectrum Clocking
* - EN_TWG = 1
* - EN_SD = 1
*/
/* Disable TWG and SD */
lvds_clear(lvds, phy->base + phy->ofs.PLLCR1, PHY_PLLCR1_EN_TWG | PHY_PLLCR1_EN_SD);
/* Power up bias and PLL dividers */
lvds_set(lvds, phy->base + phy->ofs.DCR, PHY_DCR_POWER_OK);
lvds_set(lvds, phy->base + phy->ofs.CMCR1, PHY_CMCR_CM_EN_DL);
lvds_set(lvds, phy->base + phy->ofs.CMCR2, PHY_CMCR_CM_EN_DL4);
/* Set up voltage mode */
lvds_set(lvds, phy->base + phy->ofs.PLLCPCR, 0x1);
lvds_set(lvds, phy->base + phy->ofs.BCR3, PHY_BCR3_VM_EN_DL);
lvds_set(lvds, phy->base + phy->ofs.BCR1, PHY_BCR1_EN_BIAS_DL);
/* Enable digital datalanes */
lvds_set(lvds, phy->base + phy->ofs.CFGCR, PHY_CFGCR_EN_DIG_DL);
}
static int lvds_pixel_clk_enable(struct clk_hw *hw)
{
struct stm_lvds *lvds = container_of(hw, struct stm_lvds, lvds_ck_px);
struct drm_device *drm = lvds->lvds_bridge.dev;
struct lvds_phy_info *phy;
int ret;
ret = clk_prepare_enable(lvds->pclk);
if (ret) {
drm_err(drm, "Failed to enable lvds peripheral clk\n");
return ret;
}
ret = clk_prepare_enable(lvds->pllref_clk);
if (ret) {
drm_err(drm, "Failed to enable lvds reference clk\n");
clk_disable_unprepare(lvds->pclk);
return ret;
}
/* In case we are operating in dual link the second PHY is set before the primary PHY. */
if (lvds->secondary) {
phy = lvds->secondary;
/* Release LVDS PHY from reset mode */
lvds_set(lvds, phy->base + phy->ofs.GCR, PHY_GCR_DIV_RSTN | PHY_GCR_RSTZ);
lvds_pll_config(lvds, phy);
ret = lvds_pll_enable(lvds, phy);
if (ret) {
drm_err(drm, "Failed to enable secondary PHY PLL: %d\n", ret);
return ret;
}
}
if (lvds->primary) {
phy = lvds->primary;
/* Release LVDS PHY from reset mode */
lvds_set(lvds, phy->base + phy->ofs.GCR, PHY_GCR_DIV_RSTN | PHY_GCR_RSTZ);
lvds_pll_config(lvds, phy);
ret = lvds_pll_enable(lvds, phy);
if (ret) {
drm_err(drm, "Failed to enable primary PHY PLL: %d\n", ret);
return ret;
}
}
return 0;
}
static void lvds_pixel_clk_disable(struct clk_hw *hw)
{
struct stm_lvds *lvds = container_of(hw, struct stm_lvds, lvds_ck_px);
/*
* For each PHY:
* Disable DP, LS, BIT clock outputs
* Shutdown the PLL
* Assert LVDS PHY in reset mode
*/
if (lvds->primary) {
lvds_clear(lvds, lvds->primary->base + lvds->primary->ofs.GCR,
(PHY_GCR_DP_CLK_OUT | PHY_GCR_LS_CLK_OUT | PHY_GCR_BIT_CLK_OUT));
lvds_clear(lvds, lvds->primary->base + lvds->primary->ofs.PLLCR1,
PHY_PLLCR1_PLL_EN);
lvds_clear(lvds, lvds->primary->base + lvds->primary->ofs.GCR,
PHY_GCR_DIV_RSTN | PHY_GCR_RSTZ);
}
if (lvds->secondary) {
lvds_clear(lvds, lvds->secondary->base + lvds->secondary->ofs.GCR,
(PHY_GCR_DP_CLK_OUT | PHY_GCR_LS_CLK_OUT | PHY_GCR_BIT_CLK_OUT));
lvds_clear(lvds, lvds->secondary->base + lvds->secondary->ofs.PLLCR1,
PHY_PLLCR1_PLL_EN);
lvds_clear(lvds, lvds->secondary->base + lvds->secondary->ofs.GCR,
PHY_GCR_DIV_RSTN | PHY_GCR_RSTZ);
}
clk_disable_unprepare(lvds->pllref_clk);
clk_disable_unprepare(lvds->pclk);
}
static unsigned long lvds_pixel_clk_recalc_rate(struct clk_hw *hw,
unsigned long parent_rate)
{
struct stm_lvds *lvds = container_of(hw, struct stm_lvds, lvds_ck_px);
struct drm_device *drm = lvds->lvds_bridge.dev;
unsigned int pll_in_khz, bdiv, mdiv, ndiv;
int ret, multiplier, pll_out_khz;
u32 val;
ret = clk_prepare_enable(lvds->pclk);
if (ret) {
drm_err(drm, "Failed to enable lvds peripheral clk\n");
return 0;
}
if (lvds_is_dual_link(lvds->link_type))
multiplier = 2;
else
multiplier = 1;
val = lvds_read(lvds, lvds->primary->base + lvds->primary->ofs.PLLCR2);
ndiv = (val & PHY_PLLCR2_NDIV) >> 16;
bdiv = (val & PHY_PLLCR2_BDIV) >> 0;
mdiv = (unsigned int)lvds_read(lvds,
lvds->primary->base + lvds->primary->ofs.PLLSDCR1);
pll_in_khz = (unsigned int)(parent_rate / 1000);
/* Compute values if not yet accessible */
if (val == 0 || mdiv == 0) {
lvds_pll_get_params(lvds, pll_in_khz,
lvds->pixel_clock_rate * 7 / 1000 / multiplier,
&bdiv, &mdiv, &ndiv);
}
pll_out_khz = pll_get_clkout_khz(pll_in_khz, bdiv, mdiv, ndiv);
drm_dbg(drm, "ndiv %d , bdiv %d, mdiv %d, pll_out_khz %d\n",
ndiv, bdiv, mdiv, pll_out_khz);
/*
* 1/7 because for each pixel in 1 lane there is 7 bits
* We want pixclk, not bitclk
*/
lvds->pixel_clock_rate = pll_out_khz * 1000 * multiplier / 7;
clk_disable_unprepare(lvds->pclk);
return (unsigned long)lvds->pixel_clock_rate;
}
static long lvds_pixel_clk_round_rate(struct clk_hw *hw, unsigned long rate,
unsigned long *parent_rate)
{
struct stm_lvds *lvds = container_of(hw, struct stm_lvds, lvds_ck_px);
unsigned int pll_in_khz, bdiv = 0, mdiv = 0, ndiv = 0;
const struct drm_connector *connector;
const struct drm_display_mode *mode;
int multiplier;
connector = &lvds->connector;
if (!connector)
return -EINVAL;
if (list_empty(&connector->modes)) {
drm_dbg(connector->dev, "connector: empty modes list\n");
return -EINVAL;
}
mode = list_first_entry(&connector->modes,
struct drm_display_mode, head);
pll_in_khz = (unsigned int)(*parent_rate / 1000);
if (lvds_is_dual_link(lvds->link_type))
multiplier = 2;
else
multiplier = 1;
lvds_pll_get_params(lvds, pll_in_khz, mode->clock * 7 / multiplier, &bdiv, &mdiv, &ndiv);
/*
* 1/7 because for each pixel in 1 lane there is 7 bits
* We want pixclk, not bitclk
*/
lvds->pixel_clock_rate = (unsigned long)pll_get_clkout_khz(pll_in_khz, bdiv, mdiv, ndiv)
* 1000 * multiplier / 7;
return lvds->pixel_clock_rate;
}
static const struct clk_ops lvds_pixel_clk_ops = {
.enable = lvds_pixel_clk_enable,
.disable = lvds_pixel_clk_disable,
.recalc_rate = lvds_pixel_clk_recalc_rate,
.round_rate = lvds_pixel_clk_round_rate,
};
static const struct clk_init_data clk_data = {
.name = "clk_pix_lvds",
.ops = &lvds_pixel_clk_ops,
.parent_names = (const char * []) {"ck_ker_lvdsphy"},
.num_parents = 1,
.flags = CLK_IGNORE_UNUSED,
};
static void lvds_pixel_clk_unregister(void *data)
{
struct stm_lvds *lvds = data;
of_clk_del_provider(lvds->dev->of_node);
clk_hw_unregister(&lvds->lvds_ck_px);
}
static int lvds_pixel_clk_register(struct stm_lvds *lvds)
{
struct device_node *node = lvds->dev->of_node;
int ret;
lvds->lvds_ck_px.init = &clk_data;
/* set the rate by default at 148500000 */
lvds->pixel_clock_rate = 148500000;
ret = clk_hw_register(lvds->dev, &lvds->lvds_ck_px);
if (ret)
return ret;
ret = of_clk_add_hw_provider(node, of_clk_hw_simple_get,
&lvds->lvds_ck_px);
if (ret)
clk_hw_unregister(&lvds->lvds_ck_px);
return ret;
}
/*
* Host configuration related
*/
static void lvds_config_data_mapping(struct stm_lvds *lvds)
{
struct drm_device *drm = lvds->lvds_bridge.dev;
const struct drm_display_info *info;
enum lvds_pixel (*bitmap)[7];
u32 lvds_dmlcr, lvds_dmmcr;
int i;
info = &(&lvds->connector)->display_info;
if (!info->num_bus_formats || !info->bus_formats) {
drm_warn(drm, "No LVDS bus format reported\n");
return;
}
switch (info->bus_formats[0]) {
case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG: /* VESA-RGB666 */
drm_warn(drm, "Pixel format with data mapping not yet supported.\n");
return;
case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG: /* VESA-RGB888 */
bitmap = lvds_bitmap_vesa_rgb888;
break;
case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA: /* JEIDA-RGB888 */
bitmap = lvds_bitmap_jeida_rgb888;
break;
default:
drm_warn(drm, "Unsupported LVDS bus format 0x%04x\n", info->bus_formats[0]);
return;
}
/* Set bitmap for each lane */
for (i = 0; i < 5; i++) {
lvds_dmlcr = ((bitmap[i][0])
+ (bitmap[i][1] << 5)
+ (bitmap[i][2] << 10)
+ (bitmap[i][3] << 15));
lvds_dmmcr = ((bitmap[i][4])
+ (bitmap[i][5] << 5)
+ (bitmap[i][6] << 10));
lvds_write(lvds, LVDS_DMLCR(i), lvds_dmlcr);
lvds_write(lvds, LVDS_DMMCR(i), lvds_dmmcr);
}
}
static void lvds_config_mode(struct stm_lvds *lvds)
{
u32 bus_flags, lvds_cr = 0, lvds_cdl1cr = 0, lvds_cdl2cr = 0;
const struct drm_display_mode *mode;
const struct drm_connector *connector;
connector = &lvds->connector;
if (!connector)
return;
if (list_empty(&connector->modes)) {
drm_dbg(connector->dev, "connector: empty modes list\n");
return;
}
bus_flags = connector->display_info.bus_flags;
mode = list_first_entry(&connector->modes,
struct drm_display_mode, head);
lvds_clear(lvds, LVDS_CR, CR_LKMOD);
lvds_clear(lvds, LVDS_CDL1CR, CDLCR_DISTR0 | CDLCR_DISTR1 | CDLCR_DISTR2 |
CDLCR_DISTR3 | CDLCR_DISTR4);
lvds_clear(lvds, LVDS_CDL2CR, CDLCR_DISTR0 | CDLCR_DISTR1 | CDLCR_DISTR2 |
CDLCR_DISTR3 | CDLCR_DISTR4);
/* Set channel distribution */
if (lvds->primary)
lvds_cdl1cr = CDL1CR_DEFAULT;
if (lvds->secondary) {
lvds_cr |= CR_LKMOD;
lvds_cdl2cr = CDL2CR_DEFAULT;
}
/* Set signal polarity */
if (bus_flags & DRM_BUS_FLAG_DE_LOW)
lvds_cr |= CR_DEPOL;
if (mode->flags & DRM_MODE_FLAG_NHSYNC)
lvds_cr |= CR_HSPOL;
if (mode->flags & DRM_MODE_FLAG_NVSYNC)
lvds_cr |= CR_VSPOL;
switch (lvds->link_type) {
case LVDS_DUAL_LINK_EVEN_ODD_PIXELS: /* LKPHA = 0 */
lvds_cr &= ~CR_LKPHA;
break;
case LVDS_DUAL_LINK_ODD_EVEN_PIXELS: /* LKPHA = 1 */
lvds_cr |= CR_LKPHA;
break;
default:
drm_notice(lvds->lvds_bridge.dev, "No phase precised, setting default\n");
lvds_cr &= ~CR_LKPHA;
break;
}
/* Write config to registers */
lvds_set(lvds, LVDS_CR, lvds_cr);
lvds_write(lvds, LVDS_CDL1CR, lvds_cdl1cr);
lvds_write(lvds, LVDS_CDL2CR, lvds_cdl2cr);
}
static int lvds_connector_get_modes(struct drm_connector *connector)
{
struct stm_lvds *lvds = connector_to_stm_lvds(connector);
return drm_panel_get_modes(lvds->panel, connector);
}
static int lvds_connector_atomic_check(struct drm_connector *connector,
struct drm_atomic_state *state)
{
const struct drm_display_mode *panel_mode;
struct drm_connector_state *conn_state;
struct drm_crtc_state *crtc_state;
conn_state = drm_atomic_get_new_connector_state(state, connector);
if (!conn_state)
return -EINVAL;
if (list_empty(&connector->modes)) {
drm_dbg(connector->dev, "connector: empty modes list\n");
return -EINVAL;
}
if (!conn_state->crtc)
return -EINVAL;
panel_mode = list_first_entry(&connector->modes,
struct drm_display_mode, head);
/* We're not allowed to modify the resolution. */
crtc_state = drm_atomic_get_crtc_state(state, conn_state->crtc);
if (IS_ERR(crtc_state))
return PTR_ERR(crtc_state);
if (crtc_state->mode.hdisplay != panel_mode->hdisplay ||
crtc_state->mode.vdisplay != panel_mode->vdisplay)
return -EINVAL;
/* The flat panel mode is fixed, just copy it to the adjusted mode. */
drm_mode_copy(&crtc_state->adjusted_mode, panel_mode);
return 0;
}
static const struct drm_connector_helper_funcs lvds_conn_helper_funcs = {
.get_modes = lvds_connector_get_modes,
.atomic_check = lvds_connector_atomic_check,
};
static const struct drm_connector_funcs lvds_conn_funcs = {
.reset = drm_atomic_helper_connector_reset,
.fill_modes = drm_helper_probe_single_connector_modes,
.destroy = drm_connector_cleanup,
.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
};
static int lvds_attach(struct drm_bridge *bridge, struct drm_encoder *encoder,
enum drm_bridge_attach_flags flags)
{
struct stm_lvds *lvds = bridge_to_stm_lvds(bridge);
struct drm_connector *connector = &lvds->connector;
int ret;
if (!encoder) {
drm_err(bridge->dev, "Parent encoder object not found\n");
return -ENODEV;
}
/* Set the encoder type as caller does not know it */
encoder->encoder_type = DRM_MODE_ENCODER_LVDS;
/* No cloning support */
encoder->possible_clones = 0;
/* If we have a next bridge just attach it. */
if (lvds->next_bridge)
return drm_bridge_attach(encoder, lvds->next_bridge,
bridge, flags);
if (flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR) {
drm_err(bridge->dev, "Fix bridge driver to make connector optional!");
return -EINVAL;
}
/* Otherwise if we have a panel, create a connector. */
if (!lvds->panel)
return 0;
ret = drm_connector_init(bridge->dev, connector,
&lvds_conn_funcs, DRM_MODE_CONNECTOR_LVDS);
if (ret < 0)
return ret;
drm_connector_helper_add(connector, &lvds_conn_helper_funcs);
ret = drm_connector_attach_encoder(connector, encoder);
return ret;
}
static void lvds_atomic_enable(struct drm_bridge *bridge,
struct drm_atomic_state *state)
{
struct stm_lvds *lvds = bridge_to_stm_lvds(bridge);
struct drm_connector_state *conn_state;
struct drm_connector *connector;
int ret;
ret = clk_prepare_enable(lvds->pclk);
if (ret) {
drm_err(bridge->dev, "Failed to enable lvds peripheral clk\n");
return;
}
connector = drm_atomic_get_new_connector_for_encoder(state, bridge->encoder);
if (!connector)
return;
conn_state = drm_atomic_get_new_connector_state(state, connector);
if (!conn_state)
return;
lvds_config_mode(lvds);
/* Set Data Mapping */
lvds_config_data_mapping(lvds);
/* Turn the output on. */
lvds_set(lvds, LVDS_CR, CR_LVDSEN);
if (lvds->panel) {
drm_panel_prepare(lvds->panel);
drm_panel_enable(lvds->panel);
}
}
static void lvds_atomic_disable(struct drm_bridge *bridge,
struct drm_atomic_state *state)
{
struct stm_lvds *lvds = bridge_to_stm_lvds(bridge);
if (lvds->panel) {
drm_panel_disable(lvds->panel);
drm_panel_unprepare(lvds->panel);
}
/* Disable LVDS module */
lvds_clear(lvds, LVDS_CR, CR_LVDSEN);
clk_disable_unprepare(lvds->pclk);
}
static const struct drm_bridge_funcs lvds_bridge_funcs = {
.attach = lvds_attach,
.atomic_enable = lvds_atomic_enable,
.atomic_disable = lvds_atomic_disable,
.atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
.atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
.atomic_reset = drm_atomic_helper_bridge_reset,
};
static int lvds_probe(struct platform_device *pdev)
{
struct device_node *port1, *port2, *remote;
struct device *dev = &pdev->dev;
struct reset_control *rstc;
struct stm_lvds *lvds;
int ret, dual_link;
dev_dbg(dev, "Probing LVDS driver...\n");
lvds = devm_kzalloc(dev, sizeof(*lvds), GFP_KERNEL);
if (!lvds)
return -ENOMEM;
lvds->dev = dev;
ret = drm_of_find_panel_or_bridge(dev->of_node, 1, 0,
&lvds->panel, &lvds->next_bridge);
if (ret) {
dev_err_probe(dev, ret, "Panel not found\n");
return ret;
}
lvds->base = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR(lvds->base)) {
ret = PTR_ERR(lvds->base);
dev_err(dev, "Unable to get regs %d\n", ret);
return ret;
}
lvds->pclk = devm_clk_get(dev, "pclk");
if (IS_ERR(lvds->pclk)) {
ret = PTR_ERR(lvds->pclk);
dev_err(dev, "Unable to get peripheral clock: %d\n", ret);
return ret;
}
ret = clk_prepare_enable(lvds->pclk);
if (ret) {
dev_err(dev, "%s: Failed to enable peripheral clk\n", __func__);
return ret;
}
rstc = devm_reset_control_get_exclusive(dev, NULL);
if (IS_ERR(rstc)) {
ret = PTR_ERR(rstc);
goto err_lvds_probe;
}
reset_control_assert(rstc);
usleep_range(10, 20);
reset_control_deassert(rstc);
port1 = of_graph_get_port_by_id(dev->of_node, 1);
port2 = of_graph_get_port_by_id(dev->of_node, 2);
dual_link = drm_of_lvds_get_dual_link_pixel_order(port1, port2);
switch (dual_link) {
case DRM_LVDS_DUAL_LINK_ODD_EVEN_PIXELS:
lvds->link_type = LVDS_DUAL_LINK_ODD_EVEN_PIXELS;
lvds->primary = &lvds_phy_16ff_primary;
lvds->secondary = &lvds_phy_16ff_secondary;
break;
case DRM_LVDS_DUAL_LINK_EVEN_ODD_PIXELS:
lvds->link_type = LVDS_DUAL_LINK_EVEN_ODD_PIXELS;
lvds->primary = &lvds_phy_16ff_primary;
lvds->secondary = &lvds_phy_16ff_secondary;
break;
case -EINVAL:
/*
* drm_of_lvds_get_dual_pixel_order returns 4 possible values.
* In the case where the returned value is an error, it can be
* either ENODEV or EINVAL. Seeing the structure of this
* function, EINVAL means that either port1 or port2 is not
* present in the device tree.
* In that case, the lvds panel can be a single link panel, or
* there is a semantical error in the device tree code.
*/
remote = of_get_next_available_child(port1, NULL);
if (remote) {
if (of_graph_get_remote_endpoint(remote)) {
lvds->link_type = LVDS_SINGLE_LINK_PRIMARY;
lvds->primary = &lvds_phy_16ff_primary;
lvds->secondary = NULL;
} else {
ret = -EINVAL;
}
of_node_put(remote);
}
remote = of_get_next_available_child(port2, NULL);
if (remote) {
if (of_graph_get_remote_endpoint(remote)) {
lvds->link_type = LVDS_SINGLE_LINK_SECONDARY;
lvds->primary = NULL;
lvds->secondary = &lvds_phy_16ff_secondary;
} else {
ret = (ret == -EINVAL) ? -EINVAL : 0;
}
of_node_put(remote);
}
break;
default:
ret = -EINVAL;
goto err_lvds_probe;
}
of_node_put(port1);
of_node_put(port2);
lvds->pllref_clk = devm_clk_get(dev, "ref");
if (IS_ERR(lvds->pllref_clk)) {
ret = PTR_ERR(lvds->pllref_clk);
dev_err(dev, "Unable to get reference clock: %d\n", ret);
goto err_lvds_probe;
}
ret = lvds_pixel_clk_register(lvds);
if (ret) {
dev_err(dev, "Failed to register LVDS pixel clock: %d\n", ret);
goto err_lvds_probe;
}
lvds->lvds_bridge.funcs = &lvds_bridge_funcs;
lvds->lvds_bridge.of_node = dev->of_node;
lvds->hw_version = lvds_read(lvds, LVDS_VERR);
dev_info(dev, "version 0x%02x initialized\n", lvds->hw_version);
drm_bridge_add(&lvds->lvds_bridge);
platform_set_drvdata(pdev, lvds);
clk_disable_unprepare(lvds->pclk);
return 0;
err_lvds_probe:
clk_disable_unprepare(lvds->pclk);
return ret;
}
static void lvds_remove(struct platform_device *pdev)
{
struct stm_lvds *lvds = platform_get_drvdata(pdev);
lvds_pixel_clk_unregister(lvds);
drm_bridge_remove(&lvds->lvds_bridge);
}
static const struct of_device_id lvds_dt_ids[] = {
{
.compatible = "st,stm32mp25-lvds",
.data = NULL
},
{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, lvds_dt_ids);
static struct platform_driver lvds_platform_driver = {
.probe = lvds_probe,
.remove = lvds_remove,
.driver = {
.name = "stm32-display-lvds",
.of_match_table = lvds_dt_ids,
},
};
module_platform_driver(lvds_platform_driver);
MODULE_AUTHOR("Raphaël Gallais-Pou <raphael.gallais-pou@foss.st.com>");
MODULE_AUTHOR("Philippe Cornu <philippe.cornu@foss.st.com>");
MODULE_AUTHOR("Yannick Fertre <yannick.fertre@foss.st.com>");
MODULE_DESCRIPTION("STMicroelectronics LVDS Display Interface Transmitter DRM driver");
MODULE_LICENSE("GPL");
|