drivers/gpu/drm/amd/display/amdgpu_dm/amdgpu_dm_irq.c

   1 /*
   2  * Copyright 2015 Advanced Micro Devices, Inc.
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20  * OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * Authors: AMD
  23  *
  24  */
  25
  26 #include "dm_services_types.h"
  27 #include "dc.h"
  28
  29 #include "amdgpu.h"
  30 #include "amdgpu_dm.h"
  31 #include "amdgpu_dm_irq.h"
  32
  33 /**
  34  * DOC: overview
  35  *
  36  * DM provides another layer of IRQ management on top of what the base driver
  37  * already provides. This is something that could be cleaned up, and is a
  38  * future TODO item.
  39  *
  40  * The base driver provides IRQ source registration with DRM, handler
  41  * registration into the base driver's IRQ table, and a handler callback
  42  * amdgpu_irq_handler(), with which DRM calls on interrupts. This generic
  43  * handler looks up the IRQ table, and calls the respective
  44  * &amdgpu_irq_src_funcs.process hookups.
  45  *
  46  * What DM provides on top are two IRQ tables specifically for top-half and
  47  * bottom-half IRQ handling, with the bottom-half implementing workqueues:
  48  *
  49  * - &amdgpu_display_manager.irq_handler_list_high_tab
  50  * - &amdgpu_display_manager.irq_handler_list_low_tab
  51  *
  52  * They override the base driver's IRQ table, and the effect can be seen
  53  * in the hooks that DM provides for &amdgpu_irq_src_funcs.process. They
  54  * are all set to the DM generic handler amdgpu_dm_irq_handler(), which looks up
  55  * DM's IRQ tables. However, in order for base driver to recognize this hook, DM
  56  * still needs to register the IRQ with the base driver. See
  57  * dce110_register_irq_handlers() and dcn10_register_irq_handlers().
  58  *
  59  * To expose DC's hardware interrupt toggle to the base driver, DM implements
  60  * &amdgpu_irq_src_funcs.set hooks. Base driver calls it through
  61  * amdgpu_irq_update() to enable or disable the interrupt.
  62  */
  63
  64 /******************************************************************************
  65  * Private declarations.
  66  *****************************************************************************/
  67
  68 /**
  69  * struct amdgpu_dm_irq_handler_data - Data for DM interrupt handlers.
  70  *
  71  * @list: Linked list entry referencing the next/previous handler
  72  * @handler: Handler function
  73  * @handler_arg: Argument passed to the handler when triggered
  74  * @dm: DM which this handler belongs to
  75  * @irq_source: DC interrupt source that this handler is registered for
  76  * @work: work struct
  77  */
  78 struct amdgpu_dm_irq_handler_data {
  79         struct list_head list;
  80         interrupt_handler handler;
  81         void *handler_arg;
  82
  83         struct amdgpu_display_manager *dm;
  84         /* DAL irq source which registered for this interrupt. */
  85         enum dc_irq_source irq_source;
  86         struct work_struct work;
  87 };
  88
  89 #define DM_IRQ_TABLE_LOCK(adev, flags) \
  90         spin_lock_irqsave(&adev->dm.irq_handler_list_table_lock, flags)
  91
  92 #define DM_IRQ_TABLE_UNLOCK(adev, flags) \
  93         spin_unlock_irqrestore(&adev->dm.irq_handler_list_table_lock, flags)
  94
  95 /******************************************************************************
  96  * Private functions.
  97  *****************************************************************************/
  98
  99 static void init_handler_common_data(struct amdgpu_dm_irq_handler_data *hcd,
 100                                      void (*ih)(void *),
 101                                      void *args,
 102                                      struct amdgpu_display_manager *dm)
 103 {
 104         hcd->handler = ih;
 105         hcd->handler_arg = args;
 106         hcd->dm = dm;
 107 }
 108
 109 /**
 110  * dm_irq_work_func() - Handle an IRQ outside of the interrupt handler proper.
 111  *
 112  * @work: work struct
 113  */
 114 static void dm_irq_work_func(struct work_struct *work)
 115 {
 116         struct amdgpu_dm_irq_handler_data *handler_data =
 117                 container_of(work, struct amdgpu_dm_irq_handler_data, work);
 118
 119         handler_data->handler(handler_data->handler_arg);
 120
 121         /* Call a DAL subcomponent which registered for interrupt notification
 122          * at INTERRUPT_LOW_IRQ_CONTEXT.
 123          * (The most common use is HPD interrupt)
 124          */
 125 }
 126
 127 /*
 128  * Remove a handler and return a pointer to handler list from which the
 129  * handler was removed.
 130  */
 131 static struct list_head *remove_irq_handler(struct amdgpu_device *adev,
 132                                             void *ih,
 133                                             const struct dc_interrupt_params *int_params)
 134 {
 135         struct list_head *hnd_list;
 136         struct list_head *entry, *tmp;
 137         struct amdgpu_dm_irq_handler_data *handler;
 138         unsigned long irq_table_flags;
 139         bool handler_removed = false;
 140         enum dc_irq_source irq_source;
 141
 142         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 143
 144         irq_source = int_params->irq_source;
 145
 146         switch (int_params->int_context) {
 147         case INTERRUPT_HIGH_IRQ_CONTEXT:
 148                 hnd_list = &adev->dm.irq_handler_list_high_tab[irq_source];
 149                 break;
 150         case INTERRUPT_LOW_IRQ_CONTEXT:
 151         default:
 152                 hnd_list = &adev->dm.irq_handler_list_low_tab[irq_source];
 153                 break;
 154         }
 155
 156         list_for_each_safe(entry, tmp, hnd_list) {
 157
 158                 handler = list_entry(entry, struct amdgpu_dm_irq_handler_data,
 159                                      list);
 160
 161                 if (handler == NULL)
 162                         continue;
 163
 164                 if (ih == handler->handler) {
 165                         /* Found our handler. Remove it from the list. */
 166                         list_del(&handler->list);
 167                         handler_removed = true;
 168                         break;
 169                 }
 170         }
 171
 172         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 173
 174         if (handler_removed == false) {
 175                 /* Not necessarily an error - caller may not
 176                  * know the context.
 177                  */
 178                 return NULL;
 179         }
 180
 181         kfree(handler);
 182
 183         DRM_DEBUG_KMS(
 184         "DM_IRQ: removed irq handler: %p for: dal_src=%d, irq context=%d\n",
 185                 ih, int_params->irq_source, int_params->int_context);
 186
 187         return hnd_list;
 188 }
 189
 190 /**
 191  * unregister_all_irq_handlers() - Cleans up handlers from the DM IRQ table
 192  * @adev: The base driver device containing the DM device
 193  *
 194  * Go through low and high context IRQ tables and deallocate handlers.
 195  */
 196 static void unregister_all_irq_handlers(struct amdgpu_device *adev)
 197 {
 198         struct list_head *hnd_list_low;
 199         struct list_head *hnd_list_high;
 200         struct list_head *entry, *tmp;
 201         struct amdgpu_dm_irq_handler_data *handler;
 202         unsigned long irq_table_flags;
 203         int i;
 204
 205         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 206
 207         for (i = 0; i < DAL_IRQ_SOURCES_NUMBER; i++) {
 208                 hnd_list_low = &adev->dm.irq_handler_list_low_tab[i];
 209                 hnd_list_high = &adev->dm.irq_handler_list_high_tab[i];
 210
 211                 list_for_each_safe(entry, tmp, hnd_list_low) {
 212
 213                         handler = list_entry(entry, struct amdgpu_dm_irq_handler_data,
 214                                              list);
 215
 216                         if (handler == NULL || handler->handler == NULL)
 217                                 continue;
 218
 219                         list_del(&handler->list);
 220                         kfree(handler);
 221                 }
 222
 223                 list_for_each_safe(entry, tmp, hnd_list_high) {
 224
 225                         handler = list_entry(entry, struct amdgpu_dm_irq_handler_data,
 226                                              list);
 227
 228                         if (handler == NULL || handler->handler == NULL)
 229                                 continue;
 230
 231                         list_del(&handler->list);
 232                         kfree(handler);
 233                 }
 234         }
 235
 236         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 237 }
 238
 239 static bool
 240 validate_irq_registration_params(struct dc_interrupt_params *int_params,
 241                                  void (*ih)(void *))
 242 {
 243         if (NULL == int_params || NULL == ih) {
 244                 DRM_ERROR("DM_IRQ: invalid input!\n");
 245                 return false;
 246         }
 247
 248         if (int_params->int_context >= INTERRUPT_CONTEXT_NUMBER) {
 249                 DRM_ERROR("DM_IRQ: invalid context: %d!\n",
 250                                 int_params->int_context);
 251                 return false;
 252         }
 253
 254         if (!DAL_VALID_IRQ_SRC_NUM(int_params->irq_source)) {
 255                 DRM_ERROR("DM_IRQ: invalid irq_source: %d!\n",
 256                                 int_params->irq_source);
 257                 return false;
 258         }
 259
 260         return true;
 261 }
 262
 263 static bool validate_irq_unregistration_params(enum dc_irq_source irq_source,
 264                                                irq_handler_idx handler_idx)
 265 {
 266         if (handler_idx == DAL_INVALID_IRQ_HANDLER_IDX) {
 267                 DRM_ERROR("DM_IRQ: invalid handler_idx==NULL!\n");
 268                 return false;
 269         }
 270
 271         if (!DAL_VALID_IRQ_SRC_NUM(irq_source)) {
 272                 DRM_ERROR("DM_IRQ: invalid irq_source:%d!\n", irq_source);
 273                 return false;
 274         }
 275
 276         return true;
 277 }
 278 /******************************************************************************
 279  * Public functions.
 280  *
 281  * Note: caller is responsible for input validation.
 282  *****************************************************************************/
 283
 284 /**
 285  * amdgpu_dm_irq_register_interrupt() - Register a handler within DM.
 286  * @adev: The base driver device containing the DM device.
 287  * @int_params: Interrupt parameters containing the source, and handler context
 288  * @ih: Function pointer to the interrupt handler to register
 289  * @handler_args: Arguments passed to the handler when the interrupt occurs
 290  *
 291  * Register an interrupt handler for the given IRQ source, under the given
 292  * context. The context can either be high or low. High context handlers are
 293  * executed directly within ISR context, while low context is executed within a
 294  * workqueue, thereby allowing operations that sleep.
 295  *
 296  * Registered handlers are called in a FIFO manner, i.e. the most recently
 297  * registered handler will be called first.
 298  *
 299  * Return: Handler data &struct amdgpu_dm_irq_handler_data containing the IRQ
 300  *         source, handler function, and args
 301  */
 302 void *amdgpu_dm_irq_register_interrupt(struct amdgpu_device *adev,
 303                                        struct dc_interrupt_params *int_params,
 304                                        void (*ih)(void *),
 305                                        void *handler_args)
 306 {
 307         struct list_head *hnd_list;
 308         struct amdgpu_dm_irq_handler_data *handler_data;
 309         unsigned long irq_table_flags;
 310         enum dc_irq_source irq_source;
 311
 312         if (false == validate_irq_registration_params(int_params, ih))
 313                 return DAL_INVALID_IRQ_HANDLER_IDX;
 314
 315         handler_data = kzalloc(sizeof(*handler_data), GFP_KERNEL);
 316         if (!handler_data) {
 317                 DRM_ERROR("DM_IRQ: failed to allocate irq handler!\n");
 318                 return DAL_INVALID_IRQ_HANDLER_IDX;
 319         }
 320
 321         init_handler_common_data(handler_data, ih, handler_args, &adev->dm);
 322
 323         irq_source = int_params->irq_source;
 324
 325         handler_data->irq_source = irq_source;
 326
 327         /* Lock the list, add the handler. */
 328         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 329
 330         switch (int_params->int_context) {
 331         case INTERRUPT_HIGH_IRQ_CONTEXT:
 332                 hnd_list = &adev->dm.irq_handler_list_high_tab[irq_source];
 333                 break;
 334         case INTERRUPT_LOW_IRQ_CONTEXT:
 335         default:
 336                 hnd_list = &adev->dm.irq_handler_list_low_tab[irq_source];
 337                 INIT_WORK(&handler_data->work, dm_irq_work_func);
 338                 break;
 339         }
 340
 341         list_add_tail(&handler_data->list, hnd_list);
 342
 343         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 344
 345         /* This pointer will be stored by code which requested interrupt
 346          * registration.
 347          * The same pointer will be needed in order to unregister the
 348          * interrupt.
 349          */
 350
 351         DRM_DEBUG_KMS(
 352                 "DM_IRQ: added irq handler: %p for: dal_src=%d, irq context=%d\n",
 353                 handler_data,
 354                 irq_source,
 355                 int_params->int_context);
 356
 357         return handler_data;
 358 }
 359
 360 /**
 361  * amdgpu_dm_irq_unregister_interrupt() - Remove a handler from the DM IRQ table
 362  * @adev: The base driver device containing the DM device
 363  * @irq_source: IRQ source to remove the given handler from
 364  * @ih: Function pointer to the interrupt handler to unregister
 365  *
 366  * Go through both low and high context IRQ tables, and find the given handler
 367  * for the given irq source. If found, remove it. Otherwise, do nothing.
 368  */
 369 void amdgpu_dm_irq_unregister_interrupt(struct amdgpu_device *adev,
 370                                         enum dc_irq_source irq_source,
 371                                         void *ih)
 372 {
 373         struct list_head *handler_list;
 374         struct dc_interrupt_params int_params;
 375         int i;
 376
 377         if (false == validate_irq_unregistration_params(irq_source, ih))
 378                 return;
 379
 380         memset(&int_params, 0, sizeof(int_params));
 381
 382         int_params.irq_source = irq_source;
 383
 384         for (i = 0; i < INTERRUPT_CONTEXT_NUMBER; i++) {
 385
 386                 int_params.int_context = i;
 387
 388                 handler_list = remove_irq_handler(adev, ih, &int_params);
 389
 390                 if (handler_list != NULL)
 391                         break;
 392         }
 393
 394         if (handler_list == NULL) {
 395                 /* If we got here, it means we searched all irq contexts
 396                  * for this irq source, but the handler was not found.
 397                  */
 398                 DRM_ERROR(
 399                 "DM_IRQ: failed to find irq handler:%p for irq_source:%d!\n",
 400                         ih, irq_source);
 401         }
 402 }
 403
 404 /**
 405  * amdgpu_dm_irq_init() - Initialize DM IRQ management
 406  * @adev:  The base driver device containing the DM device
 407  *
 408  * Initialize DM's high and low context IRQ tables.
 409  *
 410  * The N by M table contains N IRQ sources, with M
 411  * &struct amdgpu_dm_irq_handler_data hooked together in a linked list. The
 412  * list_heads are initialized here. When an interrupt n is triggered, all m
 413  * handlers are called in sequence, FIFO according to registration order.
 414  *
 415  * The low context table requires special steps to initialize, since handlers
 416  * will be deferred to a workqueue. See &struct irq_list_head.
 417  */
 418 int amdgpu_dm_irq_init(struct amdgpu_device *adev)
 419 {
 420         int src;
 421         struct list_head *lh;
 422
 423         DRM_DEBUG_KMS("DM_IRQ\n");
 424
 425         spin_lock_init(&adev->dm.irq_handler_list_table_lock);
 426
 427         for (src = 0; src < DAL_IRQ_SOURCES_NUMBER; src++) {
 428                 /* low context handler list init */
 429                 lh = &adev->dm.irq_handler_list_low_tab[src];
 430                 INIT_LIST_HEAD(lh);
 431                 /* high context handler init */
 432                 INIT_LIST_HEAD(&adev->dm.irq_handler_list_high_tab[src]);
 433         }
 434
 435         return 0;
 436 }
 437
 438 /**
 439  * amdgpu_dm_irq_fini() - Tear down DM IRQ management
 440  * @adev: The base driver device containing the DM device
 441  *
 442  * Flush all work within the low context IRQ table.
 443  */
 444 void amdgpu_dm_irq_fini(struct amdgpu_device *adev)
 445 {
 446         int src;
 447         struct list_head *lh;
 448         struct list_head *entry, *tmp;
 449         struct amdgpu_dm_irq_handler_data *handler;
 450         unsigned long irq_table_flags;
 451
 452         DRM_DEBUG_KMS("DM_IRQ: releasing resources.\n");
 453         for (src = 0; src < DAL_IRQ_SOURCES_NUMBER; src++) {
 454                 DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 455                 /* The handler was removed from the table,
 456                  * it means it is safe to flush all the 'work'
 457                  * (because no code can schedule a new one).
 458                  */
 459                 lh = &adev->dm.irq_handler_list_low_tab[src];
 460                 DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 461
 462                 if (!list_empty(lh)) {
 463                         list_for_each_safe(entry, tmp, lh) {
 464                                 handler = list_entry(
 465                                         entry,
 466                                         struct amdgpu_dm_irq_handler_data,
 467                                         list);
 468                                 flush_work(&handler->work);
 469                         }
 470                 }
 471         }
 472         /* Deallocate handlers from the table. */
 473         unregister_all_irq_handlers(adev);
 474 }
 475
 476 int amdgpu_dm_irq_suspend(struct amdgpu_device *adev)
 477 {
 478         int src;
 479         struct list_head *hnd_list_h;
 480         struct list_head *hnd_list_l;
 481         unsigned long irq_table_flags;
 482         struct list_head *entry, *tmp;
 483         struct amdgpu_dm_irq_handler_data *handler;
 484
 485         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 486
 487         DRM_DEBUG_KMS("DM_IRQ: suspend\n");
 488
 489         /**
 490          * Disable HW interrupt  for HPD and HPDRX only since FLIP and VBLANK
 491          * will be disabled from manage_dm_interrupts on disable CRTC.
 492          */
 493         for (src = DC_IRQ_SOURCE_HPD1; src <= DC_IRQ_SOURCE_HPD6RX; src++) {
 494                 hnd_list_l = &adev->dm.irq_handler_list_low_tab[src];
 495                 hnd_list_h = &adev->dm.irq_handler_list_high_tab[src];
 496                 if (!list_empty(hnd_list_l) || !list_empty(hnd_list_h))
 497                         dc_interrupt_set(adev->dm.dc, src, false);
 498
 499                 DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 500
 501                 if (!list_empty(hnd_list_l)) {
 502                         list_for_each_safe(entry, tmp, hnd_list_l) {
 503                                 handler = list_entry(
 504                                         entry,
 505                                         struct amdgpu_dm_irq_handler_data,
 506                                         list);
 507                                 flush_work(&handler->work);
 508                         }
 509                 }
 510                 DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 511         }
 512
 513         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 514         return 0;
 515 }
 516
 517 int amdgpu_dm_irq_resume_early(struct amdgpu_device *adev)
 518 {
 519         int src;
 520         struct list_head *hnd_list_h, *hnd_list_l;
 521         unsigned long irq_table_flags;
 522
 523         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 524
 525         DRM_DEBUG_KMS("DM_IRQ: early resume\n");
 526
 527         /* re-enable short pulse interrupts HW interrupt */
 528         for (src = DC_IRQ_SOURCE_HPD1RX; src <= DC_IRQ_SOURCE_HPD6RX; src++) {
 529                 hnd_list_l = &adev->dm.irq_handler_list_low_tab[src];
 530                 hnd_list_h = &adev->dm.irq_handler_list_high_tab[src];
 531                 if (!list_empty(hnd_list_l) || !list_empty(hnd_list_h))
 532                         dc_interrupt_set(adev->dm.dc, src, true);
 533         }
 534
 535         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 536
 537         return 0;
 538 }
 539
 540 int amdgpu_dm_irq_resume_late(struct amdgpu_device *adev)
 541 {
 542         int src;
 543         struct list_head *hnd_list_h, *hnd_list_l;
 544         unsigned long irq_table_flags;
 545
 546         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 547
 548         DRM_DEBUG_KMS("DM_IRQ: resume\n");
 549
 550         /**
 551          * Renable HW interrupt  for HPD and only since FLIP and VBLANK
 552          * will be enabled from manage_dm_interrupts on enable CRTC.
 553          */
 554         for (src = DC_IRQ_SOURCE_HPD1; src <= DC_IRQ_SOURCE_HPD6; src++) {
 555                 hnd_list_l = &adev->dm.irq_handler_list_low_tab[src];
 556                 hnd_list_h = &adev->dm.irq_handler_list_high_tab[src];
 557                 if (!list_empty(hnd_list_l) || !list_empty(hnd_list_h))
 558                         dc_interrupt_set(adev->dm.dc, src, true);
 559         }
 560
 561         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 562         return 0;
 563 }
 564
 565 /*
 566  * amdgpu_dm_irq_schedule_work - schedule all work items registered for the
 567  * "irq_source".
 568  */
 569 static void amdgpu_dm_irq_schedule_work(struct amdgpu_device *adev,
 570                                         enum dc_irq_source irq_source)
 571 {
 572         struct  list_head *handler_list = &adev->dm.irq_handler_list_low_tab[irq_source];
 573         struct  amdgpu_dm_irq_handler_data *handler_data;
 574         bool    work_queued = false;
 575
 576         if (list_empty(handler_list))
 577                 return;
 578
 579         list_for_each_entry(handler_data, handler_list, list) {
 580                 if (queue_work(system_highpri_wq, &handler_data->work)) {
 581                         work_queued = true;
 582                         break;
 583                 }
 584         }
 585
 586         if (!work_queued) {
 587                 struct  amdgpu_dm_irq_handler_data *handler_data_add;
 588                 /*get the amdgpu_dm_irq_handler_data of first item pointed by handler_list*/
 589                 handler_data = container_of(handler_list->next, struct amdgpu_dm_irq_handler_data, list);
 590
 591                 /*allocate a new amdgpu_dm_irq_handler_data*/
 592                 handler_data_add = kzalloc(sizeof(*handler_data), GFP_ATOMIC);
 593                 if (!handler_data_add) {
 594                         DRM_ERROR("DM_IRQ: failed to allocate irq handler!\n");
 595                         return;
 596                 }
 597
 598                 /*copy new amdgpu_dm_irq_handler_data members from handler_data*/
 599                 handler_data_add->handler       = handler_data->handler;
 600                 handler_data_add->handler_arg   = handler_data->handler_arg;
 601                 handler_data_add->dm            = handler_data->dm;
 602                 handler_data_add->irq_source    = irq_source;
 603
 604                 list_add_tail(&handler_data_add->list, handler_list);
 605
 606                 INIT_WORK(&handler_data_add->work, dm_irq_work_func);
 607
 608                 if (queue_work(system_highpri_wq, &handler_data_add->work))
 609                         DRM_DEBUG("Queued work for handling interrupt from "
 610                                   "display for IRQ source %d\n",
 611                                   irq_source);
 612                 else
 613                         DRM_ERROR("Failed to queue work for handling interrupt "
 614                                   "from display for IRQ source %d\n",
 615                                   irq_source);
 616         }
 617 }
 618
 619 /*
 620  * amdgpu_dm_irq_immediate_work
 621  * Callback high irq work immediately, don't send to work queue
 622  */
 623 static void amdgpu_dm_irq_immediate_work(struct amdgpu_device *adev,
 624                                          enum dc_irq_source irq_source)
 625 {
 626         struct amdgpu_dm_irq_handler_data *handler_data;
 627         unsigned long irq_table_flags;
 628
 629         DM_IRQ_TABLE_LOCK(adev, irq_table_flags);
 630
 631         list_for_each_entry(handler_data,
 632                             &adev->dm.irq_handler_list_high_tab[irq_source],
 633                             list) {
 634                 /* Call a subcomponent which registered for immediate
 635                  * interrupt notification
 636                  */
 637                 handler_data->handler(handler_data->handler_arg);
 638         }
 639
 640         DM_IRQ_TABLE_UNLOCK(adev, irq_table_flags);
 641 }
 642
 643 /**
 644  * amdgpu_dm_irq_handler - Generic DM IRQ handler
 645  * @adev: amdgpu base driver device containing the DM device
 646  * @source: Unused
 647  * @entry: Data about the triggered interrupt
 648  *
 649  * Calls all registered high irq work immediately, and schedules work for low
 650  * irq. The DM IRQ table is used to find the corresponding handlers.
 651  */
 652 static int amdgpu_dm_irq_handler(struct amdgpu_device *adev,
 653                                  struct amdgpu_irq_src *source,
 654                                  struct amdgpu_iv_entry *entry)
 655 {
 656
 657         enum dc_irq_source src =
 658                 dc_interrupt_to_irq_source(
 659                         adev->dm.dc,
 660                         entry->src_id,
 661                         entry->src_data[0]);
 662
 663         dc_interrupt_ack(adev->dm.dc, src);
 664
 665         /* Call high irq work immediately */
 666         amdgpu_dm_irq_immediate_work(adev, src);
 667         /*Schedule low_irq work */
 668         amdgpu_dm_irq_schedule_work(adev, src);
 669
 670         return 0;
 671 }
 672
 673 static enum dc_irq_source amdgpu_dm_hpd_to_dal_irq_source(unsigned int type)
 674 {
 675         switch (type) {
 676         case AMDGPU_HPD_1:
 677                 return DC_IRQ_SOURCE_HPD1;
 678         case AMDGPU_HPD_2:
 679                 return DC_IRQ_SOURCE_HPD2;
 680         case AMDGPU_HPD_3:
 681                 return DC_IRQ_SOURCE_HPD3;
 682         case AMDGPU_HPD_4:
 683                 return DC_IRQ_SOURCE_HPD4;
 684         case AMDGPU_HPD_5:
 685                 return DC_IRQ_SOURCE_HPD5;
 686         case AMDGPU_HPD_6:
 687                 return DC_IRQ_SOURCE_HPD6;
 688         default:
 689                 return DC_IRQ_SOURCE_INVALID;
 690         }
 691 }
 692
 693 static int amdgpu_dm_set_hpd_irq_state(struct amdgpu_device *adev,
 694                                        struct amdgpu_irq_src *source,
 695                                        unsigned int type,
 696                                        enum amdgpu_interrupt_state state)
 697 {
 698         enum dc_irq_source src = amdgpu_dm_hpd_to_dal_irq_source(type);
 699         bool st = (state == AMDGPU_IRQ_STATE_ENABLE);
 700
 701         dc_interrupt_set(adev->dm.dc, src, st);
 702         return 0;
 703 }
 704
 705 static inline int dm_irq_state(struct amdgpu_device *adev,
 706                                struct amdgpu_irq_src *source,
 707                                unsigned int crtc_id,
 708                                enum amdgpu_interrupt_state state,
 709                                const enum irq_type dal_irq_type,
 710                                const char *func)
 711 {
 712         bool st;
 713         enum dc_irq_source irq_source;
 714
 715         struct amdgpu_crtc *acrtc = adev->mode_info.crtcs[crtc_id];
 716
 717         if (!acrtc) {
 718                 DRM_ERROR(
 719                         "%s: crtc is NULL at id :%d\n",
 720                         func,
 721                         crtc_id);
 722                 return 0;
 723         }
 724
 725         if (acrtc->otg_inst == -1)
 726                 return 0;
 727
 728         irq_source = dal_irq_type + acrtc->otg_inst;
 729
 730         st = (state == AMDGPU_IRQ_STATE_ENABLE);
 731
 732         dc_interrupt_set(adev->dm.dc, irq_source, st);
 733         return 0;
 734 }
 735
 736 static int amdgpu_dm_set_pflip_irq_state(struct amdgpu_device *adev,
 737                                          struct amdgpu_irq_src *source,
 738                                          unsigned int crtc_id,
 739                                          enum amdgpu_interrupt_state state)
 740 {
 741         return dm_irq_state(
 742                 adev,
 743                 source,
 744                 crtc_id,
 745                 state,
 746                 IRQ_TYPE_PFLIP,
 747                 __func__);
 748 }
 749
 750 static int amdgpu_dm_set_crtc_irq_state(struct amdgpu_device *adev,
 751                                         struct amdgpu_irq_src *source,
 752                                         unsigned int crtc_id,
 753                                         enum amdgpu_interrupt_state state)
 754 {
 755         return dm_irq_state(
 756                 adev,
 757                 source,
 758                 crtc_id,
 759                 state,
 760                 IRQ_TYPE_VBLANK,
 761                 __func__);
 762 }
 763
 764 static int amdgpu_dm_set_vline0_irq_state(struct amdgpu_device *adev,
 765                                         struct amdgpu_irq_src *source,
 766                                         unsigned int crtc_id,
 767                                         enum amdgpu_interrupt_state state)
 768 {
 769         return dm_irq_state(
 770                 adev,
 771                 source,
 772                 crtc_id,
 773                 state,
 774                 IRQ_TYPE_VLINE0,
 775                 __func__);
 776 }
 777
 778 static int amdgpu_dm_set_dmub_outbox_irq_state(struct amdgpu_device *adev,
 779                                         struct amdgpu_irq_src *source,
 780                                         unsigned int crtc_id,
 781                                         enum amdgpu_interrupt_state state)
 782 {
 783         enum dc_irq_source irq_source = DC_IRQ_SOURCE_DMCUB_OUTBOX;
 784         bool st = (state == AMDGPU_IRQ_STATE_ENABLE);
 785
 786         dc_interrupt_set(adev->dm.dc, irq_source, st);
 787         return 0;
 788 }
 789
 790 static int amdgpu_dm_set_vupdate_irq_state(struct amdgpu_device *adev,
 791                                            struct amdgpu_irq_src *source,
 792                                            unsigned int crtc_id,
 793                                            enum amdgpu_interrupt_state state)
 794 {
 795         return dm_irq_state(
 796                 adev,
 797                 source,
 798                 crtc_id,
 799                 state,
 800                 IRQ_TYPE_VUPDATE,
 801                 __func__);
 802 }
 803
 804 static int amdgpu_dm_set_dmub_trace_irq_state(struct amdgpu_device *adev,
 805                                            struct amdgpu_irq_src *source,
 806                                            unsigned int type,
 807                                            enum amdgpu_interrupt_state state)
 808 {
 809         enum dc_irq_source irq_source = DC_IRQ_SOURCE_DMCUB_OUTBOX0;
 810         bool st = (state == AMDGPU_IRQ_STATE_ENABLE);
 811
 812         dc_interrupt_set(adev->dm.dc, irq_source, st);
 813         return 0;
 814 }
 815
 816 static const struct amdgpu_irq_src_funcs dm_crtc_irq_funcs = {
 817         .set = amdgpu_dm_set_crtc_irq_state,
 818         .process = amdgpu_dm_irq_handler,
 819 };
 820
 821 static const struct amdgpu_irq_src_funcs dm_vline0_irq_funcs = {
 822         .set = amdgpu_dm_set_vline0_irq_state,
 823         .process = amdgpu_dm_irq_handler,
 824 };
 825
 826 static const struct amdgpu_irq_src_funcs dm_dmub_outbox_irq_funcs = {
 827         .set = amdgpu_dm_set_dmub_outbox_irq_state,
 828         .process = amdgpu_dm_irq_handler,
 829 };
 830
 831 static const struct amdgpu_irq_src_funcs dm_vupdate_irq_funcs = {
 832         .set = amdgpu_dm_set_vupdate_irq_state,
 833         .process = amdgpu_dm_irq_handler,
 834 };
 835
 836 static const struct amdgpu_irq_src_funcs dm_dmub_trace_irq_funcs = {
 837         .set = amdgpu_dm_set_dmub_trace_irq_state,
 838         .process = amdgpu_dm_irq_handler,
 839 };
 840
 841 static const struct amdgpu_irq_src_funcs dm_pageflip_irq_funcs = {
 842         .set = amdgpu_dm_set_pflip_irq_state,
 843         .process = amdgpu_dm_irq_handler,
 844 };
 845
 846 static const struct amdgpu_irq_src_funcs dm_hpd_irq_funcs = {
 847         .set = amdgpu_dm_set_hpd_irq_state,
 848         .process = amdgpu_dm_irq_handler,
 849 };
 850
 851 void amdgpu_dm_set_irq_funcs(struct amdgpu_device *adev)
 852 {
 853         adev->crtc_irq.num_types = adev->mode_info.num_crtc;
 854         adev->crtc_irq.funcs = &dm_crtc_irq_funcs;
 855
 856         adev->vline0_irq.num_types = adev->mode_info.num_crtc;
 857         adev->vline0_irq.funcs = &dm_vline0_irq_funcs;
 858
 859         adev->dmub_outbox_irq.num_types = 1;
 860         adev->dmub_outbox_irq.funcs = &dm_dmub_outbox_irq_funcs;
 861
 862         adev->vupdate_irq.num_types = adev->mode_info.num_crtc;
 863         adev->vupdate_irq.funcs = &dm_vupdate_irq_funcs;
 864
 865         adev->dmub_trace_irq.num_types = 1;
 866         adev->dmub_trace_irq.funcs = &dm_dmub_trace_irq_funcs;
 867
 868         adev->pageflip_irq.num_types = adev->mode_info.num_crtc;
 869         adev->pageflip_irq.funcs = &dm_pageflip_irq_funcs;
 870
 871         adev->hpd_irq.num_types = adev->mode_info.num_hpd;
 872         adev->hpd_irq.funcs = &dm_hpd_irq_funcs;
 873 }
 874 void amdgpu_dm_outbox_init(struct amdgpu_device *adev)
 875 {
 876         dc_interrupt_set(adev->dm.dc,
 877                 DC_IRQ_SOURCE_DMCUB_OUTBOX,
 878                 true);
 879 }
 880
 881 /**
 882  * amdgpu_dm_hpd_init - hpd setup callback.
 883  *
 884  * @adev: amdgpu_device pointer
 885  *
 886  * Setup the hpd pins used by the card (evergreen+).
 887  * Enable the pin, set the polarity, and enable the hpd interrupts.
 888  */
 889 void amdgpu_dm_hpd_init(struct amdgpu_device *adev)
 890 {
 891         struct drm_device *dev = adev_to_drm(adev);
 892         struct drm_connector *connector;
 893         struct drm_connector_list_iter iter;
 894
 895         drm_connector_list_iter_begin(dev, &iter);
 896         drm_for_each_connector_iter(connector, &iter) {
 897                 struct amdgpu_dm_connector *amdgpu_dm_connector;
 898                 const struct dc_link *dc_link;
 899
 900                 if (connector->connector_type == DRM_MODE_CONNECTOR_WRITEBACK)
 901                         continue;
 902
 903                 amdgpu_dm_connector = to_amdgpu_dm_connector(connector);
 904
 905                 dc_link = amdgpu_dm_connector->dc_link;
 906
 907                 if (dc_link->irq_source_hpd != DC_IRQ_SOURCE_INVALID) {
 908                         dc_interrupt_set(adev->dm.dc,
 909                                         dc_link->irq_source_hpd,
 910                                         true);
 911                 }
 912
 913                 if (dc_link->irq_source_hpd_rx != DC_IRQ_SOURCE_INVALID) {
 914                         dc_interrupt_set(adev->dm.dc,
 915                                         dc_link->irq_source_hpd_rx,
 916                                         true);
 917                 }
 918         }
 919         drm_connector_list_iter_end(&iter);
 920 }
 921
 922 /**
 923  * amdgpu_dm_hpd_fini - hpd tear down callback.
 924  *
 925  * @adev: amdgpu_device pointer
 926  *
 927  * Tear down the hpd pins used by the card (evergreen+).
 928  * Disable the hpd interrupts.
 929  */
 930 void amdgpu_dm_hpd_fini(struct amdgpu_device *adev)
 931 {
 932         struct drm_device *dev = adev_to_drm(adev);
 933         struct drm_connector *connector;
 934         struct drm_connector_list_iter iter;
 935
 936         drm_connector_list_iter_begin(dev, &iter);
 937         drm_for_each_connector_iter(connector, &iter) {
 938                 struct amdgpu_dm_connector *amdgpu_dm_connector;
 939                 const struct dc_link *dc_link;
 940
 941                 if (connector->connector_type == DRM_MODE_CONNECTOR_WRITEBACK)
 942                         continue;
 943
 944                 amdgpu_dm_connector = to_amdgpu_dm_connector(connector);
 945                 dc_link = amdgpu_dm_connector->dc_link;
 946
 947                 if (dc_link->irq_source_hpd != DC_IRQ_SOURCE_INVALID) {
 948                         dc_interrupt_set(adev->dm.dc,
 949                                         dc_link->irq_source_hpd,
 950                                         false);
 951                 }
 952
 953                 if (dc_link->irq_source_hpd_rx != DC_IRQ_SOURCE_INVALID) {
 954                         dc_interrupt_set(adev->dm.dc,
 955                                         dc_link->irq_source_hpd_rx,
 956                                         false);
 957                 }
 958         }
 959         drm_connector_list_iter_end(&iter);
 960 }