drivers/gpu/drm/radeon/kv_smc.c

   1 /*
   2  * Copyright 2013 Advanced Micro Devices, Inc.
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20  * OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * Authors: Alex Deucher
  23  */
  24
  25 #include "drmP.h"
  26 #include "radeon.h"
  27 #include "cikd.h"
  28 #include "kv_dpm.h"
  29
  30 int kv_notify_message_to_smu(struct radeon_device *rdev, u32 id)
  31 {
  32         u32 i;
  33         u32 tmp = 0;
  34
  35         WREG32(SMC_MESSAGE_0, id & SMC_MSG_MASK);
  36
  37         for (i = 0; i < rdev->usec_timeout; i++) {
  38                 if ((RREG32(SMC_RESP_0) & SMC_RESP_MASK) != 0)
  39                         break;
  40                 udelay(1);
  41         }
  42         tmp = RREG32(SMC_RESP_0) & SMC_RESP_MASK;
  43
  44         if (tmp != 1) {
  45                 if (tmp == 0xFF)
  46                         return -EINVAL;
  47                 else if (tmp == 0xFE)
  48                         return -EINVAL;
  49         }
  50
  51         return 0;
  52 }
  53
  54 int kv_dpm_get_enable_mask(struct radeon_device *rdev, u32 *enable_mask)
  55 {
  56         int ret;
  57
  58         ret = kv_notify_message_to_smu(rdev, PPSMC_MSG_SCLKDPM_GetEnabledMask);
  59
  60         if (ret == 0)
  61                 *enable_mask = RREG32_SMC(SMC_SYSCON_MSG_ARG_0);
  62
  63         return ret;
  64 }
  65
  66 int kv_send_msg_to_smc_with_parameter(struct radeon_device *rdev,
  67                                       PPSMC_Msg msg, u32 parameter)
  68 {
  69
  70         WREG32(SMC_MSG_ARG_0, parameter);
  71
  72         return kv_notify_message_to_smu(rdev, msg);
  73 }
  74
  75 static int kv_set_smc_sram_address(struct radeon_device *rdev,
  76                                    u32 smc_address, u32 limit)
  77 {
  78         if (smc_address & 3)
  79                 return -EINVAL;
  80         if ((smc_address + 3) > limit)
  81                 return -EINVAL;
  82
  83         WREG32(SMC_IND_INDEX_0, smc_address);
  84         WREG32_P(SMC_IND_ACCESS_CNTL, 0, ~AUTO_INCREMENT_IND_0);
  85
  86         return 0;
  87 }
  88
  89 int kv_read_smc_sram_dword(struct radeon_device *rdev, u32 smc_address,
  90                            u32 *value, u32 limit)
  91 {
  92         int ret;
  93
  94         ret = kv_set_smc_sram_address(rdev, smc_address, limit);
  95         if (ret)
  96                 return ret;
  97
  98         *value = RREG32(SMC_IND_DATA_0);
  99         return 0;
 100 }
 101
 102 int kv_smc_dpm_enable(struct radeon_device *rdev, bool enable)
 103 {
 104         if (enable)
 105                 return kv_notify_message_to_smu(rdev, PPSMC_MSG_DPM_Enable);
 106         else
 107                 return kv_notify_message_to_smu(rdev, PPSMC_MSG_DPM_Disable);
 108 }
 109
 110 int kv_copy_bytes_to_smc(struct radeon_device *rdev,
 111                          u32 smc_start_address,
 112                          const u8 *src, u32 byte_count, u32 limit)
 113 {
 114         int ret;
 115         u32 data, original_data, addr, extra_shift, t_byte, count, mask;
 116
 117         if ((smc_start_address + byte_count) > limit)
 118                 return -EINVAL;
 119
 120         addr = smc_start_address;
 121         t_byte = addr & 3;
 122
 123         /* RMW for the initial bytes */
 124         if  (t_byte != 0) {
 125                 addr -= t_byte;
 126
 127                 ret = kv_set_smc_sram_address(rdev, addr, limit);
 128                 if (ret)
 129                         return ret;
 130
 131                 original_data = RREG32(SMC_IND_DATA_0);
 132
 133                 data = 0;
 134                 mask = 0;
 135                 count = 4;
 136                 while (count > 0) {
 137                         if (t_byte > 0) {
 138                                 mask = (mask << 8) | 0xff;
 139                                 t_byte--;
 140                         } else if (byte_count > 0) {
 141                                 data = (data << 8) + *src++;
 142                                 byte_count--;
 143                                 mask <<= 8;
 144                         } else {
 145                                 data <<= 8;
 146                                 mask = (mask << 8) | 0xff;
 147                         }
 148                         count--;
 149                 }
 150
 151                 data |= original_data & mask;
 152
 153                 ret = kv_set_smc_sram_address(rdev, addr, limit);
 154                 if (ret)
 155                         return ret;
 156
 157                 WREG32(SMC_IND_DATA_0, data);
 158
 159                 addr += 4;
 160         }
 161
 162         while (byte_count >= 4) {
 163                 /* SMC address space is BE */
 164                 data = (src[0] << 24) + (src[1] << 16) + (src[2] << 8) + src[3];
 165
 166                 ret = kv_set_smc_sram_address(rdev, addr, limit);
 167                 if (ret)
 168                         return ret;
 169
 170                 WREG32(SMC_IND_DATA_0, data);
 171
 172                 src += 4;
 173                 byte_count -= 4;
 174                 addr += 4;
 175         }
 176
 177         /* RMW for the final bytes */
 178         if (byte_count > 0) {
 179                 data = 0;
 180
 181                 ret = kv_set_smc_sram_address(rdev, addr, limit);
 182                 if (ret)
 183                         return ret;
 184
 185                 original_data= RREG32(SMC_IND_DATA_0);
 186
 187                 extra_shift = 8 * (4 - byte_count);
 188
 189                 while (byte_count > 0) {
 190                         /* SMC address space is BE */
 191                         data = (data << 8) + *src++;
 192                         byte_count--;
 193                 }
 194
 195                 data <<= extra_shift;
 196
 197                 data |= (original_data & ~((~0UL) << extra_shift));
 198
 199                 ret = kv_set_smc_sram_address(rdev, addr, limit);
 200                 if (ret)
 201                         return ret;
 202
 203                 WREG32(SMC_IND_DATA_0, data);
 204         }
 205         return 0;
 206 }
 207