Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 1 | #include <linux/kernel.h> |
| 2 | #include <linux/init.h> |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 3 | |
Tony Lindgren | 4e65331 | 2011-11-10 22:45:17 +0100 | [diff] [blame] | 4 | #include "common.h" |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 5 | |
| 6 | #include "voltage.h" |
| 7 | #include "vp.h" |
| 8 | #include "prm-regbits-34xx.h" |
| 9 | #include "prm-regbits-44xx.h" |
| 10 | #include "prm44xx.h" |
| 11 | |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 12 | static u32 _vp_set_init_voltage(struct voltagedomain *voltdm, u32 volt) |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 13 | { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 14 | struct omap_vp_instance *vp = voltdm->vp; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 15 | u32 vpconfig; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 16 | char vsel; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 17 | |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 18 | vsel = voltdm->pmic->uv_to_vsel(volt); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 19 | |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 20 | vpconfig = voltdm->read(vp->vpconfig); |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 21 | vpconfig &= ~(vp->common->vpconfig_initvoltage_mask | |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 22 | vp->common->vpconfig_forceupdate | |
| 23 | vp->common->vpconfig_initvdd); |
Kevin Hilman | 0ec3041 | 2011-04-04 16:02:28 -0700 | [diff] [blame] | 24 | vpconfig |= vsel << __ffs(vp->common->vpconfig_initvoltage_mask); |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 25 | voltdm->write(vpconfig, vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 26 | |
| 27 | /* Trigger initVDD value copy to voltage processor */ |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 28 | voltdm->write((vpconfig | vp->common->vpconfig_initvdd), |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 29 | vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 30 | |
| 31 | /* Clear initVDD copy trigger bit */ |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 32 | voltdm->write(vpconfig, vp->vpconfig); |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 33 | |
| 34 | return vpconfig; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 35 | } |
| 36 | |
| 37 | /* Generic voltage init functions */ |
| 38 | void __init omap_vp_init(struct voltagedomain *voltdm) |
| 39 | { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 40 | struct omap_vp_instance *vp = voltdm->vp; |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 41 | u32 val, sys_clk_rate, timeout, waittime; |
| 42 | u32 vddmin, vddmax, vstepmin, vstepmax; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 43 | |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 44 | if (!voltdm->read || !voltdm->write) { |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 45 | pr_err("%s: No read/write API for accessing vdd_%s regs\n", |
| 46 | __func__, voltdm->name); |
| 47 | return; |
| 48 | } |
| 49 | |
Kevin Hilman | 6f56727 | 2011-07-14 11:10:27 -0700 | [diff] [blame] | 50 | vp->enabled = false; |
| 51 | |
| 52 | /* Divide to avoid overflow */ |
| 53 | sys_clk_rate = voltdm->sys_clk.rate / 1000; |
| 54 | |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 55 | timeout = (sys_clk_rate * voltdm->pmic->vp_timeout_us) / 1000; |
| 56 | vddmin = voltdm->pmic->vp_vddmin; |
| 57 | vddmax = voltdm->pmic->vp_vddmax; |
Kevin Hilman | 6f56727 | 2011-07-14 11:10:27 -0700 | [diff] [blame] | 58 | |
| 59 | waittime = ((voltdm->pmic->step_size / voltdm->pmic->slew_rate) * |
| 60 | sys_clk_rate) / 1000; |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 61 | vstepmin = voltdm->pmic->vp_vstepmin; |
| 62 | vstepmax = voltdm->pmic->vp_vstepmax; |
Kevin Hilman | 6f56727 | 2011-07-14 11:10:27 -0700 | [diff] [blame] | 63 | |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 64 | /* |
| 65 | * VP_CONFIG: error gain is not set here, it will be updated |
| 66 | * on each scale, based on OPP. |
| 67 | */ |
| 68 | val = (voltdm->pmic->vp_erroroffset << |
| 69 | __ffs(voltdm->vp->common->vpconfig_erroroffset_mask)) | |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 70 | vp->common->vpconfig_timeouten; |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 71 | voltdm->write(val, vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 72 | |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 73 | /* VSTEPMIN */ |
| 74 | val = (waittime << vp->common->vstepmin_smpswaittimemin_shift) | |
| 75 | (vstepmin << vp->common->vstepmin_stepmin_shift); |
| 76 | voltdm->write(val, vp->vstepmin); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 77 | |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 78 | /* VSTEPMAX */ |
| 79 | val = (vstepmax << vp->common->vstepmax_stepmax_shift) | |
| 80 | (waittime << vp->common->vstepmax_smpswaittimemax_shift); |
| 81 | voltdm->write(val, vp->vstepmax); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 82 | |
Kevin Hilman | 667216d | 2011-04-04 17:58:21 -0700 | [diff] [blame] | 83 | /* VLIMITTO */ |
| 84 | val = (vddmax << vp->common->vlimitto_vddmax_shift) | |
| 85 | (vddmin << vp->common->vlimitto_vddmin_shift) | |
| 86 | (timeout << vp->common->vlimitto_timeout_shift); |
| 87 | voltdm->write(val, vp->vlimitto); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 88 | } |
| 89 | |
Kevin Hilman | 76ea742 | 2011-04-05 15:15:31 -0700 | [diff] [blame] | 90 | int omap_vp_update_errorgain(struct voltagedomain *voltdm, |
| 91 | unsigned long target_volt) |
| 92 | { |
| 93 | struct omap_volt_data *volt_data; |
| 94 | |
Kevin Hilman | 8798c4a | 2011-07-18 15:31:43 -0700 | [diff] [blame] | 95 | if (!voltdm->vp) |
| 96 | return -EINVAL; |
| 97 | |
Kevin Hilman | 76ea742 | 2011-04-05 15:15:31 -0700 | [diff] [blame] | 98 | /* Get volt_data corresponding to target_volt */ |
| 99 | volt_data = omap_voltage_get_voltdata(voltdm, target_volt); |
| 100 | if (IS_ERR(volt_data)) |
| 101 | return -EINVAL; |
| 102 | |
| 103 | /* Setting vp errorgain based on the voltage */ |
| 104 | voltdm->rmw(voltdm->vp->common->vpconfig_errorgain_mask, |
| 105 | volt_data->vp_errgain << |
| 106 | __ffs(voltdm->vp->common->vpconfig_errorgain_mask), |
| 107 | voltdm->vp->vpconfig); |
| 108 | |
| 109 | return 0; |
| 110 | } |
| 111 | |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 112 | /* VP force update method of voltage scaling */ |
| 113 | int omap_vp_forceupdate_scale(struct voltagedomain *voltdm, |
| 114 | unsigned long target_volt) |
| 115 | { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 116 | struct omap_vp_instance *vp = voltdm->vp; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 117 | u32 vpconfig; |
| 118 | u8 target_vsel, current_vsel; |
| 119 | int ret, timeout = 0; |
| 120 | |
| 121 | ret = omap_vc_pre_scale(voltdm, target_volt, &target_vsel, ¤t_vsel); |
| 122 | if (ret) |
| 123 | return ret; |
| 124 | |
| 125 | /* |
| 126 | * Clear all pending TransactionDone interrupt/status. Typical latency |
| 127 | * is <3us |
| 128 | */ |
| 129 | while (timeout++ < VP_TRANXDONE_TIMEOUT) { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 130 | vp->common->ops->clear_txdone(vp->id); |
| 131 | if (!vp->common->ops->check_txdone(vp->id)) |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 132 | break; |
| 133 | udelay(1); |
| 134 | } |
| 135 | if (timeout >= VP_TRANXDONE_TIMEOUT) { |
| 136 | pr_warning("%s: vdd_%s TRANXDONE timeout exceeded." |
| 137 | "Voltage change aborted", __func__, voltdm->name); |
| 138 | return -ETIMEDOUT; |
| 139 | } |
| 140 | |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 141 | vpconfig = _vp_set_init_voltage(voltdm, target_volt); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 142 | |
| 143 | /* Force update of voltage */ |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 144 | voltdm->write(vpconfig | vp->common->vpconfig_forceupdate, |
| 145 | voltdm->vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 146 | |
| 147 | /* |
| 148 | * Wait for TransactionDone. Typical latency is <200us. |
| 149 | * Depends on SMPSWAITTIMEMIN/MAX and voltage change |
| 150 | */ |
| 151 | timeout = 0; |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 152 | omap_test_timeout(vp->common->ops->check_txdone(vp->id), |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 153 | VP_TRANXDONE_TIMEOUT, timeout); |
| 154 | if (timeout >= VP_TRANXDONE_TIMEOUT) |
| 155 | pr_err("%s: vdd_%s TRANXDONE timeout exceeded." |
| 156 | "TRANXDONE never got set after the voltage update\n", |
| 157 | __func__, voltdm->name); |
| 158 | |
| 159 | omap_vc_post_scale(voltdm, target_volt, target_vsel, current_vsel); |
| 160 | |
| 161 | /* |
| 162 | * Disable TransactionDone interrupt , clear all status, clear |
| 163 | * control registers |
| 164 | */ |
| 165 | timeout = 0; |
| 166 | while (timeout++ < VP_TRANXDONE_TIMEOUT) { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 167 | vp->common->ops->clear_txdone(vp->id); |
| 168 | if (!vp->common->ops->check_txdone(vp->id)) |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 169 | break; |
| 170 | udelay(1); |
| 171 | } |
| 172 | |
| 173 | if (timeout >= VP_TRANXDONE_TIMEOUT) |
| 174 | pr_warning("%s: vdd_%s TRANXDONE timeout exceeded while trying" |
| 175 | "to clear the TRANXDONE status\n", |
| 176 | __func__, voltdm->name); |
| 177 | |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 178 | /* Clear force bit */ |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 179 | voltdm->write(vpconfig, vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 180 | |
| 181 | return 0; |
| 182 | } |
| 183 | |
| 184 | /** |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 185 | * omap_vp_enable() - API to enable a particular VP |
| 186 | * @voltdm: pointer to the VDD whose VP is to be enabled. |
| 187 | * |
| 188 | * This API enables a particular voltage processor. Needed by the smartreflex |
| 189 | * class drivers. |
| 190 | */ |
| 191 | void omap_vp_enable(struct voltagedomain *voltdm) |
| 192 | { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 193 | struct omap_vp_instance *vp; |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 194 | u32 vpconfig, volt; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 195 | |
| 196 | if (!voltdm || IS_ERR(voltdm)) { |
| 197 | pr_warning("%s: VDD specified does not exist!\n", __func__); |
| 198 | return; |
| 199 | } |
| 200 | |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 201 | vp = voltdm->vp; |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 202 | if (!voltdm->read || !voltdm->write) { |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 203 | pr_err("%s: No read/write API for accessing vdd_%s regs\n", |
| 204 | __func__, voltdm->name); |
| 205 | return; |
| 206 | } |
| 207 | |
| 208 | /* If VP is already enabled, do nothing. Return */ |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 209 | if (vp->enabled) |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 210 | return; |
| 211 | |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 212 | volt = voltdm_get_voltage(voltdm); |
| 213 | if (!volt) { |
| 214 | pr_warning("%s: unable to find current voltage for %s\n", |
| 215 | __func__, voltdm->name); |
| 216 | return; |
| 217 | } |
| 218 | |
| 219 | vpconfig = _vp_set_init_voltage(voltdm, volt); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 220 | |
| 221 | /* Enable VP */ |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 222 | vpconfig |= vp->common->vpconfig_vpenable; |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 223 | voltdm->write(vpconfig, vp->vpconfig); |
Kevin Hilman | b666b47 | 2011-07-15 17:05:48 -0700 | [diff] [blame] | 224 | |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 225 | vp->enabled = true; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 226 | } |
| 227 | |
| 228 | /** |
| 229 | * omap_vp_disable() - API to disable a particular VP |
| 230 | * @voltdm: pointer to the VDD whose VP is to be disabled. |
| 231 | * |
| 232 | * This API disables a particular voltage processor. Needed by the smartreflex |
| 233 | * class drivers. |
| 234 | */ |
| 235 | void omap_vp_disable(struct voltagedomain *voltdm) |
| 236 | { |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 237 | struct omap_vp_instance *vp; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 238 | u32 vpconfig; |
| 239 | int timeout; |
| 240 | |
| 241 | if (!voltdm || IS_ERR(voltdm)) { |
| 242 | pr_warning("%s: VDD specified does not exist!\n", __func__); |
| 243 | return; |
| 244 | } |
| 245 | |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 246 | vp = voltdm->vp; |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 247 | if (!voltdm->read || !voltdm->write) { |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 248 | pr_err("%s: No read/write API for accessing vdd_%s regs\n", |
| 249 | __func__, voltdm->name); |
| 250 | return; |
| 251 | } |
| 252 | |
| 253 | /* If VP is already disabled, do nothing. Return */ |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 254 | if (!vp->enabled) { |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 255 | pr_warning("%s: Trying to disable VP for vdd_%s when" |
| 256 | "it is already disabled\n", __func__, voltdm->name); |
| 257 | return; |
| 258 | } |
| 259 | |
| 260 | /* Disable VP */ |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 261 | vpconfig = voltdm->read(vp->vpconfig); |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 262 | vpconfig &= ~vp->common->vpconfig_vpenable; |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 263 | voltdm->write(vpconfig, vp->vpconfig); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 264 | |
| 265 | /* |
| 266 | * Wait for VP idle Typical latency is <2us. Maximum latency is ~100us |
| 267 | */ |
Kevin Hilman | 4bcc475 | 2011-03-28 10:40:15 -0700 | [diff] [blame] | 268 | omap_test_timeout((voltdm->read(vp->vstatus)), |
| 269 | VP_IDLE_TIMEOUT, timeout); |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 270 | |
| 271 | if (timeout >= VP_IDLE_TIMEOUT) |
| 272 | pr_warning("%s: vdd_%s idle timedout\n", |
| 273 | __func__, voltdm->name); |
| 274 | |
Kevin Hilman | b7ea803 | 2011-04-04 15:25:07 -0700 | [diff] [blame] | 275 | vp->enabled = false; |
Kevin Hilman | 01f48d3 | 2011-03-21 14:29:13 -0700 | [diff] [blame] | 276 | |
| 277 | return; |
| 278 | } |