1 /* 2 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd 3 * Author:Mark Yao <mark.yao@rock-chips.com> 4 * 5 * based on exynos_drm_drv.c 6 * 7 * This software is licensed under the terms of the GNU General Public 8 * License version 2, as published by the Free Software Foundation, and 9 * may be copied, distributed, and modified under those terms. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <asm/dma-iommu.h> 18 19 #include <drm/drmP.h> 20 #include <drm/drm_crtc_helper.h> 21 #include <drm/drm_fb_helper.h> 22 #include <drm/drm_of.h> 23 #include <linux/dma-mapping.h> 24 #include <linux/pm_runtime.h> 25 #include <linux/module.h> 26 #include <linux/of_graph.h> 27 #include <linux/component.h> 28 29 #include "rockchip_drm_drv.h" 30 #include "rockchip_drm_fb.h" 31 #include "rockchip_drm_fbdev.h" 32 #include "rockchip_drm_gem.h" 33 34 #define DRIVER_NAME "rockchip" 35 #define DRIVER_DESC "RockChip Soc DRM" 36 #define DRIVER_DATE "20140818" 37 #define DRIVER_MAJOR 1 38 #define DRIVER_MINOR 0 39 40 /* 41 * Attach a (component) device to the shared drm dma mapping from master drm 42 * device. This is used by the VOPs to map GEM buffers to a common DMA 43 * mapping. 44 */ 45 int rockchip_drm_dma_attach_device(struct drm_device *drm_dev, 46 struct device *dev) 47 { 48 struct dma_iommu_mapping *mapping = drm_dev->dev->archdata.mapping; 49 int ret; 50 51 ret = dma_set_coherent_mask(dev, DMA_BIT_MASK(32)); 52 if (ret) 53 return ret; 54 55 dma_set_max_seg_size(dev, DMA_BIT_MASK(32)); 56 57 return arm_iommu_attach_device(dev, mapping); 58 } 59 EXPORT_SYMBOL_GPL(rockchip_drm_dma_attach_device); 60 61 void rockchip_drm_dma_detach_device(struct drm_device *drm_dev, 62 struct device *dev) 63 { 64 arm_iommu_detach_device(dev); 65 } 66 EXPORT_SYMBOL_GPL(rockchip_drm_dma_detach_device); 67 68 int rockchip_register_crtc_funcs(struct drm_device *dev, 69 const struct rockchip_crtc_funcs *crtc_funcs, 70 int pipe) 71 { 72 struct rockchip_drm_private *priv = dev->dev_private; 73 74 if (pipe > ROCKCHIP_MAX_CRTC) 75 return -EINVAL; 76 77 priv->crtc_funcs[pipe] = crtc_funcs; 78 79 return 0; 80 } 81 EXPORT_SYMBOL_GPL(rockchip_register_crtc_funcs); 82 83 void rockchip_unregister_crtc_funcs(struct drm_device *dev, int pipe) 84 { 85 struct rockchip_drm_private *priv = dev->dev_private; 86 87 if (pipe > ROCKCHIP_MAX_CRTC) 88 return; 89 90 priv->crtc_funcs[pipe] = NULL; 91 } 92 EXPORT_SYMBOL_GPL(rockchip_unregister_crtc_funcs); 93 94 static struct drm_crtc *rockchip_crtc_from_pipe(struct drm_device *drm, 95 int pipe) 96 { 97 struct drm_crtc *crtc; 98 int i = 0; 99 100 list_for_each_entry(crtc, &drm->mode_config.crtc_list, head) 101 if (i++ == pipe) 102 return crtc; 103 104 return NULL; 105 } 106 107 static int rockchip_drm_crtc_enable_vblank(struct drm_device *dev, 108 unsigned int pipe) 109 { 110 struct rockchip_drm_private *priv = dev->dev_private; 111 struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe); 112 113 if (crtc && priv->crtc_funcs[pipe] && 114 priv->crtc_funcs[pipe]->enable_vblank) 115 return priv->crtc_funcs[pipe]->enable_vblank(crtc); 116 117 return 0; 118 } 119 120 static void rockchip_drm_crtc_disable_vblank(struct drm_device *dev, 121 unsigned int pipe) 122 { 123 struct rockchip_drm_private *priv = dev->dev_private; 124 struct drm_crtc *crtc = rockchip_crtc_from_pipe(dev, pipe); 125 126 if (crtc && priv->crtc_funcs[pipe] && 127 priv->crtc_funcs[pipe]->enable_vblank) 128 priv->crtc_funcs[pipe]->disable_vblank(crtc); 129 } 130 131 static int rockchip_drm_load(struct drm_device *drm_dev, unsigned long flags) 132 { 133 struct rockchip_drm_private *private; 134 struct dma_iommu_mapping *mapping; 135 struct device *dev = drm_dev->dev; 136 struct drm_connector *connector; 137 int ret; 138 139 private = devm_kzalloc(drm_dev->dev, sizeof(*private), GFP_KERNEL); 140 if (!private) 141 return -ENOMEM; 142 143 drm_dev->dev_private = private; 144 145 drm_mode_config_init(drm_dev); 146 147 rockchip_drm_mode_config_init(drm_dev); 148 149 dev->dma_parms = devm_kzalloc(dev, sizeof(*dev->dma_parms), 150 GFP_KERNEL); 151 if (!dev->dma_parms) { 152 ret = -ENOMEM; 153 goto err_config_cleanup; 154 } 155 156 /* TODO(djkurtz): fetch the mapping start/size from somewhere */ 157 mapping = arm_iommu_create_mapping(&platform_bus_type, 0x00000000, 158 SZ_2G); 159 if (IS_ERR(mapping)) { 160 ret = PTR_ERR(mapping); 161 goto err_config_cleanup; 162 } 163 164 ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(32)); 165 if (ret) 166 goto err_release_mapping; 167 168 dma_set_max_seg_size(dev, DMA_BIT_MASK(32)); 169 170 ret = arm_iommu_attach_device(dev, mapping); 171 if (ret) 172 goto err_release_mapping; 173 174 /* Try to bind all sub drivers. */ 175 ret = component_bind_all(dev, drm_dev); 176 if (ret) 177 goto err_detach_device; 178 179 /* 180 * All components are now added, we can publish the connector sysfs 181 * entries to userspace. This will generate hotplug events and so 182 * userspace will expect to be able to access DRM at this point. 183 */ 184 list_for_each_entry(connector, &drm_dev->mode_config.connector_list, 185 head) { 186 ret = drm_connector_register(connector); 187 if (ret) { 188 dev_err(drm_dev->dev, 189 "[CONNECTOR:%d:%s] drm_connector_register failed: %d\n", 190 connector->base.id, 191 connector->name, ret); 192 goto err_unbind; 193 } 194 } 195 196 /* init kms poll for handling hpd */ 197 drm_kms_helper_poll_init(drm_dev); 198 199 /* 200 * enable drm irq mode. 201 * - with irq_enabled = true, we can use the vblank feature. 202 */ 203 drm_dev->irq_enabled = true; 204 205 ret = drm_vblank_init(drm_dev, ROCKCHIP_MAX_CRTC); 206 if (ret) 207 goto err_kms_helper_poll_fini; 208 209 /* 210 * with vblank_disable_allowed = true, vblank interrupt will be disabled 211 * by drm timer once a current process gives up ownership of 212 * vblank event.(after drm_vblank_put function is called) 213 */ 214 drm_dev->vblank_disable_allowed = true; 215 216 ret = rockchip_drm_fbdev_init(drm_dev); 217 if (ret) 218 goto err_vblank_cleanup; 219 220 return 0; 221 err_vblank_cleanup: 222 drm_vblank_cleanup(drm_dev); 223 err_kms_helper_poll_fini: 224 drm_kms_helper_poll_fini(drm_dev); 225 err_unbind: 226 component_unbind_all(dev, drm_dev); 227 err_detach_device: 228 arm_iommu_detach_device(dev); 229 err_release_mapping: 230 arm_iommu_release_mapping(dev->archdata.mapping); 231 err_config_cleanup: 232 drm_mode_config_cleanup(drm_dev); 233 drm_dev->dev_private = NULL; 234 return ret; 235 } 236 237 static int rockchip_drm_unload(struct drm_device *drm_dev) 238 { 239 struct device *dev = drm_dev->dev; 240 241 rockchip_drm_fbdev_fini(drm_dev); 242 drm_vblank_cleanup(drm_dev); 243 drm_kms_helper_poll_fini(drm_dev); 244 component_unbind_all(dev, drm_dev); 245 arm_iommu_detach_device(dev); 246 arm_iommu_release_mapping(dev->archdata.mapping); 247 drm_mode_config_cleanup(drm_dev); 248 drm_dev->dev_private = NULL; 249 250 return 0; 251 } 252 253 void rockchip_drm_lastclose(struct drm_device *dev) 254 { 255 struct rockchip_drm_private *priv = dev->dev_private; 256 257 drm_fb_helper_restore_fbdev_mode_unlocked(&priv->fbdev_helper); 258 } 259 260 static const struct file_operations rockchip_drm_driver_fops = { 261 .owner = THIS_MODULE, 262 .open = drm_open, 263 .mmap = rockchip_gem_mmap, 264 .poll = drm_poll, 265 .read = drm_read, 266 .unlocked_ioctl = drm_ioctl, 267 #ifdef CONFIG_COMPAT 268 .compat_ioctl = drm_compat_ioctl, 269 #endif 270 .release = drm_release, 271 }; 272 273 const struct vm_operations_struct rockchip_drm_vm_ops = { 274 .open = drm_gem_vm_open, 275 .close = drm_gem_vm_close, 276 }; 277 278 static struct drm_driver rockchip_drm_driver = { 279 .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME, 280 .load = rockchip_drm_load, 281 .unload = rockchip_drm_unload, 282 .lastclose = rockchip_drm_lastclose, 283 .get_vblank_counter = drm_vblank_no_hw_counter, 284 .enable_vblank = rockchip_drm_crtc_enable_vblank, 285 .disable_vblank = rockchip_drm_crtc_disable_vblank, 286 .gem_vm_ops = &rockchip_drm_vm_ops, 287 .gem_free_object = rockchip_gem_free_object, 288 .dumb_create = rockchip_gem_dumb_create, 289 .dumb_map_offset = rockchip_gem_dumb_map_offset, 290 .dumb_destroy = drm_gem_dumb_destroy, 291 .prime_handle_to_fd = drm_gem_prime_handle_to_fd, 292 .prime_fd_to_handle = drm_gem_prime_fd_to_handle, 293 .gem_prime_import = drm_gem_prime_import, 294 .gem_prime_export = drm_gem_prime_export, 295 .gem_prime_get_sg_table = rockchip_gem_prime_get_sg_table, 296 .gem_prime_vmap = rockchip_gem_prime_vmap, 297 .gem_prime_vunmap = rockchip_gem_prime_vunmap, 298 .gem_prime_mmap = rockchip_gem_mmap_buf, 299 .fops = &rockchip_drm_driver_fops, 300 .name = DRIVER_NAME, 301 .desc = DRIVER_DESC, 302 .date = DRIVER_DATE, 303 .major = DRIVER_MAJOR, 304 .minor = DRIVER_MINOR, 305 }; 306 307 #ifdef CONFIG_PM_SLEEP 308 static int rockchip_drm_sys_suspend(struct device *dev) 309 { 310 struct drm_device *drm = dev_get_drvdata(dev); 311 struct drm_connector *connector; 312 313 if (!drm) 314 return 0; 315 316 drm_modeset_lock_all(drm); 317 list_for_each_entry(connector, &drm->mode_config.connector_list, head) { 318 int old_dpms = connector->dpms; 319 320 if (connector->funcs->dpms) 321 connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF); 322 323 /* Set the old mode back to the connector for resume */ 324 connector->dpms = old_dpms; 325 } 326 drm_modeset_unlock_all(drm); 327 328 return 0; 329 } 330 331 static int rockchip_drm_sys_resume(struct device *dev) 332 { 333 struct drm_device *drm = dev_get_drvdata(dev); 334 struct drm_connector *connector; 335 enum drm_connector_status status; 336 bool changed = false; 337 338 if (!drm) 339 return 0; 340 341 drm_modeset_lock_all(drm); 342 list_for_each_entry(connector, &drm->mode_config.connector_list, head) { 343 int desired_mode = connector->dpms; 344 345 /* 346 * at suspend time, we save dpms to connector->dpms, 347 * restore the old_dpms, and at current time, the connector 348 * dpms status must be DRM_MODE_DPMS_OFF. 349 */ 350 connector->dpms = DRM_MODE_DPMS_OFF; 351 352 /* 353 * If the connector has been disconnected during suspend, 354 * disconnect it from the encoder and leave it off. We'll notify 355 * userspace at the end. 356 */ 357 if (desired_mode == DRM_MODE_DPMS_ON) { 358 status = connector->funcs->detect(connector, true); 359 if (status == connector_status_disconnected) { 360 connector->encoder = NULL; 361 connector->status = status; 362 changed = true; 363 continue; 364 } 365 } 366 if (connector->funcs->dpms) 367 connector->funcs->dpms(connector, desired_mode); 368 } 369 drm_modeset_unlock_all(drm); 370 371 drm_helper_resume_force_mode(drm); 372 373 if (changed) 374 drm_kms_helper_hotplug_event(drm); 375 376 return 0; 377 } 378 #endif 379 380 static const struct dev_pm_ops rockchip_drm_pm_ops = { 381 SET_SYSTEM_SLEEP_PM_OPS(rockchip_drm_sys_suspend, 382 rockchip_drm_sys_resume) 383 }; 384 385 /* 386 * @node: device tree node containing encoder input ports 387 * @encoder: drm_encoder 388 */ 389 int rockchip_drm_encoder_get_mux_id(struct device_node *node, 390 struct drm_encoder *encoder) 391 { 392 struct device_node *ep; 393 struct drm_crtc *crtc = encoder->crtc; 394 struct of_endpoint endpoint; 395 struct device_node *port; 396 int ret; 397 398 if (!node || !crtc) 399 return -EINVAL; 400 401 for_each_endpoint_of_node(node, ep) { 402 port = of_graph_get_remote_port(ep); 403 of_node_put(port); 404 if (port == crtc->port) { 405 ret = of_graph_parse_endpoint(ep, &endpoint); 406 of_node_put(ep); 407 return ret ?: endpoint.id; 408 } 409 } 410 411 return -EINVAL; 412 } 413 EXPORT_SYMBOL_GPL(rockchip_drm_encoder_get_mux_id); 414 415 static int compare_of(struct device *dev, void *data) 416 { 417 struct device_node *np = data; 418 419 return dev->of_node == np; 420 } 421 422 static int rockchip_drm_bind(struct device *dev) 423 { 424 struct drm_device *drm; 425 int ret; 426 427 drm = drm_dev_alloc(&rockchip_drm_driver, dev); 428 if (!drm) 429 return -ENOMEM; 430 431 ret = drm_dev_set_unique(drm, "%s", dev_name(dev)); 432 if (ret) 433 goto err_free; 434 435 ret = drm_dev_register(drm, 0); 436 if (ret) 437 goto err_free; 438 439 dev_set_drvdata(dev, drm); 440 441 return 0; 442 443 err_free: 444 drm_dev_unref(drm); 445 return ret; 446 } 447 448 static void rockchip_drm_unbind(struct device *dev) 449 { 450 struct drm_device *drm = dev_get_drvdata(dev); 451 452 drm_dev_unregister(drm); 453 drm_dev_unref(drm); 454 dev_set_drvdata(dev, NULL); 455 } 456 457 static const struct component_master_ops rockchip_drm_ops = { 458 .bind = rockchip_drm_bind, 459 .unbind = rockchip_drm_unbind, 460 }; 461 462 static int rockchip_drm_platform_probe(struct platform_device *pdev) 463 { 464 int ret = drm_of_component_probe(&pdev->dev, compare_of, 465 &rockchip_drm_ops); 466 467 /* keep compatibility with old code that was returning -ENODEV */ 468 if (ret == -EINVAL) 469 return -ENODEV; 470 471 return ret; 472 } 473 474 static int rockchip_drm_platform_remove(struct platform_device *pdev) 475 { 476 component_master_del(&pdev->dev, &rockchip_drm_ops); 477 478 return 0; 479 } 480 481 static const struct of_device_id rockchip_drm_dt_ids[] = { 482 { .compatible = "rockchip,display-subsystem", }, 483 { /* sentinel */ }, 484 }; 485 MODULE_DEVICE_TABLE(of, rockchip_drm_dt_ids); 486 487 static struct platform_driver rockchip_drm_platform_driver = { 488 .probe = rockchip_drm_platform_probe, 489 .remove = rockchip_drm_platform_remove, 490 .driver = { 491 .name = "rockchip-drm", 492 .of_match_table = rockchip_drm_dt_ids, 493 .pm = &rockchip_drm_pm_ops, 494 }, 495 }; 496 497 module_platform_driver(rockchip_drm_platform_driver); 498 499 MODULE_AUTHOR("Mark Yao <mark.yao@rock-chips.com>"); 500 MODULE_DESCRIPTION("ROCKCHIP DRM Driver"); 501 MODULE_LICENSE("GPL v2"); 502