linux/drivers/gpu/drm/amd/amdgpu/amdgpu_atombios.c
<<
>>
Prefs
   1/*
   2 * Copyright 2007-8 Advanced Micro Devices, Inc.
   3 * Copyright 2008 Red Hat Inc.
   4 *
   5 * Permission is hereby granted, free of charge, to any person obtaining a
   6 * copy of this software and associated documentation files (the "Software"),
   7 * to deal in the Software without restriction, including without limitation
   8 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   9 * and/or sell copies of the Software, and to permit persons to whom the
  10 * Software is furnished to do so, subject to the following conditions:
  11 *
  12 * The above copyright notice and this permission notice shall be included in
  13 * all copies or substantial portions of the Software.
  14 *
  15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  19 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  20 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  21 * OTHER DEALINGS IN THE SOFTWARE.
  22 *
  23 * Authors: Dave Airlie
  24 *          Alex Deucher
  25 */
  26#include <drm/drmP.h>
  27#include <drm/amdgpu_drm.h>
  28#include "amdgpu.h"
  29#include "amdgpu_atombios.h"
  30#include "amdgpu_i2c.h"
  31
  32#include "atom.h"
  33#include "atom-bits.h"
  34#include "atombios_encoders.h"
  35#include "bif/bif_4_1_d.h"
  36
  37static void amdgpu_atombios_lookup_i2c_gpio_quirks(struct amdgpu_device *adev,
  38                                          ATOM_GPIO_I2C_ASSIGMENT *gpio,
  39                                          u8 index)
  40{
  41
  42}
  43
  44static struct amdgpu_i2c_bus_rec amdgpu_atombios_get_bus_rec_for_i2c_gpio(ATOM_GPIO_I2C_ASSIGMENT *gpio)
  45{
  46        struct amdgpu_i2c_bus_rec i2c;
  47
  48        memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
  49
  50        i2c.mask_clk_reg = le16_to_cpu(gpio->usClkMaskRegisterIndex);
  51        i2c.mask_data_reg = le16_to_cpu(gpio->usDataMaskRegisterIndex);
  52        i2c.en_clk_reg = le16_to_cpu(gpio->usClkEnRegisterIndex);
  53        i2c.en_data_reg = le16_to_cpu(gpio->usDataEnRegisterIndex);
  54        i2c.y_clk_reg = le16_to_cpu(gpio->usClkY_RegisterIndex);
  55        i2c.y_data_reg = le16_to_cpu(gpio->usDataY_RegisterIndex);
  56        i2c.a_clk_reg = le16_to_cpu(gpio->usClkA_RegisterIndex);
  57        i2c.a_data_reg = le16_to_cpu(gpio->usDataA_RegisterIndex);
  58        i2c.mask_clk_mask = (1 << gpio->ucClkMaskShift);
  59        i2c.mask_data_mask = (1 << gpio->ucDataMaskShift);
  60        i2c.en_clk_mask = (1 << gpio->ucClkEnShift);
  61        i2c.en_data_mask = (1 << gpio->ucDataEnShift);
  62        i2c.y_clk_mask = (1 << gpio->ucClkY_Shift);
  63        i2c.y_data_mask = (1 << gpio->ucDataY_Shift);
  64        i2c.a_clk_mask = (1 << gpio->ucClkA_Shift);
  65        i2c.a_data_mask = (1 << gpio->ucDataA_Shift);
  66
  67        if (gpio->sucI2cId.sbfAccess.bfHW_Capable)
  68                i2c.hw_capable = true;
  69        else
  70                i2c.hw_capable = false;
  71
  72        if (gpio->sucI2cId.ucAccess == 0xa0)
  73                i2c.mm_i2c = true;
  74        else
  75                i2c.mm_i2c = false;
  76
  77        i2c.i2c_id = gpio->sucI2cId.ucAccess;
  78
  79        if (i2c.mask_clk_reg)
  80                i2c.valid = true;
  81        else
  82                i2c.valid = false;
  83
  84        return i2c;
  85}
  86
  87struct amdgpu_i2c_bus_rec amdgpu_atombios_lookup_i2c_gpio(struct amdgpu_device *adev,
  88                                                          uint8_t id)
  89{
  90        struct atom_context *ctx = adev->mode_info.atom_context;
  91        ATOM_GPIO_I2C_ASSIGMENT *gpio;
  92        struct amdgpu_i2c_bus_rec i2c;
  93        int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
  94        struct _ATOM_GPIO_I2C_INFO *i2c_info;
  95        uint16_t data_offset, size;
  96        int i, num_indices;
  97
  98        memset(&i2c, 0, sizeof(struct amdgpu_i2c_bus_rec));
  99        i2c.valid = false;
 100
 101        if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
 102                i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
 103
 104                num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 105                        sizeof(ATOM_GPIO_I2C_ASSIGMENT);
 106
 107                gpio = &i2c_info->asGPIO_Info[0];
 108                for (i = 0; i < num_indices; i++) {
 109
 110                        amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
 111
 112                        if (gpio->sucI2cId.ucAccess == id) {
 113                                i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
 114                                break;
 115                        }
 116                        gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
 117                                ((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
 118                }
 119        }
 120
 121        return i2c;
 122}
 123
 124void amdgpu_atombios_i2c_init(struct amdgpu_device *adev)
 125{
 126        struct atom_context *ctx = adev->mode_info.atom_context;
 127        ATOM_GPIO_I2C_ASSIGMENT *gpio;
 128        struct amdgpu_i2c_bus_rec i2c;
 129        int index = GetIndexIntoMasterTable(DATA, GPIO_I2C_Info);
 130        struct _ATOM_GPIO_I2C_INFO *i2c_info;
 131        uint16_t data_offset, size;
 132        int i, num_indices;
 133        char stmp[32];
 134
 135        if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
 136                i2c_info = (struct _ATOM_GPIO_I2C_INFO *)(ctx->bios + data_offset);
 137
 138                num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 139                        sizeof(ATOM_GPIO_I2C_ASSIGMENT);
 140
 141                gpio = &i2c_info->asGPIO_Info[0];
 142                for (i = 0; i < num_indices; i++) {
 143                        amdgpu_atombios_lookup_i2c_gpio_quirks(adev, gpio, i);
 144
 145                        i2c = amdgpu_atombios_get_bus_rec_for_i2c_gpio(gpio);
 146
 147                        if (i2c.valid) {
 148                                sprintf(stmp, "0x%x", i2c.i2c_id);
 149                                adev->i2c_bus[i] = amdgpu_i2c_create(adev->ddev, &i2c, stmp);
 150                        }
 151                        gpio = (ATOM_GPIO_I2C_ASSIGMENT *)
 152                                ((u8 *)gpio + sizeof(ATOM_GPIO_I2C_ASSIGMENT));
 153                }
 154        }
 155}
 156
 157struct amdgpu_gpio_rec
 158amdgpu_atombios_lookup_gpio(struct amdgpu_device *adev,
 159                            u8 id)
 160{
 161        struct atom_context *ctx = adev->mode_info.atom_context;
 162        struct amdgpu_gpio_rec gpio;
 163        int index = GetIndexIntoMasterTable(DATA, GPIO_Pin_LUT);
 164        struct _ATOM_GPIO_PIN_LUT *gpio_info;
 165        ATOM_GPIO_PIN_ASSIGNMENT *pin;
 166        u16 data_offset, size;
 167        int i, num_indices;
 168
 169        memset(&gpio, 0, sizeof(struct amdgpu_gpio_rec));
 170        gpio.valid = false;
 171
 172        if (amdgpu_atom_parse_data_header(ctx, index, &size, NULL, NULL, &data_offset)) {
 173                gpio_info = (struct _ATOM_GPIO_PIN_LUT *)(ctx->bios + data_offset);
 174
 175                num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 176                        sizeof(ATOM_GPIO_PIN_ASSIGNMENT);
 177
 178                pin = gpio_info->asGPIO_Pin;
 179                for (i = 0; i < num_indices; i++) {
 180                        if (id == pin->ucGPIO_ID) {
 181                                gpio.id = pin->ucGPIO_ID;
 182                                gpio.reg = le16_to_cpu(pin->usGpioPin_AIndex);
 183                                gpio.shift = pin->ucGpioPinBitShift;
 184                                gpio.mask = (1 << pin->ucGpioPinBitShift);
 185                                gpio.valid = true;
 186                                break;
 187                        }
 188                        pin = (ATOM_GPIO_PIN_ASSIGNMENT *)
 189                                ((u8 *)pin + sizeof(ATOM_GPIO_PIN_ASSIGNMENT));
 190                }
 191        }
 192
 193        return gpio;
 194}
 195
 196static struct amdgpu_hpd
 197amdgpu_atombios_get_hpd_info_from_gpio(struct amdgpu_device *adev,
 198                                       struct amdgpu_gpio_rec *gpio)
 199{
 200        struct amdgpu_hpd hpd;
 201        u32 reg;
 202
 203        memset(&hpd, 0, sizeof(struct amdgpu_hpd));
 204
 205        reg = amdgpu_display_hpd_get_gpio_reg(adev);
 206
 207        hpd.gpio = *gpio;
 208        if (gpio->reg == reg) {
 209                switch(gpio->mask) {
 210                case (1 << 0):
 211                        hpd.hpd = AMDGPU_HPD_1;
 212                        break;
 213                case (1 << 8):
 214                        hpd.hpd = AMDGPU_HPD_2;
 215                        break;
 216                case (1 << 16):
 217                        hpd.hpd = AMDGPU_HPD_3;
 218                        break;
 219                case (1 << 24):
 220                        hpd.hpd = AMDGPU_HPD_4;
 221                        break;
 222                case (1 << 26):
 223                        hpd.hpd = AMDGPU_HPD_5;
 224                        break;
 225                case (1 << 28):
 226                        hpd.hpd = AMDGPU_HPD_6;
 227                        break;
 228                default:
 229                        hpd.hpd = AMDGPU_HPD_NONE;
 230                        break;
 231                }
 232        } else
 233                hpd.hpd = AMDGPU_HPD_NONE;
 234        return hpd;
 235}
 236
 237static const int object_connector_convert[] = {
 238        DRM_MODE_CONNECTOR_Unknown,
 239        DRM_MODE_CONNECTOR_DVII,
 240        DRM_MODE_CONNECTOR_DVII,
 241        DRM_MODE_CONNECTOR_DVID,
 242        DRM_MODE_CONNECTOR_DVID,
 243        DRM_MODE_CONNECTOR_VGA,
 244        DRM_MODE_CONNECTOR_Composite,
 245        DRM_MODE_CONNECTOR_SVIDEO,
 246        DRM_MODE_CONNECTOR_Unknown,
 247        DRM_MODE_CONNECTOR_Unknown,
 248        DRM_MODE_CONNECTOR_9PinDIN,
 249        DRM_MODE_CONNECTOR_Unknown,
 250        DRM_MODE_CONNECTOR_HDMIA,
 251        DRM_MODE_CONNECTOR_HDMIB,
 252        DRM_MODE_CONNECTOR_LVDS,
 253        DRM_MODE_CONNECTOR_9PinDIN,
 254        DRM_MODE_CONNECTOR_Unknown,
 255        DRM_MODE_CONNECTOR_Unknown,
 256        DRM_MODE_CONNECTOR_Unknown,
 257        DRM_MODE_CONNECTOR_DisplayPort,
 258        DRM_MODE_CONNECTOR_eDP,
 259        DRM_MODE_CONNECTOR_Unknown
 260};
 261
 262bool amdgpu_atombios_has_dce_engine_info(struct amdgpu_device *adev)
 263{
 264        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 265        struct atom_context *ctx = mode_info->atom_context;
 266        int index = GetIndexIntoMasterTable(DATA, Object_Header);
 267        u16 size, data_offset;
 268        u8 frev, crev;
 269        ATOM_DISPLAY_OBJECT_PATH_TABLE *path_obj;
 270        ATOM_OBJECT_HEADER *obj_header;
 271
 272        if (!amdgpu_atom_parse_data_header(ctx, index, &size, &frev, &crev, &data_offset))
 273                return false;
 274
 275        if (crev < 2)
 276                return false;
 277
 278        obj_header = (ATOM_OBJECT_HEADER *) (ctx->bios + data_offset);
 279        path_obj = (ATOM_DISPLAY_OBJECT_PATH_TABLE *)
 280            (ctx->bios + data_offset +
 281             le16_to_cpu(obj_header->usDisplayPathTableOffset));
 282
 283        if (path_obj->ucNumOfDispPath)
 284                return true;
 285        else
 286                return false;
 287}
 288
 289bool amdgpu_atombios_get_connector_info_from_object_table(struct amdgpu_device *adev)
 290{
 291        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 292        struct atom_context *ctx = mode_info->atom_context;
 293        int index = GetIndexIntoMasterTable(DATA, Object_Header);
 294        u16 size, data_offset;
 295        u8 frev, crev;
 296        ATOM_CONNECTOR_OBJECT_TABLE *con_obj;
 297        ATOM_ENCODER_OBJECT_TABLE *enc_obj;
 298        ATOM_OBJECT_TABLE *router_obj;
 299        ATOM_DISPLAY_OBJECT_PATH_TABLE *path_obj;
 300        ATOM_OBJECT_HEADER *obj_header;
 301        int i, j, k, path_size, device_support;
 302        int connector_type;
 303        u16 conn_id, connector_object_id;
 304        struct amdgpu_i2c_bus_rec ddc_bus;
 305        struct amdgpu_router router;
 306        struct amdgpu_gpio_rec gpio;
 307        struct amdgpu_hpd hpd;
 308
 309        if (!amdgpu_atom_parse_data_header(ctx, index, &size, &frev, &crev, &data_offset))
 310                return false;
 311
 312        if (crev < 2)
 313                return false;
 314
 315        obj_header = (ATOM_OBJECT_HEADER *) (ctx->bios + data_offset);
 316        path_obj = (ATOM_DISPLAY_OBJECT_PATH_TABLE *)
 317            (ctx->bios + data_offset +
 318             le16_to_cpu(obj_header->usDisplayPathTableOffset));
 319        con_obj = (ATOM_CONNECTOR_OBJECT_TABLE *)
 320            (ctx->bios + data_offset +
 321             le16_to_cpu(obj_header->usConnectorObjectTableOffset));
 322        enc_obj = (ATOM_ENCODER_OBJECT_TABLE *)
 323            (ctx->bios + data_offset +
 324             le16_to_cpu(obj_header->usEncoderObjectTableOffset));
 325        router_obj = (ATOM_OBJECT_TABLE *)
 326                (ctx->bios + data_offset +
 327                 le16_to_cpu(obj_header->usRouterObjectTableOffset));
 328        device_support = le16_to_cpu(obj_header->usDeviceSupport);
 329
 330        path_size = 0;
 331        for (i = 0; i < path_obj->ucNumOfDispPath; i++) {
 332                uint8_t *addr = (uint8_t *) path_obj->asDispPath;
 333                ATOM_DISPLAY_OBJECT_PATH *path;
 334                addr += path_size;
 335                path = (ATOM_DISPLAY_OBJECT_PATH *) addr;
 336                path_size += le16_to_cpu(path->usSize);
 337
 338                if (device_support & le16_to_cpu(path->usDeviceTag)) {
 339                        uint8_t con_obj_id, con_obj_num, con_obj_type;
 340
 341                        con_obj_id =
 342                            (le16_to_cpu(path->usConnObjectId) & OBJECT_ID_MASK)
 343                            >> OBJECT_ID_SHIFT;
 344                        con_obj_num =
 345                            (le16_to_cpu(path->usConnObjectId) & ENUM_ID_MASK)
 346                            >> ENUM_ID_SHIFT;
 347                        con_obj_type =
 348                            (le16_to_cpu(path->usConnObjectId) &
 349                             OBJECT_TYPE_MASK) >> OBJECT_TYPE_SHIFT;
 350
 351                        /* Skip TV/CV support */
 352                        if ((le16_to_cpu(path->usDeviceTag) ==
 353                             ATOM_DEVICE_TV1_SUPPORT) ||
 354                            (le16_to_cpu(path->usDeviceTag) ==
 355                             ATOM_DEVICE_CV_SUPPORT))
 356                                continue;
 357
 358                        if (con_obj_id >= ARRAY_SIZE(object_connector_convert)) {
 359                                DRM_ERROR("invalid con_obj_id %d for device tag 0x%04x\n",
 360                                          con_obj_id, le16_to_cpu(path->usDeviceTag));
 361                                continue;
 362                        }
 363
 364                        connector_type =
 365                                object_connector_convert[con_obj_id];
 366                        connector_object_id = con_obj_id;
 367
 368                        if (connector_type == DRM_MODE_CONNECTOR_Unknown)
 369                                continue;
 370
 371                        router.ddc_valid = false;
 372                        router.cd_valid = false;
 373                        for (j = 0; j < ((le16_to_cpu(path->usSize) - 8) / 2); j++) {
 374                                uint8_t grph_obj_id, grph_obj_num, grph_obj_type;
 375
 376                                grph_obj_id =
 377                                    (le16_to_cpu(path->usGraphicObjIds[j]) &
 378                                     OBJECT_ID_MASK) >> OBJECT_ID_SHIFT;
 379                                grph_obj_num =
 380                                    (le16_to_cpu(path->usGraphicObjIds[j]) &
 381                                     ENUM_ID_MASK) >> ENUM_ID_SHIFT;
 382                                grph_obj_type =
 383                                    (le16_to_cpu(path->usGraphicObjIds[j]) &
 384                                     OBJECT_TYPE_MASK) >> OBJECT_TYPE_SHIFT;
 385
 386                                if (grph_obj_type == GRAPH_OBJECT_TYPE_ENCODER) {
 387                                        for (k = 0; k < enc_obj->ucNumberOfObjects; k++) {
 388                                                u16 encoder_obj = le16_to_cpu(enc_obj->asObjects[k].usObjectID);
 389                                                if (le16_to_cpu(path->usGraphicObjIds[j]) == encoder_obj) {
 390                                                        ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
 391                                                                (ctx->bios + data_offset +
 392                                                                 le16_to_cpu(enc_obj->asObjects[k].usRecordOffset));
 393                                                        ATOM_ENCODER_CAP_RECORD *cap_record;
 394                                                        u16 caps = 0;
 395
 396                                                        while (record->ucRecordSize > 0 &&
 397                                                               record->ucRecordType > 0 &&
 398                                                               record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
 399                                                                switch (record->ucRecordType) {
 400                                                                case ATOM_ENCODER_CAP_RECORD_TYPE:
 401                                                                        cap_record =(ATOM_ENCODER_CAP_RECORD *)
 402                                                                                record;
 403                                                                        caps = le16_to_cpu(cap_record->usEncoderCap);
 404                                                                        break;
 405                                                                }
 406                                                                record = (ATOM_COMMON_RECORD_HEADER *)
 407                                                                        ((char *)record + record->ucRecordSize);
 408                                                        }
 409                                                        amdgpu_display_add_encoder(adev, encoder_obj,
 410                                                                                    le16_to_cpu(path->usDeviceTag),
 411                                                                                    caps);
 412                                                }
 413                                        }
 414                                } else if (grph_obj_type == GRAPH_OBJECT_TYPE_ROUTER) {
 415                                        for (k = 0; k < router_obj->ucNumberOfObjects; k++) {
 416                                                u16 router_obj_id = le16_to_cpu(router_obj->asObjects[k].usObjectID);
 417                                                if (le16_to_cpu(path->usGraphicObjIds[j]) == router_obj_id) {
 418                                                        ATOM_COMMON_RECORD_HEADER *record = (ATOM_COMMON_RECORD_HEADER *)
 419                                                                (ctx->bios + data_offset +
 420                                                                 le16_to_cpu(router_obj->asObjects[k].usRecordOffset));
 421                                                        ATOM_I2C_RECORD *i2c_record;
 422                                                        ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
 423                                                        ATOM_ROUTER_DDC_PATH_SELECT_RECORD *ddc_path;
 424                                                        ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *cd_path;
 425                                                        ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *router_src_dst_table =
 426                                                                (ATOM_SRC_DST_TABLE_FOR_ONE_OBJECT *)
 427                                                                (ctx->bios + data_offset +
 428                                                                 le16_to_cpu(router_obj->asObjects[k].usSrcDstTableOffset));
 429                                                        u8 *num_dst_objs = (u8 *)
 430                                                                ((u8 *)router_src_dst_table + 1 +
 431                                                                 (router_src_dst_table->ucNumberOfSrc * 2));
 432                                                        u16 *dst_objs = (u16 *)(num_dst_objs + 1);
 433                                                        int enum_id;
 434
 435                                                        router.router_id = router_obj_id;
 436                                                        for (enum_id = 0; enum_id < (*num_dst_objs); enum_id++) {
 437                                                                if (le16_to_cpu(path->usConnObjectId) ==
 438                                                                    le16_to_cpu(dst_objs[enum_id]))
 439                                                                        break;
 440                                                        }
 441
 442                                                        while (record->ucRecordSize > 0 &&
 443                                                               record->ucRecordType > 0 &&
 444                                                               record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
 445                                                                switch (record->ucRecordType) {
 446                                                                case ATOM_I2C_RECORD_TYPE:
 447                                                                        i2c_record =
 448                                                                                (ATOM_I2C_RECORD *)
 449                                                                                record;
 450                                                                        i2c_config =
 451                                                                                (ATOM_I2C_ID_CONFIG_ACCESS *)
 452                                                                                &i2c_record->sucI2cId;
 453                                                                        router.i2c_info =
 454                                                                                amdgpu_atombios_lookup_i2c_gpio(adev,
 455                                                                                                       i2c_config->
 456                                                                                                       ucAccess);
 457                                                                        router.i2c_addr = i2c_record->ucI2CAddr >> 1;
 458                                                                        break;
 459                                                                case ATOM_ROUTER_DDC_PATH_SELECT_RECORD_TYPE:
 460                                                                        ddc_path = (ATOM_ROUTER_DDC_PATH_SELECT_RECORD *)
 461                                                                                record;
 462                                                                        router.ddc_valid = true;
 463                                                                        router.ddc_mux_type = ddc_path->ucMuxType;
 464                                                                        router.ddc_mux_control_pin = ddc_path->ucMuxControlPin;
 465                                                                        router.ddc_mux_state = ddc_path->ucMuxState[enum_id];
 466                                                                        break;
 467                                                                case ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD_TYPE:
 468                                                                        cd_path = (ATOM_ROUTER_DATA_CLOCK_PATH_SELECT_RECORD *)
 469                                                                                record;
 470                                                                        router.cd_valid = true;
 471                                                                        router.cd_mux_type = cd_path->ucMuxType;
 472                                                                        router.cd_mux_control_pin = cd_path->ucMuxControlPin;
 473                                                                        router.cd_mux_state = cd_path->ucMuxState[enum_id];
 474                                                                        break;
 475                                                                }
 476                                                                record = (ATOM_COMMON_RECORD_HEADER *)
 477                                                                        ((char *)record + record->ucRecordSize);
 478                                                        }
 479                                                }
 480                                        }
 481                                }
 482                        }
 483
 484                        /* look up gpio for ddc, hpd */
 485                        ddc_bus.valid = false;
 486                        hpd.hpd = AMDGPU_HPD_NONE;
 487                        if ((le16_to_cpu(path->usDeviceTag) &
 488                             (ATOM_DEVICE_TV_SUPPORT | ATOM_DEVICE_CV_SUPPORT)) == 0) {
 489                                for (j = 0; j < con_obj->ucNumberOfObjects; j++) {
 490                                        if (le16_to_cpu(path->usConnObjectId) ==
 491                                            le16_to_cpu(con_obj->asObjects[j].
 492                                                        usObjectID)) {
 493                                                ATOM_COMMON_RECORD_HEADER
 494                                                    *record =
 495                                                    (ATOM_COMMON_RECORD_HEADER
 496                                                     *)
 497                                                    (ctx->bios + data_offset +
 498                                                     le16_to_cpu(con_obj->
 499                                                                 asObjects[j].
 500                                                                 usRecordOffset));
 501                                                ATOM_I2C_RECORD *i2c_record;
 502                                                ATOM_HPD_INT_RECORD *hpd_record;
 503                                                ATOM_I2C_ID_CONFIG_ACCESS *i2c_config;
 504
 505                                                while (record->ucRecordSize > 0 &&
 506                                                       record->ucRecordType > 0 &&
 507                                                       record->ucRecordType <= ATOM_MAX_OBJECT_RECORD_NUMBER) {
 508                                                        switch (record->ucRecordType) {
 509                                                        case ATOM_I2C_RECORD_TYPE:
 510                                                                i2c_record =
 511                                                                    (ATOM_I2C_RECORD *)
 512                                                                        record;
 513                                                                i2c_config =
 514                                                                        (ATOM_I2C_ID_CONFIG_ACCESS *)
 515                                                                        &i2c_record->sucI2cId;
 516                                                                ddc_bus = amdgpu_atombios_lookup_i2c_gpio(adev,
 517                                                                                                 i2c_config->
 518                                                                                                 ucAccess);
 519                                                                break;
 520                                                        case ATOM_HPD_INT_RECORD_TYPE:
 521                                                                hpd_record =
 522                                                                        (ATOM_HPD_INT_RECORD *)
 523                                                                        record;
 524                                                                gpio = amdgpu_atombios_lookup_gpio(adev,
 525                                                                                          hpd_record->ucHPDIntGPIOID);
 526                                                                hpd = amdgpu_atombios_get_hpd_info_from_gpio(adev, &gpio);
 527                                                                hpd.plugged_state = hpd_record->ucPlugged_PinState;
 528                                                                break;
 529                                                        }
 530                                                        record =
 531                                                            (ATOM_COMMON_RECORD_HEADER
 532                                                             *) ((char *)record
 533                                                                 +
 534                                                                 record->
 535                                                                 ucRecordSize);
 536                                                }
 537                                                break;
 538                                        }
 539                                }
 540                        }
 541
 542                        /* needed for aux chan transactions */
 543                        ddc_bus.hpd = hpd.hpd;
 544
 545                        conn_id = le16_to_cpu(path->usConnObjectId);
 546
 547                        amdgpu_display_add_connector(adev,
 548                                                      conn_id,
 549                                                      le16_to_cpu(path->usDeviceTag),
 550                                                      connector_type, &ddc_bus,
 551                                                      connector_object_id,
 552                                                      &hpd,
 553                                                      &router);
 554
 555                }
 556        }
 557
 558        amdgpu_link_encoder_connector(adev->ddev);
 559
 560        return true;
 561}
 562
 563union firmware_info {
 564        ATOM_FIRMWARE_INFO info;
 565        ATOM_FIRMWARE_INFO_V1_2 info_12;
 566        ATOM_FIRMWARE_INFO_V1_3 info_13;
 567        ATOM_FIRMWARE_INFO_V1_4 info_14;
 568        ATOM_FIRMWARE_INFO_V2_1 info_21;
 569        ATOM_FIRMWARE_INFO_V2_2 info_22;
 570};
 571
 572int amdgpu_atombios_get_clock_info(struct amdgpu_device *adev)
 573{
 574        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 575        int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
 576        uint8_t frev, crev;
 577        uint16_t data_offset;
 578        int ret = -EINVAL;
 579
 580        if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
 581                                   &frev, &crev, &data_offset)) {
 582                int i;
 583                struct amdgpu_pll *ppll = &adev->clock.ppll[0];
 584                struct amdgpu_pll *spll = &adev->clock.spll;
 585                struct amdgpu_pll *mpll = &adev->clock.mpll;
 586                union firmware_info *firmware_info =
 587                        (union firmware_info *)(mode_info->atom_context->bios +
 588                                                data_offset);
 589                /* pixel clocks */
 590                ppll->reference_freq =
 591                    le16_to_cpu(firmware_info->info.usReferenceClock);
 592                ppll->reference_div = 0;
 593
 594                ppll->pll_out_min =
 595                        le32_to_cpu(firmware_info->info_12.ulMinPixelClockPLL_Output);
 596                ppll->pll_out_max =
 597                    le32_to_cpu(firmware_info->info.ulMaxPixelClockPLL_Output);
 598
 599                ppll->lcd_pll_out_min =
 600                        le16_to_cpu(firmware_info->info_14.usLcdMinPixelClockPLL_Output) * 100;
 601                if (ppll->lcd_pll_out_min == 0)
 602                        ppll->lcd_pll_out_min = ppll->pll_out_min;
 603                ppll->lcd_pll_out_max =
 604                        le16_to_cpu(firmware_info->info_14.usLcdMaxPixelClockPLL_Output) * 100;
 605                if (ppll->lcd_pll_out_max == 0)
 606                        ppll->lcd_pll_out_max = ppll->pll_out_max;
 607
 608                if (ppll->pll_out_min == 0)
 609                        ppll->pll_out_min = 64800;
 610
 611                ppll->pll_in_min =
 612                    le16_to_cpu(firmware_info->info.usMinPixelClockPLL_Input);
 613                ppll->pll_in_max =
 614                    le16_to_cpu(firmware_info->info.usMaxPixelClockPLL_Input);
 615
 616                ppll->min_post_div = 2;
 617                ppll->max_post_div = 0x7f;
 618                ppll->min_frac_feedback_div = 0;
 619                ppll->max_frac_feedback_div = 9;
 620                ppll->min_ref_div = 2;
 621                ppll->max_ref_div = 0x3ff;
 622                ppll->min_feedback_div = 4;
 623                ppll->max_feedback_div = 0xfff;
 624                ppll->best_vco = 0;
 625
 626                for (i = 1; i < AMDGPU_MAX_PPLL; i++)
 627                        adev->clock.ppll[i] = *ppll;
 628
 629                /* system clock */
 630                spll->reference_freq =
 631                        le16_to_cpu(firmware_info->info_21.usCoreReferenceClock);
 632                spll->reference_div = 0;
 633
 634                spll->pll_out_min =
 635                    le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Output);
 636                spll->pll_out_max =
 637                    le32_to_cpu(firmware_info->info.ulMaxEngineClockPLL_Output);
 638
 639                /* ??? */
 640                if (spll->pll_out_min == 0)
 641                        spll->pll_out_min = 64800;
 642
 643                spll->pll_in_min =
 644                    le16_to_cpu(firmware_info->info.usMinEngineClockPLL_Input);
 645                spll->pll_in_max =
 646                    le16_to_cpu(firmware_info->info.usMaxEngineClockPLL_Input);
 647
 648                spll->min_post_div = 1;
 649                spll->max_post_div = 1;
 650                spll->min_ref_div = 2;
 651                spll->max_ref_div = 0xff;
 652                spll->min_feedback_div = 4;
 653                spll->max_feedback_div = 0xff;
 654                spll->best_vco = 0;
 655
 656                /* memory clock */
 657                mpll->reference_freq =
 658                        le16_to_cpu(firmware_info->info_21.usMemoryReferenceClock);
 659                mpll->reference_div = 0;
 660
 661                mpll->pll_out_min =
 662                    le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Output);
 663                mpll->pll_out_max =
 664                    le32_to_cpu(firmware_info->info.ulMaxMemoryClockPLL_Output);
 665
 666                /* ??? */
 667                if (mpll->pll_out_min == 0)
 668                        mpll->pll_out_min = 64800;
 669
 670                mpll->pll_in_min =
 671                    le16_to_cpu(firmware_info->info.usMinMemoryClockPLL_Input);
 672                mpll->pll_in_max =
 673                    le16_to_cpu(firmware_info->info.usMaxMemoryClockPLL_Input);
 674
 675                adev->clock.default_sclk =
 676                    le32_to_cpu(firmware_info->info.ulDefaultEngineClock);
 677                adev->clock.default_mclk =
 678                    le32_to_cpu(firmware_info->info.ulDefaultMemoryClock);
 679
 680                mpll->min_post_div = 1;
 681                mpll->max_post_div = 1;
 682                mpll->min_ref_div = 2;
 683                mpll->max_ref_div = 0xff;
 684                mpll->min_feedback_div = 4;
 685                mpll->max_feedback_div = 0xff;
 686                mpll->best_vco = 0;
 687
 688                /* disp clock */
 689                adev->clock.default_dispclk =
 690                        le32_to_cpu(firmware_info->info_21.ulDefaultDispEngineClkFreq);
 691                /* set a reasonable default for DP */
 692                if (adev->clock.default_dispclk < 53900) {
 693                        DRM_INFO("Changing default dispclk from %dMhz to 600Mhz\n",
 694                                 adev->clock.default_dispclk / 100);
 695                        adev->clock.default_dispclk = 60000;
 696                }
 697                adev->clock.dp_extclk =
 698                        le16_to_cpu(firmware_info->info_21.usUniphyDPModeExtClkFreq);
 699                adev->clock.current_dispclk = adev->clock.default_dispclk;
 700
 701                adev->clock.max_pixel_clock = le16_to_cpu(firmware_info->info.usMaxPixelClock);
 702                if (adev->clock.max_pixel_clock == 0)
 703                        adev->clock.max_pixel_clock = 40000;
 704
 705                /* not technically a clock, but... */
 706                adev->mode_info.firmware_flags =
 707                        le16_to_cpu(firmware_info->info.usFirmwareCapability.susAccess);
 708
 709                ret = 0;
 710        }
 711
 712        adev->pm.current_sclk = adev->clock.default_sclk;
 713        adev->pm.current_mclk = adev->clock.default_mclk;
 714
 715        return ret;
 716}
 717
 718union gfx_info {
 719        ATOM_GFX_INFO_V2_1 info;
 720};
 721
 722int amdgpu_atombios_get_gfx_info(struct amdgpu_device *adev)
 723{
 724        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 725        int index = GetIndexIntoMasterTable(DATA, GFX_Info);
 726        uint8_t frev, crev;
 727        uint16_t data_offset;
 728        int ret = -EINVAL;
 729
 730        if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
 731                                   &frev, &crev, &data_offset)) {
 732                union gfx_info *gfx_info = (union gfx_info *)
 733                        (mode_info->atom_context->bios + data_offset);
 734
 735                adev->gfx.config.max_shader_engines = gfx_info->info.max_shader_engines;
 736                adev->gfx.config.max_tile_pipes = gfx_info->info.max_tile_pipes;
 737                adev->gfx.config.max_cu_per_sh = gfx_info->info.max_cu_per_sh;
 738                adev->gfx.config.max_sh_per_se = gfx_info->info.max_sh_per_se;
 739                adev->gfx.config.max_backends_per_se = gfx_info->info.max_backends_per_se;
 740                adev->gfx.config.max_texture_channel_caches =
 741                        gfx_info->info.max_texture_channel_caches;
 742
 743                ret = 0;
 744        }
 745        return ret;
 746}
 747
 748union igp_info {
 749        struct _ATOM_INTEGRATED_SYSTEM_INFO info;
 750        struct _ATOM_INTEGRATED_SYSTEM_INFO_V2 info_2;
 751        struct _ATOM_INTEGRATED_SYSTEM_INFO_V6 info_6;
 752        struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_7 info_7;
 753        struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_8 info_8;
 754        struct _ATOM_INTEGRATED_SYSTEM_INFO_V1_9 info_9;
 755};
 756
 757static void amdgpu_atombios_get_igp_ss_overrides(struct amdgpu_device *adev,
 758                                                 struct amdgpu_atom_ss *ss,
 759                                                 int id)
 760{
 761        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 762        int index = GetIndexIntoMasterTable(DATA, IntegratedSystemInfo);
 763        u16 data_offset, size;
 764        union igp_info *igp_info;
 765        u8 frev, crev;
 766        u16 percentage = 0, rate = 0;
 767
 768        /* get any igp specific overrides */
 769        if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
 770                                   &frev, &crev, &data_offset)) {
 771                igp_info = (union igp_info *)
 772                        (mode_info->atom_context->bios + data_offset);
 773                switch (crev) {
 774                case 6:
 775                        switch (id) {
 776                        case ASIC_INTERNAL_SS_ON_TMDS:
 777                                percentage = le16_to_cpu(igp_info->info_6.usDVISSPercentage);
 778                                rate = le16_to_cpu(igp_info->info_6.usDVISSpreadRateIn10Hz);
 779                                break;
 780                        case ASIC_INTERNAL_SS_ON_HDMI:
 781                                percentage = le16_to_cpu(igp_info->info_6.usHDMISSPercentage);
 782                                rate = le16_to_cpu(igp_info->info_6.usHDMISSpreadRateIn10Hz);
 783                                break;
 784                        case ASIC_INTERNAL_SS_ON_LVDS:
 785                                percentage = le16_to_cpu(igp_info->info_6.usLvdsSSPercentage);
 786                                rate = le16_to_cpu(igp_info->info_6.usLvdsSSpreadRateIn10Hz);
 787                                break;
 788                        }
 789                        break;
 790                case 7:
 791                        switch (id) {
 792                        case ASIC_INTERNAL_SS_ON_TMDS:
 793                                percentage = le16_to_cpu(igp_info->info_7.usDVISSPercentage);
 794                                rate = le16_to_cpu(igp_info->info_7.usDVISSpreadRateIn10Hz);
 795                                break;
 796                        case ASIC_INTERNAL_SS_ON_HDMI:
 797                                percentage = le16_to_cpu(igp_info->info_7.usHDMISSPercentage);
 798                                rate = le16_to_cpu(igp_info->info_7.usHDMISSpreadRateIn10Hz);
 799                                break;
 800                        case ASIC_INTERNAL_SS_ON_LVDS:
 801                                percentage = le16_to_cpu(igp_info->info_7.usLvdsSSPercentage);
 802                                rate = le16_to_cpu(igp_info->info_7.usLvdsSSpreadRateIn10Hz);
 803                                break;
 804                        }
 805                        break;
 806                case 8:
 807                        switch (id) {
 808                        case ASIC_INTERNAL_SS_ON_TMDS:
 809                                percentage = le16_to_cpu(igp_info->info_8.usDVISSPercentage);
 810                                rate = le16_to_cpu(igp_info->info_8.usDVISSpreadRateIn10Hz);
 811                                break;
 812                        case ASIC_INTERNAL_SS_ON_HDMI:
 813                                percentage = le16_to_cpu(igp_info->info_8.usHDMISSPercentage);
 814                                rate = le16_to_cpu(igp_info->info_8.usHDMISSpreadRateIn10Hz);
 815                                break;
 816                        case ASIC_INTERNAL_SS_ON_LVDS:
 817                                percentage = le16_to_cpu(igp_info->info_8.usLvdsSSPercentage);
 818                                rate = le16_to_cpu(igp_info->info_8.usLvdsSSpreadRateIn10Hz);
 819                                break;
 820                        }
 821                        break;
 822                case 9:
 823                        switch (id) {
 824                        case ASIC_INTERNAL_SS_ON_TMDS:
 825                                percentage = le16_to_cpu(igp_info->info_9.usDVISSPercentage);
 826                                rate = le16_to_cpu(igp_info->info_9.usDVISSpreadRateIn10Hz);
 827                                break;
 828                        case ASIC_INTERNAL_SS_ON_HDMI:
 829                                percentage = le16_to_cpu(igp_info->info_9.usHDMISSPercentage);
 830                                rate = le16_to_cpu(igp_info->info_9.usHDMISSpreadRateIn10Hz);
 831                                break;
 832                        case ASIC_INTERNAL_SS_ON_LVDS:
 833                                percentage = le16_to_cpu(igp_info->info_9.usLvdsSSPercentage);
 834                                rate = le16_to_cpu(igp_info->info_9.usLvdsSSpreadRateIn10Hz);
 835                                break;
 836                        }
 837                        break;
 838                default:
 839                        DRM_ERROR("Unsupported IGP table: %d %d\n", frev, crev);
 840                        break;
 841                }
 842                if (percentage)
 843                        ss->percentage = percentage;
 844                if (rate)
 845                        ss->rate = rate;
 846        }
 847}
 848
 849union asic_ss_info {
 850        struct _ATOM_ASIC_INTERNAL_SS_INFO info;
 851        struct _ATOM_ASIC_INTERNAL_SS_INFO_V2 info_2;
 852        struct _ATOM_ASIC_INTERNAL_SS_INFO_V3 info_3;
 853};
 854
 855union asic_ss_assignment {
 856        struct _ATOM_ASIC_SS_ASSIGNMENT v1;
 857        struct _ATOM_ASIC_SS_ASSIGNMENT_V2 v2;
 858        struct _ATOM_ASIC_SS_ASSIGNMENT_V3 v3;
 859};
 860
 861bool amdgpu_atombios_get_asic_ss_info(struct amdgpu_device *adev,
 862                                      struct amdgpu_atom_ss *ss,
 863                                      int id, u32 clock)
 864{
 865        struct amdgpu_mode_info *mode_info = &adev->mode_info;
 866        int index = GetIndexIntoMasterTable(DATA, ASIC_InternalSS_Info);
 867        uint16_t data_offset, size;
 868        union asic_ss_info *ss_info;
 869        union asic_ss_assignment *ss_assign;
 870        uint8_t frev, crev;
 871        int i, num_indices;
 872
 873        if (id == ASIC_INTERNAL_MEMORY_SS) {
 874                if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_MEMORY_CLOCK_SS_SUPPORT))
 875                        return false;
 876        }
 877        if (id == ASIC_INTERNAL_ENGINE_SS) {
 878                if (!(adev->mode_info.firmware_flags & ATOM_BIOS_INFO_ENGINE_CLOCK_SS_SUPPORT))
 879                        return false;
 880        }
 881
 882        memset(ss, 0, sizeof(struct amdgpu_atom_ss));
 883        if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, &size,
 884                                   &frev, &crev, &data_offset)) {
 885
 886                ss_info =
 887                        (union asic_ss_info *)(mode_info->atom_context->bios + data_offset);
 888
 889                switch (frev) {
 890                case 1:
 891                        num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 892                                sizeof(ATOM_ASIC_SS_ASSIGNMENT);
 893
 894                        ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info.asSpreadSpectrum[0]);
 895                        for (i = 0; i < num_indices; i++) {
 896                                if ((ss_assign->v1.ucClockIndication == id) &&
 897                                    (clock <= le32_to_cpu(ss_assign->v1.ulTargetClockRange))) {
 898                                        ss->percentage =
 899                                                le16_to_cpu(ss_assign->v1.usSpreadSpectrumPercentage);
 900                                        ss->type = ss_assign->v1.ucSpreadSpectrumMode;
 901                                        ss->rate = le16_to_cpu(ss_assign->v1.usSpreadRateInKhz);
 902                                        ss->percentage_divider = 100;
 903                                        return true;
 904                                }
 905                                ss_assign = (union asic_ss_assignment *)
 906                                        ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT));
 907                        }
 908                        break;
 909                case 2:
 910                        num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 911                                sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2);
 912                        ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_2.asSpreadSpectrum[0]);
 913                        for (i = 0; i < num_indices; i++) {
 914                                if ((ss_assign->v2.ucClockIndication == id) &&
 915                                    (clock <= le32_to_cpu(ss_assign->v2.ulTargetClockRange))) {
 916                                        ss->percentage =
 917                                                le16_to_cpu(ss_assign->v2.usSpreadSpectrumPercentage);
 918                                        ss->type = ss_assign->v2.ucSpreadSpectrumMode;
 919                                        ss->rate = le16_to_cpu(ss_assign->v2.usSpreadRateIn10Hz);
 920                                        ss->percentage_divider = 100;
 921                                        if ((crev == 2) &&
 922                                            ((id == ASIC_INTERNAL_ENGINE_SS) ||
 923                                             (id == ASIC_INTERNAL_MEMORY_SS)))
 924                                                ss->rate /= 100;
 925                                        return true;
 926                                }
 927                                ss_assign = (union asic_ss_assignment *)
 928                                        ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V2));
 929                        }
 930                        break;
 931                case 3:
 932                        num_indices = (size - sizeof(ATOM_COMMON_TABLE_HEADER)) /
 933                                sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3);
 934                        ss_assign = (union asic_ss_assignment *)((u8 *)&ss_info->info_3.asSpreadSpectrum[0]);
 935                        for (i = 0; i < num_indices; i++) {
 936                                if ((ss_assign->v3.ucClockIndication == id) &&
 937                                    (clock <= le32_to_cpu(ss_assign->v3.ulTargetClockRange))) {
 938                                        ss->percentage =
 939                                                le16_to_cpu(ss_assign->v3.usSpreadSpectrumPercentage);
 940                                        ss->type = ss_assign->v3.ucSpreadSpectrumMode;
 941                                        ss->rate = le16_to_cpu(ss_assign->v3.usSpreadRateIn10Hz);
 942                                        if (ss_assign->v3.ucSpreadSpectrumMode &
 943                                            SS_MODE_V3_PERCENTAGE_DIV_BY_1000_MASK)
 944                                                ss->percentage_divider = 1000;
 945                                        else
 946                                                ss->percentage_divider = 100;
 947                                        if ((id == ASIC_INTERNAL_ENGINE_SS) ||
 948                                            (id == ASIC_INTERNAL_MEMORY_SS))
 949                                                ss->rate /= 100;
 950                                        if (adev->flags & AMD_IS_APU)
 951                                                amdgpu_atombios_get_igp_ss_overrides(adev, ss, id);
 952                                        return true;
 953                                }
 954                                ss_assign = (union asic_ss_assignment *)
 955                                        ((u8 *)ss_assign + sizeof(ATOM_ASIC_SS_ASSIGNMENT_V3));
 956                        }
 957                        break;
 958                default:
 959                        DRM_ERROR("Unsupported ASIC_InternalSS_Info table: %d %d\n", frev, crev);
 960                        break;
 961                }
 962
 963        }
 964        return false;
 965}
 966
 967union get_clock_dividers {
 968        struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS v1;
 969        struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V2 v2;
 970        struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V3 v3;
 971        struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V4 v4;
 972        struct _COMPUTE_MEMORY_ENGINE_PLL_PARAMETERS_V5 v5;
 973        struct _COMPUTE_GPU_CLOCK_INPUT_PARAMETERS_V1_6 v6_in;
 974        struct _COMPUTE_GPU_CLOCK_OUTPUT_PARAMETERS_V1_6 v6_out;
 975};
 976
 977int amdgpu_atombios_get_clock_dividers(struct amdgpu_device *adev,
 978                                       u8 clock_type,
 979                                       u32 clock,
 980                                       bool strobe_mode,
 981                                       struct atom_clock_dividers *dividers)
 982{
 983        union get_clock_dividers args;
 984        int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryEnginePLL);
 985        u8 frev, crev;
 986
 987        memset(&args, 0, sizeof(args));
 988        memset(dividers, 0, sizeof(struct atom_clock_dividers));
 989
 990        if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
 991                return -EINVAL;
 992
 993        switch (crev) {
 994        case 2:
 995        case 3:
 996        case 5:
 997                /* r6xx, r7xx, evergreen, ni, si.
 998                 * TODO: add support for asic_type <= CHIP_RV770*/
 999                if (clock_type == COMPUTE_ENGINE_PLL_PARAM) {
1000                        args.v3.ulClockParams = cpu_to_le32((clock_type << 24) | clock);
1001
1002                        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1003
1004                        dividers->post_div = args.v3.ucPostDiv;
1005                        dividers->enable_post_div = (args.v3.ucCntlFlag &
1006                                                     ATOM_PLL_CNTL_FLAG_PLL_POST_DIV_EN) ? true : false;
1007                        dividers->enable_dithen = (args.v3.ucCntlFlag &
1008                                                   ATOM_PLL_CNTL_FLAG_FRACTION_DISABLE) ? false : true;
1009                        dividers->whole_fb_div = le16_to_cpu(args.v3.ulFbDiv.usFbDiv);
1010                        dividers->frac_fb_div = le16_to_cpu(args.v3.ulFbDiv.usFbDivFrac);
1011                        dividers->ref_div = args.v3.ucRefDiv;
1012                        dividers->vco_mode = (args.v3.ucCntlFlag &
1013                                              ATOM_PLL_CNTL_FLAG_MPLL_VCO_MODE) ? 1 : 0;
1014                } else {
1015                        /* for SI we use ComputeMemoryClockParam for memory plls */
1016                        if (adev->asic_type >= CHIP_TAHITI)
1017                                return -EINVAL;
1018                        args.v5.ulClockParams = cpu_to_le32((clock_type << 24) | clock);
1019                        if (strobe_mode)
1020                                args.v5.ucInputFlag = ATOM_PLL_INPUT_FLAG_PLL_STROBE_MODE_EN;
1021
1022                        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1023
1024                        dividers->post_div = args.v5.ucPostDiv;
1025                        dividers->enable_post_div = (args.v5.ucCntlFlag &
1026                                                     ATOM_PLL_CNTL_FLAG_PLL_POST_DIV_EN) ? true : false;
1027                        dividers->enable_dithen = (args.v5.ucCntlFlag &
1028                                                   ATOM_PLL_CNTL_FLAG_FRACTION_DISABLE) ? false : true;
1029                        dividers->whole_fb_div = le16_to_cpu(args.v5.ulFbDiv.usFbDiv);
1030                        dividers->frac_fb_div = le16_to_cpu(args.v5.ulFbDiv.usFbDivFrac);
1031                        dividers->ref_div = args.v5.ucRefDiv;
1032                        dividers->vco_mode = (args.v5.ucCntlFlag &
1033                                              ATOM_PLL_CNTL_FLAG_MPLL_VCO_MODE) ? 1 : 0;
1034                }
1035                break;
1036        case 4:
1037                /* fusion */
1038                args.v4.ulClock = cpu_to_le32(clock);   /* 10 khz */
1039
1040                amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1041
1042                dividers->post_divider = dividers->post_div = args.v4.ucPostDiv;
1043                dividers->real_clock = le32_to_cpu(args.v4.ulClock);
1044                break;
1045        case 6:
1046                /* CI */
1047                /* COMPUTE_GPUCLK_INPUT_FLAG_DEFAULT_GPUCLK, COMPUTE_GPUCLK_INPUT_FLAG_SCLK */
1048                args.v6_in.ulClock.ulComputeClockFlag = clock_type;
1049                args.v6_in.ulClock.ulClockFreq = cpu_to_le32(clock);    /* 10 khz */
1050
1051                amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1052
1053                dividers->whole_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDiv);
1054                dividers->frac_fb_div = le16_to_cpu(args.v6_out.ulFbDiv.usFbDivFrac);
1055                dividers->ref_div = args.v6_out.ucPllRefDiv;
1056                dividers->post_div = args.v6_out.ucPllPostDiv;
1057                dividers->flags = args.v6_out.ucPllCntlFlag;
1058                dividers->real_clock = le32_to_cpu(args.v6_out.ulClock.ulClock);
1059                dividers->post_divider = args.v6_out.ulClock.ucPostDiv;
1060                break;
1061        default:
1062                return -EINVAL;
1063        }
1064        return 0;
1065}
1066
1067int amdgpu_atombios_get_memory_pll_dividers(struct amdgpu_device *adev,
1068                                            u32 clock,
1069                                            bool strobe_mode,
1070                                            struct atom_mpll_param *mpll_param)
1071{
1072        COMPUTE_MEMORY_CLOCK_PARAM_PARAMETERS_V2_1 args;
1073        int index = GetIndexIntoMasterTable(COMMAND, ComputeMemoryClockParam);
1074        u8 frev, crev;
1075
1076        memset(&args, 0, sizeof(args));
1077        memset(mpll_param, 0, sizeof(struct atom_mpll_param));
1078
1079        if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1080                return -EINVAL;
1081
1082        switch (frev) {
1083        case 2:
1084                switch (crev) {
1085                case 1:
1086                        /* SI */
1087                        args.ulClock = cpu_to_le32(clock);      /* 10 khz */
1088                        args.ucInputFlag = 0;
1089                        if (strobe_mode)
1090                                args.ucInputFlag |= MPLL_INPUT_FLAG_STROBE_MODE_EN;
1091
1092                        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1093
1094                        mpll_param->clkfrac = le16_to_cpu(args.ulFbDiv.usFbDivFrac);
1095                        mpll_param->clkf = le16_to_cpu(args.ulFbDiv.usFbDiv);
1096                        mpll_param->post_div = args.ucPostDiv;
1097                        mpll_param->dll_speed = args.ucDllSpeed;
1098                        mpll_param->bwcntl = args.ucBWCntl;
1099                        mpll_param->vco_mode =
1100                                (args.ucPllCntlFlag & MPLL_CNTL_FLAG_VCO_MODE_MASK);
1101                        mpll_param->yclk_sel =
1102                                (args.ucPllCntlFlag & MPLL_CNTL_FLAG_BYPASS_DQ_PLL) ? 1 : 0;
1103                        mpll_param->qdr =
1104                                (args.ucPllCntlFlag & MPLL_CNTL_FLAG_QDR_ENABLE) ? 1 : 0;
1105                        mpll_param->half_rate =
1106                                (args.ucPllCntlFlag & MPLL_CNTL_FLAG_AD_HALF_RATE) ? 1 : 0;
1107                        break;
1108                default:
1109                        return -EINVAL;
1110                }
1111                break;
1112        default:
1113                return -EINVAL;
1114        }
1115        return 0;
1116}
1117
1118uint32_t amdgpu_atombios_get_engine_clock(struct amdgpu_device *adev)
1119{
1120        GET_ENGINE_CLOCK_PS_ALLOCATION args;
1121        int index = GetIndexIntoMasterTable(COMMAND, GetEngineClock);
1122
1123        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1124        return le32_to_cpu(args.ulReturnEngineClock);
1125}
1126
1127uint32_t amdgpu_atombios_get_memory_clock(struct amdgpu_device *adev)
1128{
1129        GET_MEMORY_CLOCK_PS_ALLOCATION args;
1130        int index = GetIndexIntoMasterTable(COMMAND, GetMemoryClock);
1131
1132        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1133        return le32_to_cpu(args.ulReturnMemoryClock);
1134}
1135
1136void amdgpu_atombios_set_engine_clock(struct amdgpu_device *adev,
1137                                      uint32_t eng_clock)
1138{
1139        SET_ENGINE_CLOCK_PS_ALLOCATION args;
1140        int index = GetIndexIntoMasterTable(COMMAND, SetEngineClock);
1141
1142        args.ulTargetEngineClock = cpu_to_le32(eng_clock);      /* 10 khz */
1143
1144        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1145}
1146
1147void amdgpu_atombios_set_memory_clock(struct amdgpu_device *adev,
1148                                      uint32_t mem_clock)
1149{
1150        SET_MEMORY_CLOCK_PS_ALLOCATION args;
1151        int index = GetIndexIntoMasterTable(COMMAND, SetMemoryClock);
1152
1153        if (adev->flags & AMD_IS_APU)
1154                return;
1155
1156        args.ulTargetMemoryClock = cpu_to_le32(mem_clock);      /* 10 khz */
1157
1158        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1159}
1160
1161void amdgpu_atombios_set_engine_dram_timings(struct amdgpu_device *adev,
1162                                             u32 eng_clock, u32 mem_clock)
1163{
1164        SET_ENGINE_CLOCK_PS_ALLOCATION args;
1165        int index = GetIndexIntoMasterTable(COMMAND, DynamicMemorySettings);
1166        u32 tmp;
1167
1168        memset(&args, 0, sizeof(args));
1169
1170        tmp = eng_clock & SET_CLOCK_FREQ_MASK;
1171        tmp |= (COMPUTE_ENGINE_PLL_PARAM << 24);
1172
1173        args.ulTargetEngineClock = cpu_to_le32(tmp);
1174        if (mem_clock)
1175                args.sReserved.ulClock = cpu_to_le32(mem_clock & SET_CLOCK_FREQ_MASK);
1176
1177        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1178}
1179
1180void amdgpu_atombios_get_default_voltages(struct amdgpu_device *adev,
1181                                          u16 *vddc, u16 *vddci, u16 *mvdd)
1182{
1183        struct amdgpu_mode_info *mode_info = &adev->mode_info;
1184        int index = GetIndexIntoMasterTable(DATA, FirmwareInfo);
1185        u8 frev, crev;
1186        u16 data_offset;
1187        union firmware_info *firmware_info;
1188
1189        *vddc = 0;
1190        *vddci = 0;
1191        *mvdd = 0;
1192
1193        if (amdgpu_atom_parse_data_header(mode_info->atom_context, index, NULL,
1194                                   &frev, &crev, &data_offset)) {
1195                firmware_info =
1196                        (union firmware_info *)(mode_info->atom_context->bios +
1197                                                data_offset);
1198                *vddc = le16_to_cpu(firmware_info->info_14.usBootUpVDDCVoltage);
1199                if ((frev == 2) && (crev >= 2)) {
1200                        *vddci = le16_to_cpu(firmware_info->info_22.usBootUpVDDCIVoltage);
1201                        *mvdd = le16_to_cpu(firmware_info->info_22.usBootUpMVDDCVoltage);
1202                }
1203        }
1204}
1205
1206union set_voltage {
1207        struct _SET_VOLTAGE_PS_ALLOCATION alloc;
1208        struct _SET_VOLTAGE_PARAMETERS v1;
1209        struct _SET_VOLTAGE_PARAMETERS_V2 v2;
1210        struct _SET_VOLTAGE_PARAMETERS_V1_3 v3;
1211};
1212
1213int amdgpu_atombios_get_max_vddc(struct amdgpu_device *adev, u8 voltage_type,
1214                             u16 voltage_id, u16 *voltage)
1215{
1216        union set_voltage args;
1217        int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
1218        u8 frev, crev;
1219
1220        if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1221                return -EINVAL;
1222
1223        switch (crev) {
1224        case 1:
1225                return -EINVAL;
1226        case 2:
1227                args.v2.ucVoltageType = SET_VOLTAGE_GET_MAX_VOLTAGE;
1228                args.v2.ucVoltageMode = 0;
1229                args.v2.usVoltageLevel = 0;
1230
1231                amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1232
1233                *voltage = le16_to_cpu(args.v2.usVoltageLevel);
1234                break;
1235        case 3:
1236                args.v3.ucVoltageType = voltage_type;
1237                args.v3.ucVoltageMode = ATOM_GET_VOLTAGE_LEVEL;
1238                args.v3.usVoltageLevel = cpu_to_le16(voltage_id);
1239
1240                amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1241
1242                *voltage = le16_to_cpu(args.v3.usVoltageLevel);
1243                break;
1244        default:
1245                DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1246                return -EINVAL;
1247        }
1248
1249        return 0;
1250}
1251
1252int amdgpu_atombios_get_leakage_vddc_based_on_leakage_idx(struct amdgpu_device *adev,
1253                                                      u16 *voltage,
1254                                                      u16 leakage_idx)
1255{
1256        return amdgpu_atombios_get_max_vddc(adev, VOLTAGE_TYPE_VDDC, leakage_idx, voltage);
1257}
1258
1259void amdgpu_atombios_set_voltage(struct amdgpu_device *adev,
1260                                 u16 voltage_level,
1261                                 u8 voltage_type)
1262{
1263        union set_voltage args;
1264        int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
1265        u8 frev, crev, volt_index = voltage_level;
1266
1267        if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1268                return;
1269
1270        /* 0xff01 is a flag rather then an actual voltage */
1271        if (voltage_level == 0xff01)
1272                return;
1273
1274        switch (crev) {
1275        case 1:
1276                args.v1.ucVoltageType = voltage_type;
1277                args.v1.ucVoltageMode = SET_ASIC_VOLTAGE_MODE_ALL_SOURCE;
1278                args.v1.ucVoltageIndex = volt_index;
1279                break;
1280        case 2:
1281                args.v2.ucVoltageType = voltage_type;
1282                args.v2.ucVoltageMode = SET_ASIC_VOLTAGE_MODE_SET_VOLTAGE;
1283                args.v2.usVoltageLevel = cpu_to_le16(voltage_level);
1284                break;
1285        case 3:
1286                args.v3.ucVoltageType = voltage_type;
1287                args.v3.ucVoltageMode = ATOM_SET_VOLTAGE;
1288                args.v3.usVoltageLevel = cpu_to_le16(voltage_level);
1289                break;
1290        default:
1291                DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1292                return;
1293        }
1294
1295        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1296}
1297
1298int amdgpu_atombios_get_leakage_id_from_vbios(struct amdgpu_device *adev,
1299                                              u16 *leakage_id)
1300{
1301        union set_voltage args;
1302        int index = GetIndexIntoMasterTable(COMMAND, SetVoltage);
1303        u8 frev, crev;
1304
1305        if (!amdgpu_atom_parse_cmd_header(adev->mode_info.atom_context, index, &frev, &crev))
1306                return -EINVAL;
1307
1308        switch (crev) {
1309        case 3:
1310        case 4:
1311                args.v3.ucVoltageType = 0;
1312                args.v3.ucVoltageMode = ATOM_GET_LEAKAGE_ID;
1313                args.v3.usVoltageLevel = 0;
1314
1315                amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1316
1317                *leakage_id = le16_to_cpu(args.v3.usVoltageLevel);
1318                break;
1319        default:
1320                DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1321                return -EINVAL;
1322        }
1323
1324        return 0;
1325}
1326
1327int amdgpu_atombios_get_leakage_vddc_based_on_leakage_params(struct amdgpu_device *adev,
1328                                                             u16 *vddc, u16 *vddci,
1329                                                             u16 virtual_voltage_id,
1330                                                             u16 vbios_voltage_id)
1331{
1332        int index = GetIndexIntoMasterTable(DATA, ASIC_ProfilingInfo);
1333        u8 frev, crev;
1334        u16 data_offset, size;
1335        int i, j;
1336        ATOM_ASIC_PROFILING_INFO_V2_1 *profile;
1337        u16 *leakage_bin, *vddc_id_buf, *vddc_buf, *vddci_id_buf, *vddci_buf;
1338
1339        *vddc = 0;
1340        *vddci = 0;
1341
1342        if (!amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1343                                    &frev, &crev, &data_offset))
1344                return -EINVAL;
1345
1346        profile = (ATOM_ASIC_PROFILING_INFO_V2_1 *)
1347                (adev->mode_info.atom_context->bios + data_offset);
1348
1349        switch (frev) {
1350        case 1:
1351                return -EINVAL;
1352        case 2:
1353                switch (crev) {
1354                case 1:
1355                        if (size < sizeof(ATOM_ASIC_PROFILING_INFO_V2_1))
1356                                return -EINVAL;
1357                        leakage_bin = (u16 *)
1358                                (adev->mode_info.atom_context->bios + data_offset +
1359                                 le16_to_cpu(profile->usLeakageBinArrayOffset));
1360                        vddc_id_buf = (u16 *)
1361                                (adev->mode_info.atom_context->bios + data_offset +
1362                                 le16_to_cpu(profile->usElbVDDC_IdArrayOffset));
1363                        vddc_buf = (u16 *)
1364                                (adev->mode_info.atom_context->bios + data_offset +
1365                                 le16_to_cpu(profile->usElbVDDC_LevelArrayOffset));
1366                        vddci_id_buf = (u16 *)
1367                                (adev->mode_info.atom_context->bios + data_offset +
1368                                 le16_to_cpu(profile->usElbVDDCI_IdArrayOffset));
1369                        vddci_buf = (u16 *)
1370                                (adev->mode_info.atom_context->bios + data_offset +
1371                                 le16_to_cpu(profile->usElbVDDCI_LevelArrayOffset));
1372
1373                        if (profile->ucElbVDDC_Num > 0) {
1374                                for (i = 0; i < profile->ucElbVDDC_Num; i++) {
1375                                        if (vddc_id_buf[i] == virtual_voltage_id) {
1376                                                for (j = 0; j < profile->ucLeakageBinNum; j++) {
1377                                                        if (vbios_voltage_id <= leakage_bin[j]) {
1378                                                                *vddc = vddc_buf[j * profile->ucElbVDDC_Num + i];
1379                                                                break;
1380                                                        }
1381                                                }
1382                                                break;
1383                                        }
1384                                }
1385                        }
1386                        if (profile->ucElbVDDCI_Num > 0) {
1387                                for (i = 0; i < profile->ucElbVDDCI_Num; i++) {
1388                                        if (vddci_id_buf[i] == virtual_voltage_id) {
1389                                                for (j = 0; j < profile->ucLeakageBinNum; j++) {
1390                                                        if (vbios_voltage_id <= leakage_bin[j]) {
1391                                                                *vddci = vddci_buf[j * profile->ucElbVDDCI_Num + i];
1392                                                                break;
1393                                                        }
1394                                                }
1395                                                break;
1396                                        }
1397                                }
1398                        }
1399                        break;
1400                default:
1401                        DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1402                        return -EINVAL;
1403                }
1404                break;
1405        default:
1406                DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1407                return -EINVAL;
1408        }
1409
1410        return 0;
1411}
1412
1413union get_voltage_info {
1414        struct _GET_VOLTAGE_INFO_INPUT_PARAMETER_V1_2 in;
1415        struct _GET_EVV_VOLTAGE_INFO_OUTPUT_PARAMETER_V1_2 evv_out;
1416};
1417
1418int amdgpu_atombios_get_voltage_evv(struct amdgpu_device *adev,
1419                                    u16 virtual_voltage_id,
1420                                    u16 *voltage)
1421{
1422        int index = GetIndexIntoMasterTable(COMMAND, GetVoltageInfo);
1423        u32 entry_id;
1424        u32 count = adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.count;
1425        union get_voltage_info args;
1426
1427        for (entry_id = 0; entry_id < count; entry_id++) {
1428                if (adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[entry_id].v ==
1429                    virtual_voltage_id)
1430                        break;
1431        }
1432
1433        if (entry_id >= count)
1434                return -EINVAL;
1435
1436        args.in.ucVoltageType = VOLTAGE_TYPE_VDDC;
1437        args.in.ucVoltageMode = ATOM_GET_VOLTAGE_EVV_VOLTAGE;
1438        args.in.usVoltageLevel = cpu_to_le16(virtual_voltage_id);
1439        args.in.ulSCLKFreq =
1440                cpu_to_le32(adev->pm.dpm.dyn_state.vddc_dependency_on_sclk.entries[entry_id].clk);
1441
1442        amdgpu_atom_execute_table(adev->mode_info.atom_context, index, (uint32_t *)&args);
1443
1444        *voltage = le16_to_cpu(args.evv_out.usVoltageLevel);
1445
1446        return 0;
1447}
1448
1449union voltage_object_info {
1450        struct _ATOM_VOLTAGE_OBJECT_INFO v1;
1451        struct _ATOM_VOLTAGE_OBJECT_INFO_V2 v2;
1452        struct _ATOM_VOLTAGE_OBJECT_INFO_V3_1 v3;
1453};
1454
1455union voltage_object {
1456        struct _ATOM_VOLTAGE_OBJECT v1;
1457        struct _ATOM_VOLTAGE_OBJECT_V2 v2;
1458        union _ATOM_VOLTAGE_OBJECT_V3 v3;
1459};
1460
1461
1462static ATOM_VOLTAGE_OBJECT_V3 *amdgpu_atombios_lookup_voltage_object_v3(ATOM_VOLTAGE_OBJECT_INFO_V3_1 *v3,
1463                                                                        u8 voltage_type, u8 voltage_mode)
1464{
1465        u32 size = le16_to_cpu(v3->sHeader.usStructureSize);
1466        u32 offset = offsetof(ATOM_VOLTAGE_OBJECT_INFO_V3_1, asVoltageObj[0]);
1467        u8 *start = (u8*)v3;
1468
1469        while (offset < size) {
1470                ATOM_VOLTAGE_OBJECT_V3 *vo = (ATOM_VOLTAGE_OBJECT_V3 *)(start + offset);
1471                if ((vo->asGpioVoltageObj.sHeader.ucVoltageType == voltage_type) &&
1472                    (vo->asGpioVoltageObj.sHeader.ucVoltageMode == voltage_mode))
1473                        return vo;
1474                offset += le16_to_cpu(vo->asGpioVoltageObj.sHeader.usSize);
1475        }
1476        return NULL;
1477}
1478
1479int amdgpu_atombios_get_svi2_info(struct amdgpu_device *adev,
1480                              u8 voltage_type,
1481                              u8 *svd_gpio_id, u8 *svc_gpio_id)
1482{
1483        int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1484        u8 frev, crev;
1485        u16 data_offset, size;
1486        union voltage_object_info *voltage_info;
1487        union voltage_object *voltage_object = NULL;
1488
1489        if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1490                                   &frev, &crev, &data_offset)) {
1491                voltage_info = (union voltage_object_info *)
1492                        (adev->mode_info.atom_context->bios + data_offset);
1493
1494                switch (frev) {
1495                case 3:
1496                        switch (crev) {
1497                        case 1:
1498                                voltage_object = (union voltage_object *)
1499                                        amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1500                                                                      voltage_type,
1501                                                                      VOLTAGE_OBJ_SVID2);
1502                                if (voltage_object) {
1503                                        *svd_gpio_id = voltage_object->v3.asSVID2Obj.ucSVDGpioId;
1504                                        *svc_gpio_id = voltage_object->v3.asSVID2Obj.ucSVCGpioId;
1505                                } else {
1506                                        return -EINVAL;
1507                                }
1508                                break;
1509                        default:
1510                                DRM_ERROR("unknown voltage object table\n");
1511                                return -EINVAL;
1512                        }
1513                        break;
1514                default:
1515                        DRM_ERROR("unknown voltage object table\n");
1516                        return -EINVAL;
1517                }
1518
1519        }
1520        return 0;
1521}
1522
1523bool
1524amdgpu_atombios_is_voltage_gpio(struct amdgpu_device *adev,
1525                                u8 voltage_type, u8 voltage_mode)
1526{
1527        int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1528        u8 frev, crev;
1529        u16 data_offset, size;
1530        union voltage_object_info *voltage_info;
1531
1532        if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1533                                   &frev, &crev, &data_offset)) {
1534                voltage_info = (union voltage_object_info *)
1535                        (adev->mode_info.atom_context->bios + data_offset);
1536
1537                switch (frev) {
1538                case 3:
1539                        switch (crev) {
1540                        case 1:
1541                                if (amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1542                                                                  voltage_type, voltage_mode))
1543                                        return true;
1544                                break;
1545                        default:
1546                                DRM_ERROR("unknown voltage object table\n");
1547                                return false;
1548                        }
1549                        break;
1550                default:
1551                        DRM_ERROR("unknown voltage object table\n");
1552                        return false;
1553                }
1554
1555        }
1556        return false;
1557}
1558
1559int amdgpu_atombios_get_voltage_table(struct amdgpu_device *adev,
1560                                      u8 voltage_type, u8 voltage_mode,
1561                                      struct atom_voltage_table *voltage_table)
1562{
1563        int index = GetIndexIntoMasterTable(DATA, VoltageObjectInfo);
1564        u8 frev, crev;
1565        u16 data_offset, size;
1566        int i;
1567        union voltage_object_info *voltage_info;
1568        union voltage_object *voltage_object = NULL;
1569
1570        if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1571                                   &frev, &crev, &data_offset)) {
1572                voltage_info = (union voltage_object_info *)
1573                        (adev->mode_info.atom_context->bios + data_offset);
1574
1575                switch (frev) {
1576                case 3:
1577                        switch (crev) {
1578                        case 1:
1579                                voltage_object = (union voltage_object *)
1580                                        amdgpu_atombios_lookup_voltage_object_v3(&voltage_info->v3,
1581                                                                      voltage_type, voltage_mode);
1582                                if (voltage_object) {
1583                                        ATOM_GPIO_VOLTAGE_OBJECT_V3 *gpio =
1584                                                &voltage_object->v3.asGpioVoltageObj;
1585                                        VOLTAGE_LUT_ENTRY_V2 *lut;
1586                                        if (gpio->ucGpioEntryNum > MAX_VOLTAGE_ENTRIES)
1587                                                return -EINVAL;
1588                                        lut = &gpio->asVolGpioLut[0];
1589                                        for (i = 0; i < gpio->ucGpioEntryNum; i++) {
1590                                                voltage_table->entries[i].value =
1591                                                        le16_to_cpu(lut->usVoltageValue);
1592                                                voltage_table->entries[i].smio_low =
1593                                                        le32_to_cpu(lut->ulVoltageId);
1594                                                lut = (VOLTAGE_LUT_ENTRY_V2 *)
1595                                                        ((u8 *)lut + sizeof(VOLTAGE_LUT_ENTRY_V2));
1596                                        }
1597                                        voltage_table->mask_low = le32_to_cpu(gpio->ulGpioMaskVal);
1598                                        voltage_table->count = gpio->ucGpioEntryNum;
1599                                        voltage_table->phase_delay = gpio->ucPhaseDelay;
1600                                        return 0;
1601                                }
1602                                break;
1603                        default:
1604                                DRM_ERROR("unknown voltage object table\n");
1605                                return -EINVAL;
1606                        }
1607                        break;
1608                default:
1609                        DRM_ERROR("unknown voltage object table\n");
1610                        return -EINVAL;
1611                }
1612        }
1613        return -EINVAL;
1614}
1615
1616union vram_info {
1617        struct _ATOM_VRAM_INFO_V3 v1_3;
1618        struct _ATOM_VRAM_INFO_V4 v1_4;
1619        struct _ATOM_VRAM_INFO_HEADER_V2_1 v2_1;
1620};
1621
1622#define MEM_ID_MASK           0xff000000
1623#define MEM_ID_SHIFT          24
1624#define CLOCK_RANGE_MASK      0x00ffffff
1625#define CLOCK_RANGE_SHIFT     0
1626#define LOW_NIBBLE_MASK       0xf
1627#define DATA_EQU_PREV         0
1628#define DATA_FROM_TABLE       4
1629
1630int amdgpu_atombios_init_mc_reg_table(struct amdgpu_device *adev,
1631                                      u8 module_index,
1632                                      struct atom_mc_reg_table *reg_table)
1633{
1634        int index = GetIndexIntoMasterTable(DATA, VRAM_Info);
1635        u8 frev, crev, num_entries, t_mem_id, num_ranges = 0;
1636        u32 i = 0, j;
1637        u16 data_offset, size;
1638        union vram_info *vram_info;
1639
1640        memset(reg_table, 0, sizeof(struct atom_mc_reg_table));
1641
1642        if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1643                                   &frev, &crev, &data_offset)) {
1644                vram_info = (union vram_info *)
1645                        (adev->mode_info.atom_context->bios + data_offset);
1646                switch (frev) {
1647                case 1:
1648                        DRM_ERROR("old table version %d, %d\n", frev, crev);
1649                        return -EINVAL;
1650                case 2:
1651                        switch (crev) {
1652                        case 1:
1653                                if (module_index < vram_info->v2_1.ucNumOfVRAMModule) {
1654                                        ATOM_INIT_REG_BLOCK *reg_block =
1655                                                (ATOM_INIT_REG_BLOCK *)
1656                                                ((u8 *)vram_info + le16_to_cpu(vram_info->v2_1.usMemClkPatchTblOffset));
1657                                        ATOM_MEMORY_SETTING_DATA_BLOCK *reg_data =
1658                                                (ATOM_MEMORY_SETTING_DATA_BLOCK *)
1659                                                ((u8 *)reg_block + (2 * sizeof(u16)) +
1660                                                 le16_to_cpu(reg_block->usRegIndexTblSize));
1661                                        ATOM_INIT_REG_INDEX_FORMAT *format = &reg_block->asRegIndexBuf[0];
1662                                        num_entries = (u8)((le16_to_cpu(reg_block->usRegIndexTblSize)) /
1663                                                           sizeof(ATOM_INIT_REG_INDEX_FORMAT)) - 1;
1664                                        if (num_entries > VBIOS_MC_REGISTER_ARRAY_SIZE)
1665                                                return -EINVAL;
1666                                        while (i < num_entries) {
1667                                                if (format->ucPreRegDataLength & ACCESS_PLACEHOLDER)
1668                                                        break;
1669                                                reg_table->mc_reg_address[i].s1 =
1670                                                        (u16)(le16_to_cpu(format->usRegIndex));
1671                                                reg_table->mc_reg_address[i].pre_reg_data =
1672                                                        (u8)(format->ucPreRegDataLength);
1673                                                i++;
1674                                                format = (ATOM_INIT_REG_INDEX_FORMAT *)
1675                                                        ((u8 *)format + sizeof(ATOM_INIT_REG_INDEX_FORMAT));
1676                                        }
1677                                        reg_table->last = i;
1678                                        while ((le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK) &&
1679                                               (num_ranges < VBIOS_MAX_AC_TIMING_ENTRIES)) {
1680                                                t_mem_id = (u8)((le32_to_cpu(*(u32 *)reg_data) & MEM_ID_MASK)
1681                                                                >> MEM_ID_SHIFT);
1682                                                if (module_index == t_mem_id) {
1683                                                        reg_table->mc_reg_table_entry[num_ranges].mclk_max =
1684                                                                (u32)((le32_to_cpu(*(u32 *)reg_data) & CLOCK_RANGE_MASK)
1685                                                                      >> CLOCK_RANGE_SHIFT);
1686                                                        for (i = 0, j = 1; i < reg_table->last; i++) {
1687                                                                if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_FROM_TABLE) {
1688                                                                        reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
1689                                                                                (u32)le32_to_cpu(*((u32 *)reg_data + j));
1690                                                                        j++;
1691                                                                } else if ((reg_table->mc_reg_address[i].pre_reg_data & LOW_NIBBLE_MASK) == DATA_EQU_PREV) {
1692                                                                        reg_table->mc_reg_table_entry[num_ranges].mc_data[i] =
1693                                                                                reg_table->mc_reg_table_entry[num_ranges].mc_data[i - 1];
1694                                                                }
1695                                                        }
1696                                                        num_ranges++;
1697                                                }
1698                                                reg_data = (ATOM_MEMORY_SETTING_DATA_BLOCK *)
1699                                                        ((u8 *)reg_data + le16_to_cpu(reg_block->usRegDataBlkSize));
1700                                        }
1701                                        if (le32_to_cpu(*(u32 *)reg_data) != END_OF_REG_DATA_BLOCK)
1702                                                return -EINVAL;
1703                                        reg_table->num_entries = num_ranges;
1704                                } else
1705                                        return -EINVAL;
1706                                break;
1707                        default:
1708                                DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1709                                return -EINVAL;
1710                        }
1711                        break;
1712                default:
1713                        DRM_ERROR("Unknown table version %d, %d\n", frev, crev);
1714                        return -EINVAL;
1715                }
1716                return 0;
1717        }
1718        return -EINVAL;
1719}
1720
1721bool amdgpu_atombios_has_gpu_virtualization_table(struct amdgpu_device *adev)
1722{
1723        int index = GetIndexIntoMasterTable(DATA, GPUVirtualizationInfo);
1724        u8 frev, crev;
1725        u16 data_offset, size;
1726
1727        if (amdgpu_atom_parse_data_header(adev->mode_info.atom_context, index, &size,
1728                                          &frev, &crev, &data_offset))
1729                return true;
1730
1731        return false;
1732}
1733
1734void amdgpu_atombios_scratch_regs_lock(struct amdgpu_device *adev, bool lock)
1735{
1736        uint32_t bios_6_scratch;
1737
1738        bios_6_scratch = RREG32(mmBIOS_SCRATCH_6);
1739
1740        if (lock) {
1741                bios_6_scratch |= ATOM_S6_CRITICAL_STATE;
1742                bios_6_scratch &= ~ATOM_S6_ACC_MODE;
1743        } else {
1744                bios_6_scratch &= ~ATOM_S6_CRITICAL_STATE;
1745                bios_6_scratch |= ATOM_S6_ACC_MODE;
1746        }
1747
1748        WREG32(mmBIOS_SCRATCH_6, bios_6_scratch);
1749}
1750
1751void amdgpu_atombios_scratch_regs_init(struct amdgpu_device *adev)
1752{
1753        uint32_t bios_2_scratch, bios_6_scratch;
1754
1755        bios_2_scratch = RREG32(mmBIOS_SCRATCH_2);
1756        bios_6_scratch = RREG32(mmBIOS_SCRATCH_6);
1757
1758        /* let the bios control the backlight */
1759        bios_2_scratch &= ~ATOM_S2_VRI_BRIGHT_ENABLE;
1760
1761        /* tell the bios not to handle mode switching */
1762        bios_6_scratch |= ATOM_S6_ACC_BLOCK_DISPLAY_SWITCH;
1763
1764        /* clear the vbios dpms state */
1765        bios_2_scratch &= ~ATOM_S2_DEVICE_DPMS_STATE;
1766
1767        WREG32(mmBIOS_SCRATCH_2, bios_2_scratch);
1768        WREG32(mmBIOS_SCRATCH_6, bios_6_scratch);
1769}
1770
1771void amdgpu_atombios_scratch_regs_save(struct amdgpu_device *adev)
1772{
1773        int i;
1774
1775        for (i = 0; i < AMDGPU_BIOS_NUM_SCRATCH; i++)
1776                adev->bios_scratch[i] = RREG32(mmBIOS_SCRATCH_0 + i);
1777}
1778
1779void amdgpu_atombios_scratch_regs_restore(struct amdgpu_device *adev)
1780{
1781        int i;
1782
1783        for (i = 0; i < AMDGPU_BIOS_NUM_SCRATCH; i++)
1784                WREG32(mmBIOS_SCRATCH_0 + i, adev->bios_scratch[i]);
1785}
1786
1787/* Atom needs data in little endian format
1788 * so swap as appropriate when copying data to
1789 * or from atom. Note that atom operates on
1790 * dw units.
1791 */
1792void amdgpu_atombios_copy_swap(u8 *dst, u8 *src, u8 num_bytes, bool to_le)
1793{
1794#ifdef __BIG_ENDIAN
1795        u8 src_tmp[20], dst_tmp[20]; /* used for byteswapping */
1796        u32 *dst32, *src32;
1797        int i;
1798
1799        memcpy(src_tmp, src, num_bytes);
1800        src32 = (u32 *)src_tmp;
1801        dst32 = (u32 *)dst_tmp;
1802        if (to_le) {
1803                for (i = 0; i < ((num_bytes + 3) / 4); i++)
1804                        dst32[i] = cpu_to_le32(src32[i]);
1805                memcpy(dst, dst_tmp, num_bytes);
1806        } else {
1807                u8 dws = num_bytes & ~3;
1808                for (i = 0; i < ((num_bytes + 3) / 4); i++)
1809                        dst32[i] = le32_to_cpu(src32[i]);
1810                memcpy(dst, dst_tmp, dws);
1811                if (num_bytes % 4) {
1812                        for (i = 0; i < (num_bytes % 4); i++)
1813                                dst[dws+i] = dst_tmp[dws+i];
1814                }
1815        }
1816#else
1817        memcpy(dst, src, num_bytes);
1818#endif
1819}
1820