1 /* 2 drm_edid_load.c: use a built-in EDID data set or load it via the firmware 3 interface 4 5 Copyright (C) 2012 Carsten Emde <C.Emde@osadl.org> 6 7 This program is free software; you can redistribute it and/or 8 modify it under the terms of the GNU General Public License 9 as published by the Free Software Foundation; either version 2 10 of the License, or (at your option) any later version. 11 12 This program is distributed in the hope that it will be useful, 13 but WITHOUT ANY WARRANTY; without even the implied warranty of 14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 GNU General Public License for more details. 16 17 You should have received a copy of the GNU General Public License 18 along with this program; if not, write to the Free Software 19 Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA. 20 */ 21 22 #include <linux/module.h> 23 #include <linux/firmware.h> 24 #include <drm/drmP.h> 25 #include <drm/drm_crtc.h> 26 #include <drm/drm_crtc_helper.h> 27 #include <drm/drm_edid.h> 28 29 static char edid_firmware[PATH_MAX]; 30 module_param_string(edid_firmware, edid_firmware, sizeof(edid_firmware), 0644); 31 MODULE_PARM_DESC(edid_firmware, "Do not probe monitor, use specified EDID blob " 32 "from built-in data or /lib/firmware instead. "); 33 34 #define GENERIC_EDIDS 4 35 static char *generic_edid_name[GENERIC_EDIDS] = { 36 "edid/1024x768.bin", 37 "edid/1280x1024.bin", 38 "edid/1680x1050.bin", 39 "edid/1920x1080.bin", 40 }; 41 42 static u8 generic_edid[GENERIC_EDIDS][128] = { 43 { 44 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 45 0x31, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 46 0x05, 0x16, 0x01, 0x03, 0x6d, 0x23, 0x1a, 0x78, 47 0xea, 0x5e, 0xc0, 0xa4, 0x59, 0x4a, 0x98, 0x25, 48 0x20, 0x50, 0x54, 0x00, 0x08, 0x00, 0x61, 0x40, 49 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 50 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x64, 0x19, 51 0x00, 0x40, 0x41, 0x00, 0x26, 0x30, 0x08, 0x90, 52 0x36, 0x00, 0x63, 0x0a, 0x11, 0x00, 0x00, 0x18, 53 0x00, 0x00, 0x00, 0xff, 0x00, 0x4c, 0x69, 0x6e, 54 0x75, 0x78, 0x20, 0x23, 0x30, 0x0a, 0x20, 0x20, 55 0x20, 0x20, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x3b, 56 0x3d, 0x2f, 0x31, 0x07, 0x00, 0x0a, 0x20, 0x20, 57 0x20, 0x20, 0x20, 0x20, 0x00, 0x00, 0x00, 0xfc, 58 0x00, 0x4c, 0x69, 0x6e, 0x75, 0x78, 0x20, 0x58, 59 0x47, 0x41, 0x0a, 0x20, 0x20, 0x20, 0x00, 0x55, 60 }, 61 { 62 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 63 0x31, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 64 0x05, 0x16, 0x01, 0x03, 0x6d, 0x2c, 0x23, 0x78, 65 0xea, 0x5e, 0xc0, 0xa4, 0x59, 0x4a, 0x98, 0x25, 66 0x20, 0x50, 0x54, 0x00, 0x00, 0x00, 0x81, 0x80, 67 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 68 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x30, 0x2a, 69 0x00, 0x98, 0x51, 0x00, 0x2a, 0x40, 0x30, 0x70, 70 0x13, 0x00, 0xbc, 0x63, 0x11, 0x00, 0x00, 0x1e, 71 0x00, 0x00, 0x00, 0xff, 0x00, 0x4c, 0x69, 0x6e, 72 0x75, 0x78, 0x20, 0x23, 0x30, 0x0a, 0x20, 0x20, 73 0x20, 0x20, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x3b, 74 0x3d, 0x3e, 0x40, 0x0b, 0x00, 0x0a, 0x20, 0x20, 75 0x20, 0x20, 0x20, 0x20, 0x00, 0x00, 0x00, 0xfc, 76 0x00, 0x4c, 0x69, 0x6e, 0x75, 0x78, 0x20, 0x53, 77 0x58, 0x47, 0x41, 0x0a, 0x20, 0x20, 0x00, 0xa0, 78 }, 79 { 80 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 81 0x31, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 82 0x05, 0x16, 0x01, 0x03, 0x6d, 0x2b, 0x1b, 0x78, 83 0xea, 0x5e, 0xc0, 0xa4, 0x59, 0x4a, 0x98, 0x25, 84 0x20, 0x50, 0x54, 0x00, 0x00, 0x00, 0xb3, 0x00, 85 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 86 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x21, 0x39, 87 0x90, 0x30, 0x62, 0x1a, 0x27, 0x40, 0x68, 0xb0, 88 0x36, 0x00, 0xb5, 0x11, 0x11, 0x00, 0x00, 0x1e, 89 0x00, 0x00, 0x00, 0xff, 0x00, 0x4c, 0x69, 0x6e, 90 0x75, 0x78, 0x20, 0x23, 0x30, 0x0a, 0x20, 0x20, 91 0x20, 0x20, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x3b, 92 0x3d, 0x40, 0x42, 0x0f, 0x00, 0x0a, 0x20, 0x20, 93 0x20, 0x20, 0x20, 0x20, 0x00, 0x00, 0x00, 0xfc, 94 0x00, 0x4c, 0x69, 0x6e, 0x75, 0x78, 0x20, 0x57, 95 0x53, 0x58, 0x47, 0x41, 0x0a, 0x20, 0x00, 0x26, 96 }, 97 { 98 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 99 0x31, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 100 0x05, 0x16, 0x01, 0x03, 0x6d, 0x32, 0x1c, 0x78, 101 0xea, 0x5e, 0xc0, 0xa4, 0x59, 0x4a, 0x98, 0x25, 102 0x20, 0x50, 0x54, 0x00, 0x00, 0x00, 0xd1, 0xc0, 103 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 104 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x3a, 105 0x80, 0x18, 0x71, 0x38, 0x2d, 0x40, 0x58, 0x2c, 106 0x45, 0x00, 0xf4, 0x19, 0x11, 0x00, 0x00, 0x1e, 107 0x00, 0x00, 0x00, 0xff, 0x00, 0x4c, 0x69, 0x6e, 108 0x75, 0x78, 0x20, 0x23, 0x30, 0x0a, 0x20, 0x20, 109 0x20, 0x20, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x3b, 110 0x3d, 0x42, 0x44, 0x0f, 0x00, 0x0a, 0x20, 0x20, 111 0x20, 0x20, 0x20, 0x20, 0x00, 0x00, 0x00, 0xfc, 112 0x00, 0x4c, 0x69, 0x6e, 0x75, 0x78, 0x20, 0x46, 113 0x48, 0x44, 0x0a, 0x20, 0x20, 0x20, 0x00, 0x05, 114 }, 115 }; 116 117 static u8 *edid_load(struct drm_connector *connector, char *name, 118 char *connector_name) 119 { 120 const struct firmware *fw; 121 struct platform_device *pdev; 122 u8 *fwdata = NULL, *edid, *new_edid; 123 int fwsize, expected; 124 int builtin = 0, err = 0; 125 int i, valid_extensions = 0; 126 bool print_bad_edid = !connector->bad_edid_counter || (drm_debug & DRM_UT_KMS); 127 128 pdev = platform_device_register_simple(connector_name, -1, NULL, 0); 129 if (IS_ERR(pdev)) { 130 DRM_ERROR("Failed to register EDID firmware platform device " 131 "for connector \"%s\"\n", connector_name); 132 err = -EINVAL; 133 goto out; 134 } 135 136 err = request_firmware(&fw, name, &pdev->dev); 137 platform_device_unregister(pdev); 138 139 if (err) { 140 i = 0; 141 while (i < GENERIC_EDIDS && strcmp(name, generic_edid_name[i])) 142 i++; 143 if (i < GENERIC_EDIDS) { 144 err = 0; 145 builtin = 1; 146 fwdata = generic_edid[i]; 147 fwsize = sizeof(generic_edid[i]); 148 } 149 } 150 151 if (err) { 152 DRM_ERROR("Requesting EDID firmware \"%s\" failed (err=%d)\n", 153 name, err); 154 goto out; 155 } 156 157 if (fwdata == NULL) { 158 fwdata = (u8 *) fw->data; 159 fwsize = fw->size; 160 } 161 162 expected = (fwdata[0x7e] + 1) * EDID_LENGTH; 163 if (expected != fwsize) { 164 DRM_ERROR("Size of EDID firmware \"%s\" is invalid " 165 "(expected %d, got %d)\n", name, expected, (int) fwsize); 166 err = -EINVAL; 167 goto relfw_out; 168 } 169 170 edid = kmalloc(fwsize, GFP_KERNEL); 171 if (edid == NULL) { 172 err = -ENOMEM; 173 goto relfw_out; 174 } 175 memcpy(edid, fwdata, fwsize); 176 177 if (!drm_edid_block_valid(edid, 0, print_bad_edid)) { 178 connector->bad_edid_counter++; 179 DRM_ERROR("Base block of EDID firmware \"%s\" is invalid ", 180 name); 181 kfree(edid); 182 err = -EINVAL; 183 goto relfw_out; 184 } 185 186 for (i = 1; i <= edid[0x7e]; i++) { 187 if (i != valid_extensions + 1) 188 memcpy(edid + (valid_extensions + 1) * EDID_LENGTH, 189 edid + i * EDID_LENGTH, EDID_LENGTH); 190 if (drm_edid_block_valid(edid + i * EDID_LENGTH, i, print_bad_edid)) 191 valid_extensions++; 192 } 193 194 if (valid_extensions != edid[0x7e]) { 195 edid[EDID_LENGTH-1] += edid[0x7e] - valid_extensions; 196 DRM_INFO("Found %d valid extensions instead of %d in EDID data " 197 "\"%s\" for connector \"%s\"\n", valid_extensions, 198 edid[0x7e], name, connector_name); 199 edid[0x7e] = valid_extensions; 200 new_edid = krealloc(edid, (valid_extensions + 1) * EDID_LENGTH, 201 GFP_KERNEL); 202 if (new_edid == NULL) { 203 err = -ENOMEM; 204 kfree(edid); 205 goto relfw_out; 206 } 207 edid = new_edid; 208 } 209 210 DRM_INFO("Got %s EDID base block and %d extension%s from " 211 "\"%s\" for connector \"%s\"\n", builtin ? "built-in" : 212 "external", valid_extensions, valid_extensions == 1 ? "" : "s", 213 name, connector_name); 214 215 relfw_out: 216 release_firmware(fw); 217 218 out: 219 if (err) 220 return ERR_PTR(err); 221 222 return edid; 223 } 224 225 int drm_load_edid_firmware(struct drm_connector *connector) 226 { 227 char *connector_name = drm_get_connector_name(connector); 228 char *edidname = edid_firmware, *last, *colon; 229 int ret; 230 struct edid *edid; 231 232 if (*edidname == '\0') 233 return 0; 234 235 colon = strchr(edidname, ':'); 236 if (colon != NULL) { 237 if (strncmp(connector_name, edidname, colon - edidname)) 238 return 0; 239 edidname = colon + 1; 240 if (*edidname == '\0') 241 return 0; 242 } 243 244 last = edidname + strlen(edidname) - 1; 245 if (*last == '\n') 246 *last = '\0'; 247 248 edid = (struct edid *) edid_load(connector, edidname, connector_name); 249 if (IS_ERR_OR_NULL(edid)) 250 return 0; 251 252 drm_mode_connector_update_edid_property(connector, edid); 253 ret = drm_add_edid_modes(connector, edid); 254 kfree(edid); 255 256 return ret; 257 } 258