xref: /dragonfly/sys/dev/drm/radeon/kv_smc.c (revision 3f2dd94a569761201b5b0a18b2f697f97fe1b9dc)
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 <drm/drmP.h>
26 #include "radeon.h"
27 #include "cikd.h"
28 #include "kv_dpm.h"
29 
kv_notify_message_to_smu(struct radeon_device * rdev,u32 id)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 
kv_dpm_get_enable_mask(struct radeon_device * rdev,u32 * enable_mask)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 
kv_send_msg_to_smc_with_parameter(struct radeon_device * rdev,PPSMC_Msg msg,u32 parameter)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 
kv_set_smc_sram_address(struct radeon_device * rdev,u32 smc_address,u32 limit)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 
kv_read_smc_sram_dword(struct radeon_device * rdev,u32 smc_address,u32 * value,u32 limit)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 
kv_smc_dpm_enable(struct radeon_device * rdev,bool enable)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 
kv_smc_bapm_enable(struct radeon_device * rdev,bool enable)110 int kv_smc_bapm_enable(struct radeon_device *rdev, bool enable)
111 {
112           if (enable)
113                     return kv_notify_message_to_smu(rdev, PPSMC_MSG_EnableBAPM);
114           else
115                     return kv_notify_message_to_smu(rdev, PPSMC_MSG_DisableBAPM);
116 }
117 
kv_copy_bytes_to_smc(struct radeon_device * rdev,u32 smc_start_address,const u8 * src,u32 byte_count,u32 limit)118 int kv_copy_bytes_to_smc(struct radeon_device *rdev,
119                                u32 smc_start_address,
120                                const u8 *src, u32 byte_count, u32 limit)
121 {
122           int ret;
123           u32 data, original_data, addr, extra_shift, t_byte, count, mask;
124 
125           if ((smc_start_address + byte_count) > limit)
126                     return -EINVAL;
127 
128           addr = smc_start_address;
129           t_byte = addr & 3;
130 
131           /* RMW for the initial bytes */
132           if  (t_byte != 0) {
133                     addr -= t_byte;
134 
135                     ret = kv_set_smc_sram_address(rdev, addr, limit);
136                     if (ret)
137                               return ret;
138 
139                     original_data = RREG32(SMC_IND_DATA_0);
140 
141                     data = 0;
142                     mask = 0;
143                     count = 4;
144                     while (count > 0) {
145                               if (t_byte > 0) {
146                                         mask = (mask << 8) | 0xff;
147                                         t_byte--;
148                               } else if (byte_count > 0) {
149                                         data = (data << 8) + *src++;
150                                         byte_count--;
151                                         mask <<= 8;
152                               } else {
153                                         data <<= 8;
154                                         mask = (mask << 8) | 0xff;
155                               }
156                               count--;
157                     }
158 
159                     data |= original_data & mask;
160 
161                     ret = kv_set_smc_sram_address(rdev, addr, limit);
162                     if (ret)
163                               return ret;
164 
165                     WREG32(SMC_IND_DATA_0, data);
166 
167                     addr += 4;
168           }
169 
170           while (byte_count >= 4) {
171                     /* SMC address space is BE */
172                     data = (src[0] << 24) + (src[1] << 16) + (src[2] << 8) + src[3];
173 
174                     ret = kv_set_smc_sram_address(rdev, addr, limit);
175                     if (ret)
176                               return ret;
177 
178                     WREG32(SMC_IND_DATA_0, data);
179 
180                     src += 4;
181                     byte_count -= 4;
182                     addr += 4;
183           }
184 
185           /* RMW for the final bytes */
186           if (byte_count > 0) {
187                     data = 0;
188 
189                     ret = kv_set_smc_sram_address(rdev, addr, limit);
190                     if (ret)
191                               return ret;
192 
193                     original_data= RREG32(SMC_IND_DATA_0);
194 
195                     extra_shift = 8 * (4 - byte_count);
196 
197                     while (byte_count > 0) {
198                               /* SMC address space is BE */
199                               data = (data << 8) + *src++;
200                               byte_count--;
201                     }
202 
203                     data <<= extra_shift;
204 
205                     data |= (original_data & ~((~0UL) << extra_shift));
206 
207                     ret = kv_set_smc_sram_address(rdev, addr, limit);
208                     if (ret)
209                               return ret;
210 
211                     WREG32(SMC_IND_DATA_0, data);
212           }
213           return 0;
214 }
215 
216