drivers/gpu/drm/amd/display/dc/gpio/gpio_service.c

   1 /*
   2  * Copyright 2012-15 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 /*
  27  * Pre-requisites: headers required by header of this unit
  28  */
  29
  30 #include <linux/slab.h>
  31
  32 #include "dm_services.h"
  33 #include "include/gpio_interface.h"
  34 #include "include/gpio_service_interface.h"
  35 #include "hw_translate.h"
  36 #include "hw_factory.h"
  37
  38 /*
  39  * Header of this unit
  40  */
  41
  42 #include "gpio_service.h"
  43
  44 /*
  45  * Post-requisites: headers required by this unit
  46  */
  47
  48 #include "hw_gpio.h"
  49
  50 /*
  51  * @brief
  52  * Public API.
  53  */
  54
  55 struct gpio_service *dal_gpio_service_create(
  56         enum dce_version dce_version_major,
  57         enum dce_version dce_version_minor,
  58         struct dc_context *ctx)
  59 {
  60         struct gpio_service *service;
  61         uint32_t index_of_id;
  62
  63         service = kzalloc(sizeof(struct gpio_service), GFP_KERNEL);
  64
  65         if (!service) {
  66                 BREAK_TO_DEBUGGER();
  67                 return NULL;
  68         }
  69
  70         if (!dal_hw_translate_init(&service->translate, dce_version_major,
  71                         dce_version_minor)) {
  72                 BREAK_TO_DEBUGGER();
  73                 goto failure_1;
  74         }
  75
  76         if (!dal_hw_factory_init(&service->factory, dce_version_major,
  77                         dce_version_minor)) {
  78                 BREAK_TO_DEBUGGER();
  79                 goto failure_1;
  80         }
  81
  82         /* allocate and initialize busyness storage */
  83         {
  84                 index_of_id = 0;
  85                 service->ctx = ctx;
  86
  87                 do {
  88                         uint32_t number_of_bits =
  89                                 service->factory.number_of_pins[index_of_id];
  90                         uint32_t i = 0;
  91
  92                         if (number_of_bits)  {
  93                                 service->busyness[index_of_id] =
  94                                         kcalloc(number_of_bits, sizeof(char),
  95                                                 GFP_KERNEL);
  96
  97                                 if (!service->busyness[index_of_id]) {
  98                                         BREAK_TO_DEBUGGER();
  99                                         goto failure_2;
 100                                 }
 101
 102                                 do {
 103                                         service->busyness[index_of_id][i] = 0;
 104                                         ++i;
 105                                 } while (i < number_of_bits);
 106                         } else {
 107                                 service->busyness[index_of_id] = NULL;
 108                         }
 109
 110                         ++index_of_id;
 111                 } while (index_of_id < GPIO_ID_COUNT);
 112         }
 113
 114         return service;
 115
 116 failure_2:
 117         while (index_of_id) {
 118                 --index_of_id;
 119                 kfree(service->busyness[index_of_id]);
 120         }
 121
 122 failure_1:
 123         kfree(service);
 124
 125         return NULL;
 126 }
 127
 128 struct gpio *dal_gpio_service_create_irq(
 129         struct gpio_service *service,
 130         uint32_t offset,
 131         uint32_t mask)
 132 {
 133         enum gpio_id id;
 134         uint32_t en;
 135
 136         if (!service->translate.funcs->offset_to_id(offset, mask, &id, &en)) {
 137                 ASSERT_CRITICAL(false);
 138                 return NULL;
 139         }
 140
 141         return dal_gpio_create_irq(service, id, en);
 142 }
 143
 144 struct gpio *dal_gpio_service_create_generic_mux(
 145         struct gpio_service *service,
 146         uint32_t offset,
 147         uint32_t mask)
 148 {
 149         enum gpio_id id;
 150         uint32_t en;
 151         struct gpio *generic;
 152
 153         if (!service->translate.funcs->offset_to_id(offset, mask, &id, &en)) {
 154                 ASSERT_CRITICAL(false);
 155                 return NULL;
 156         }
 157
 158         generic = dal_gpio_create(
 159                 service, id, en, GPIO_PIN_OUTPUT_STATE_DEFAULT);
 160
 161         return generic;
 162 }
 163
 164 void dal_gpio_destroy_generic_mux(
 165         struct gpio **mux)
 166 {
 167         if (!mux || !*mux) {
 168                 ASSERT_CRITICAL(false);
 169                 return;
 170         }
 171
 172         dal_gpio_destroy(mux);
 173         kfree(*mux);
 174
 175         *mux = NULL;
 176 }
 177
 178 struct gpio_pin_info dal_gpio_get_generic_pin_info(
 179         struct gpio_service *service,
 180         enum gpio_id id,
 181         uint32_t en)
 182 {
 183         struct gpio_pin_info pin;
 184
 185         if (service->translate.funcs->id_to_offset) {
 186                 service->translate.funcs->id_to_offset(id, en, &pin);
 187         } else {
 188                 pin.mask = 0xFFFFFFFF;
 189                 pin.offset = 0xFFFFFFFF;
 190         }
 191
 192         return pin;
 193 }
 194
 195 void dal_gpio_service_destroy(
 196         struct gpio_service **ptr)
 197 {
 198         if (!ptr || !*ptr) {
 199                 BREAK_TO_DEBUGGER();
 200                 return;
 201         }
 202
 203         /* free business storage */
 204         {
 205                 uint32_t index_of_id = 0;
 206
 207                 do {
 208                         kfree((*ptr)->busyness[index_of_id]);
 209
 210                         ++index_of_id;
 211                 } while (index_of_id < GPIO_ID_COUNT);
 212         }
 213
 214         kfree(*ptr);
 215
 216         *ptr = NULL;
 217 }
 218
 219 enum gpio_result dal_mux_setup_config(
 220         struct gpio *mux,
 221         struct gpio_generic_mux_config *config)
 222 {
 223         struct gpio_config_data config_data;
 224
 225         if (!config)
 226                 return GPIO_RESULT_INVALID_DATA;
 227
 228         config_data.config.generic_mux = *config;
 229         config_data.type = GPIO_CONFIG_TYPE_GENERIC_MUX;
 230
 231         return dal_gpio_set_config(mux, &config_data);
 232 }
 233
 234 /*
 235  * @brief
 236  * Private API.
 237  */
 238
 239 static bool is_pin_busy(
 240         const struct gpio_service *service,
 241         enum gpio_id id,
 242         uint32_t en)
 243 {
 244         return service->busyness[id][en];
 245 }
 246
 247 static void set_pin_busy(
 248         struct gpio_service *service,
 249         enum gpio_id id,
 250         uint32_t en)
 251 {
 252         service->busyness[id][en] = true;
 253 }
 254
 255 static void set_pin_free(
 256         struct gpio_service *service,
 257         enum gpio_id id,
 258         uint32_t en)
 259 {
 260         service->busyness[id][en] = false;
 261 }
 262
 263 enum gpio_result dal_gpio_service_lock(
 264         struct gpio_service *service,
 265         enum gpio_id id,
 266         uint32_t en)
 267 {
 268         if (!service->busyness[id]) {
 269                 ASSERT_CRITICAL(false);
 270                 return GPIO_RESULT_OPEN_FAILED;
 271         }
 272
 273         set_pin_busy(service, id, en);
 274         return GPIO_RESULT_OK;
 275 }
 276
 277 enum gpio_result dal_gpio_service_unlock(
 278         struct gpio_service *service,
 279         enum gpio_id id,
 280         uint32_t en)
 281 {
 282         if (!service->busyness[id]) {
 283                 ASSERT_CRITICAL(false);
 284                 return GPIO_RESULT_OPEN_FAILED;
 285         }
 286
 287         set_pin_free(service, id, en);
 288         return GPIO_RESULT_OK;
 289 }
 290
 291 enum gpio_result dal_gpio_service_open(
 292         struct gpio *gpio)
 293 {
 294         struct gpio_service *service = gpio->service;
 295         enum gpio_id id = gpio->id;
 296         uint32_t en = gpio->en;
 297         enum gpio_mode mode = gpio->mode;
 298
 299         struct hw_gpio_pin **pin = &gpio->pin;
 300
 301
 302         if (!service->busyness[id]) {
 303                 ASSERT_CRITICAL(false);
 304                 return GPIO_RESULT_OPEN_FAILED;
 305         }
 306
 307         if (is_pin_busy(service, id, en)) {
 308                 ASSERT_CRITICAL(false);
 309                 return GPIO_RESULT_DEVICE_BUSY;
 310         }
 311
 312         switch (id) {
 313         case GPIO_ID_DDC_DATA:
 314                 *pin = service->factory.funcs->get_ddc_pin(gpio);
 315                 service->factory.funcs->define_ddc_registers(*pin, en);
 316         break;
 317         case GPIO_ID_DDC_CLOCK:
 318                 *pin = service->factory.funcs->get_ddc_pin(gpio);
 319                 service->factory.funcs->define_ddc_registers(*pin, en);
 320         break;
 321         case GPIO_ID_GENERIC:
 322                 *pin = service->factory.funcs->get_generic_pin(gpio);
 323                 service->factory.funcs->define_generic_registers(*pin, en);
 324         break;
 325         case GPIO_ID_HPD:
 326                 *pin = service->factory.funcs->get_hpd_pin(gpio);
 327                 service->factory.funcs->define_hpd_registers(*pin, en);
 328         break;
 329
 330         //TODO: gsl and sync support? create_sync and create_gsl are NULL
 331         case GPIO_ID_SYNC:
 332         case GPIO_ID_GSL:
 333         break;
 334         default:
 335                 ASSERT_CRITICAL(false);
 336                 return GPIO_RESULT_NON_SPECIFIC_ERROR;
 337         }
 338
 339         if (!*pin) {
 340                 ASSERT_CRITICAL(false);
 341                 return GPIO_RESULT_NON_SPECIFIC_ERROR;
 342         }
 343
 344         if (!(*pin)->funcs->open(*pin, mode)) {
 345                 ASSERT_CRITICAL(false);
 346                 dal_gpio_service_close(service, pin);
 347                 return GPIO_RESULT_OPEN_FAILED;
 348         }
 349
 350         set_pin_busy(service, id, en);
 351         return GPIO_RESULT_OK;
 352 }
 353
 354 void dal_gpio_service_close(
 355         struct gpio_service *service,
 356         struct hw_gpio_pin **ptr)
 357 {
 358         struct hw_gpio_pin *pin;
 359
 360         if (!ptr) {
 361                 ASSERT_CRITICAL(false);
 362                 return;
 363         }
 364
 365         pin = *ptr;
 366
 367         if (pin) {
 368                 set_pin_free(service, pin->id, pin->en);
 369
 370                 pin->funcs->close(pin);
 371
 372                 *ptr = NULL;
 373         }
 374 }
 375
 376 enum dc_irq_source dal_irq_get_source(
 377         const struct gpio *irq)
 378 {
 379         enum gpio_id id = dal_gpio_get_id(irq);
 380
 381         switch (id) {
 382         case GPIO_ID_HPD:
 383                 return (enum dc_irq_source)(DC_IRQ_SOURCE_HPD1 +
 384                         dal_gpio_get_enum(irq));
 385         case GPIO_ID_GPIO_PAD:
 386                 return (enum dc_irq_source)(DC_IRQ_SOURCE_GPIOPAD0 +
 387                         dal_gpio_get_enum(irq));
 388         default:
 389                 return DC_IRQ_SOURCE_INVALID;
 390         }
 391 }
 392
 393 enum dc_irq_source dal_irq_get_rx_source(
 394         const struct gpio *irq)
 395 {
 396         enum gpio_id id = dal_gpio_get_id(irq);
 397
 398         switch (id) {
 399         case GPIO_ID_HPD:
 400                 return (enum dc_irq_source)(DC_IRQ_SOURCE_HPD1RX +
 401                         dal_gpio_get_enum(irq));
 402         default:
 403                 return DC_IRQ_SOURCE_INVALID;
 404         }
 405 }
 406
 407 enum gpio_result dal_irq_setup_hpd_filter(
 408         struct gpio *irq,
 409         struct gpio_hpd_config *config)
 410 {
 411         struct gpio_config_data config_data;
 412
 413         if (!config)
 414                 return GPIO_RESULT_INVALID_DATA;
 415
 416         config_data.type = GPIO_CONFIG_TYPE_HPD;
 417         config_data.config.hpd = *config;
 418
 419         return dal_gpio_set_config(irq, &config_data);
 420 }
 421
 422 /*
 423  * @brief
 424  * Creation and destruction
 425  */
 426
 427 struct gpio *dal_gpio_create_irq(
 428         struct gpio_service *service,
 429         enum gpio_id id,
 430         uint32_t en)
 431 {
 432         struct gpio *irq;
 433
 434         switch (id) {
 435         case GPIO_ID_HPD:
 436         case GPIO_ID_GPIO_PAD:
 437         break;
 438         default:
 439                 id = GPIO_ID_HPD;
 440                 ASSERT_CRITICAL(false);
 441                 return NULL;
 442         }
 443
 444         irq = dal_gpio_create(
 445                 service, id, en, GPIO_PIN_OUTPUT_STATE_DEFAULT);
 446
 447         if (irq)
 448                 return irq;
 449
 450         ASSERT_CRITICAL(false);
 451         return NULL;
 452 }
 453
 454 void dal_gpio_destroy_irq(
 455         struct gpio **irq)
 456 {
 457         if (!irq || !*irq) {
 458                 ASSERT_CRITICAL(false);
 459                 return;
 460         }
 461
 462         dal_gpio_destroy(irq);
 463         kfree(*irq);
 464
 465         *irq = NULL;
 466 }
 467
 468 struct ddc *dal_gpio_create_ddc(
 469         struct gpio_service *service,
 470         uint32_t offset,
 471         uint32_t mask,
 472         struct gpio_ddc_hw_info *info)
 473 {
 474         enum gpio_id id;
 475         uint32_t en;
 476         struct ddc *ddc;
 477
 478         if (!service->translate.funcs->offset_to_id(offset, mask, &id, &en))
 479                 return NULL;
 480
 481         ddc = kzalloc(sizeof(struct ddc), GFP_KERNEL);
 482
 483         if (!ddc) {
 484                 BREAK_TO_DEBUGGER();
 485                 return NULL;
 486         }
 487
 488         ddc->pin_data = dal_gpio_create(
 489                 service, GPIO_ID_DDC_DATA, en, GPIO_PIN_OUTPUT_STATE_DEFAULT);
 490
 491         if (!ddc->pin_data) {
 492                 BREAK_TO_DEBUGGER();
 493                 goto failure_1;
 494         }
 495
 496         ddc->pin_clock = dal_gpio_create(
 497                 service, GPIO_ID_DDC_CLOCK, en, GPIO_PIN_OUTPUT_STATE_DEFAULT);
 498
 499         if (!ddc->pin_clock) {
 500                 BREAK_TO_DEBUGGER();
 501                 goto failure_2;
 502         }
 503
 504         ddc->hw_info = *info;
 505
 506         ddc->ctx = service->ctx;
 507
 508         return ddc;
 509
 510 failure_2:
 511         dal_gpio_destroy(&ddc->pin_data);
 512
 513 failure_1:
 514         kfree(ddc);
 515
 516         return NULL;
 517 }
 518
 519 void dal_gpio_destroy_ddc(
 520         struct ddc **ddc)
 521 {
 522         if (!ddc || !*ddc) {
 523                 BREAK_TO_DEBUGGER();
 524                 return;
 525         }
 526
 527         dal_ddc_close(*ddc);
 528         dal_gpio_destroy(&(*ddc)->pin_data);
 529         dal_gpio_destroy(&(*ddc)->pin_clock);
 530         kfree(*ddc);
 531
 532         *ddc = NULL;
 533 }
 534
 535 enum gpio_result dal_ddc_open(
 536         struct ddc *ddc,
 537         enum gpio_mode mode,
 538         enum gpio_ddc_config_type config_type)
 539 {
 540         enum gpio_result result;
 541
 542         struct gpio_config_data config_data;
 543         struct hw_gpio *hw_data;
 544         struct hw_gpio *hw_clock;
 545
 546         result = dal_gpio_open_ex(ddc->pin_data, mode);
 547
 548         if (result != GPIO_RESULT_OK) {
 549                 BREAK_TO_DEBUGGER();
 550                 return result;
 551         }
 552
 553         result = dal_gpio_open_ex(ddc->pin_clock, mode);
 554
 555         if (result != GPIO_RESULT_OK) {
 556                 BREAK_TO_DEBUGGER();
 557                 goto failure;
 558         }
 559
 560         /* DDC clock and data pins should belong
 561          * to the same DDC block id,
 562          * we use the data pin to set the pad mode. */
 563
 564         if (mode == GPIO_MODE_INPUT)
 565                 /* this is from detect_sink_type,
 566                  * we need extra delay there */
 567                 config_data.type = GPIO_CONFIG_TYPE_I2C_AUX_DUAL_MODE;
 568         else
 569                 config_data.type = GPIO_CONFIG_TYPE_DDC;
 570
 571         config_data.config.ddc.type = config_type;
 572
 573         hw_data = FROM_HW_GPIO_PIN(ddc->pin_data->pin);
 574         hw_clock = FROM_HW_GPIO_PIN(ddc->pin_clock->pin);
 575
 576         config_data.config.ddc.data_en_bit_present = hw_data->store.en != 0;
 577         config_data.config.ddc.clock_en_bit_present = hw_clock->store.en != 0;
 578
 579         result = dal_gpio_set_config(ddc->pin_data, &config_data);
 580
 581         if (result == GPIO_RESULT_OK)
 582                 return result;
 583
 584         BREAK_TO_DEBUGGER();
 585
 586         dal_gpio_close(ddc->pin_clock);
 587
 588 failure:
 589         dal_gpio_close(ddc->pin_data);
 590
 591         return result;
 592 }
 593
 594 enum gpio_result dal_ddc_change_mode(
 595         struct ddc *ddc,
 596         enum gpio_mode mode)
 597 {
 598         enum gpio_result result;
 599
 600         enum gpio_mode original_mode =
 601                 dal_gpio_get_mode(ddc->pin_data);
 602
 603         result = dal_gpio_change_mode(ddc->pin_data, mode);
 604
 605         /* [anaumov] DAL2 code returns GPIO_RESULT_NON_SPECIFIC_ERROR
 606          * in case of failures;
 607          * set_mode() is so that, in case of failure,
 608          * we must explicitly set original mode */
 609
 610         if (result != GPIO_RESULT_OK)
 611                 goto failure;
 612
 613         result = dal_gpio_change_mode(ddc->pin_clock, mode);
 614
 615         if (result == GPIO_RESULT_OK)
 616                 return result;
 617
 618         dal_gpio_change_mode(ddc->pin_clock, original_mode);
 619
 620 failure:
 621         dal_gpio_change_mode(ddc->pin_data, original_mode);
 622
 623         return result;
 624 }
 625
 626 enum gpio_ddc_line dal_ddc_get_line(
 627         const struct ddc *ddc)
 628 {
 629         return (enum gpio_ddc_line)dal_gpio_get_enum(ddc->pin_data);
 630 }
 631
 632 enum gpio_result dal_ddc_set_config(
 633         struct ddc *ddc,
 634         enum gpio_ddc_config_type config_type)
 635 {
 636         struct gpio_config_data config_data;
 637
 638         config_data.type = GPIO_CONFIG_TYPE_DDC;
 639
 640         config_data.config.ddc.type = config_type;
 641         config_data.config.ddc.data_en_bit_present = false;
 642         config_data.config.ddc.clock_en_bit_present = false;
 643
 644         return dal_gpio_set_config(ddc->pin_data, &config_data);
 645 }
 646
 647 void dal_ddc_close(
 648         struct ddc *ddc)
 649 {
 650         dal_gpio_close(ddc->pin_clock);
 651         dal_gpio_close(ddc->pin_data);
 652 }
 653