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 | |
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_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 | |
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, , 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 | |