Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / 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_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, 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