1 2 #define DSS_SUBSYS_NAME "HDMI" 3 4 #include <linux/kernel.h> 5 #include <linux/err.h> 6 #include <linux/of.h> 7 #include <video/omapfb_dss.h> 8 9 #include "hdmi.h" 10 11 int hdmi_parse_lanes_of(struct platform_device *pdev, struct device_node *ep, 12 struct hdmi_phy_data *phy) 13 { 14 struct property *prop; 15 int r, len; 16 17 prop = of_find_property(ep, "lanes", &len); 18 if (prop) { 19 u32 lanes[8]; 20 21 if (len / sizeof(u32) != ARRAY_SIZE(lanes)) { 22 dev_err(&pdev->dev, "bad number of lanes\n"); 23 return -EINVAL; 24 } 25 26 r = of_property_read_u32_array(ep, "lanes", lanes, 27 ARRAY_SIZE(lanes)); 28 if (r) { 29 dev_err(&pdev->dev, "failed to read lane data\n"); 30 return r; 31 } 32 33 r = hdmi_phy_parse_lanes(phy, lanes); 34 if (r) { 35 dev_err(&pdev->dev, "failed to parse lane data\n"); 36 return r; 37 } 38 } else { 39 static const u32 default_lanes[] = { 0, 1, 2, 3, 4, 5, 6, 7 }; 40 41 r = hdmi_phy_parse_lanes(phy, default_lanes); 42 if (WARN_ON(r)) { 43 dev_err(&pdev->dev, "failed to parse lane data\n"); 44 return r; 45 } 46 } 47 48 return 0; 49 } 50 51 int hdmi_compute_acr(u32 pclk, u32 sample_freq, u32 *n, u32 *cts) 52 { 53 u32 deep_color; 54 bool deep_color_correct = false; 55 56 if (n == NULL || cts == NULL) 57 return -EINVAL; 58 59 /* TODO: When implemented, query deep color mode here. */ 60 deep_color = 100; 61 62 /* 63 * When using deep color, the default N value (as in the HDMI 64 * specification) yields to an non-integer CTS. Hence, we 65 * modify it while keeping the restrictions described in 66 * section 7.2.1 of the HDMI 1.4a specification. 67 */ 68 switch (sample_freq) { 69 case 32000: 70 case 48000: 71 case 96000: 72 case 192000: 73 if (deep_color == 125) 74 if (pclk == 27027000 || pclk == 74250000) 75 deep_color_correct = true; 76 if (deep_color == 150) 77 if (pclk == 27027000) 78 deep_color_correct = true; 79 break; 80 case 44100: 81 case 88200: 82 case 176400: 83 if (deep_color == 125) 84 if (pclk == 27027000) 85 deep_color_correct = true; 86 break; 87 default: 88 return -EINVAL; 89 } 90 91 if (deep_color_correct) { 92 switch (sample_freq) { 93 case 32000: 94 *n = 8192; 95 break; 96 case 44100: 97 *n = 12544; 98 break; 99 case 48000: 100 *n = 8192; 101 break; 102 case 88200: 103 *n = 25088; 104 break; 105 case 96000: 106 *n = 16384; 107 break; 108 case 176400: 109 *n = 50176; 110 break; 111 case 192000: 112 *n = 32768; 113 break; 114 default: 115 return -EINVAL; 116 } 117 } else { 118 switch (sample_freq) { 119 case 32000: 120 *n = 4096; 121 break; 122 case 44100: 123 *n = 6272; 124 break; 125 case 48000: 126 *n = 6144; 127 break; 128 case 88200: 129 *n = 12544; 130 break; 131 case 96000: 132 *n = 12288; 133 break; 134 case 176400: 135 *n = 25088; 136 break; 137 case 192000: 138 *n = 24576; 139 break; 140 default: 141 return -EINVAL; 142 } 143 } 144 /* Calculate CTS. See HDMI 1.3a or 1.4a specifications */ 145 *cts = (pclk/1000) * (*n / 128) * deep_color / (sample_freq / 10); 146 147 return 0; 148 } 149