0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011 #include <linux/kernel.h>
0012 #include <linux/errno.h>
0013 #include <linux/err.h>
0014 #include <linux/io.h>
0015
0016 #include "powerdomain.h"
0017 #include "prm2xxx_3xxx.h"
0018 #include "prm-regbits-24xx.h"
0019 #include "clockdomain.h"
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033 int omap2_prm_is_hardreset_asserted(u8 shift, u8 part, s16 prm_mod, u16 offset)
0034 {
0035 return omap2_prm_read_mod_bits_shift(prm_mod, OMAP2_RM_RSTCTRL,
0036 (1 << shift));
0037 }
0038
0039
0040
0041
0042
0043
0044
0045
0046
0047
0048
0049
0050
0051
0052
0053 int omap2_prm_assert_hardreset(u8 shift, u8 part, s16 prm_mod, u16 offset)
0054 {
0055 u32 mask;
0056
0057 mask = 1 << shift;
0058 omap2_prm_rmw_mod_reg_bits(mask, mask, prm_mod, OMAP2_RM_RSTCTRL);
0059
0060 return 0;
0061 }
0062
0063
0064
0065
0066
0067
0068
0069
0070
0071
0072
0073
0074
0075
0076
0077
0078
0079
0080
0081
0082 int omap2_prm_deassert_hardreset(u8 rst_shift, u8 st_shift, u8 part,
0083 s16 prm_mod, u16 rst_offset, u16 st_offset)
0084 {
0085 u32 rst, st;
0086 int c;
0087
0088 rst = 1 << rst_shift;
0089 st = 1 << st_shift;
0090
0091
0092 if (omap2_prm_read_mod_bits_shift(prm_mod, OMAP2_RM_RSTCTRL, rst) == 0)
0093 return -EEXIST;
0094
0095
0096 omap2_prm_rmw_mod_reg_bits(0xffffffff, st, prm_mod, OMAP2_RM_RSTST);
0097
0098 omap2_prm_rmw_mod_reg_bits(rst, 0, prm_mod, OMAP2_RM_RSTCTRL);
0099
0100 omap_test_timeout(omap2_prm_read_mod_bits_shift(prm_mod, OMAP2_RM_RSTST,
0101 st),
0102 MAX_MODULE_HARDRESET_WAIT, c);
0103
0104 return (c == MAX_MODULE_HARDRESET_WAIT) ? -EBUSY : 0;
0105 }
0106
0107
0108
0109
0110
0111 int omap2_pwrdm_set_mem_onst(struct powerdomain *pwrdm, u8 bank,
0112 u8 pwrst)
0113 {
0114 u32 m;
0115
0116 m = omap2_pwrdm_get_mem_bank_onstate_mask(bank);
0117
0118 omap2_prm_rmw_mod_reg_bits(m, (pwrst << __ffs(m)), pwrdm->prcm_offs,
0119 OMAP2_PM_PWSTCTRL);
0120
0121 return 0;
0122 }
0123
0124 int omap2_pwrdm_set_mem_retst(struct powerdomain *pwrdm, u8 bank,
0125 u8 pwrst)
0126 {
0127 u32 m;
0128
0129 m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
0130
0131 omap2_prm_rmw_mod_reg_bits(m, (pwrst << __ffs(m)), pwrdm->prcm_offs,
0132 OMAP2_PM_PWSTCTRL);
0133
0134 return 0;
0135 }
0136
0137 int omap2_pwrdm_read_mem_pwrst(struct powerdomain *pwrdm, u8 bank)
0138 {
0139 u32 m;
0140
0141 m = omap2_pwrdm_get_mem_bank_stst_mask(bank);
0142
0143 return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs, OMAP2_PM_PWSTST,
0144 m);
0145 }
0146
0147 int omap2_pwrdm_read_mem_retst(struct powerdomain *pwrdm, u8 bank)
0148 {
0149 u32 m;
0150
0151 m = omap2_pwrdm_get_mem_bank_retst_mask(bank);
0152
0153 return omap2_prm_read_mod_bits_shift(pwrdm->prcm_offs,
0154 OMAP2_PM_PWSTCTRL, m);
0155 }
0156
0157 int omap2_pwrdm_set_logic_retst(struct powerdomain *pwrdm, u8 pwrst)
0158 {
0159 u32 v;
0160
0161 v = pwrst << __ffs(OMAP_LOGICRETSTATE_MASK);
0162 omap2_prm_rmw_mod_reg_bits(OMAP_LOGICRETSTATE_MASK, v, pwrdm->prcm_offs,
0163 OMAP2_PM_PWSTCTRL);
0164
0165 return 0;
0166 }
0167
0168 int omap2_pwrdm_wait_transition(struct powerdomain *pwrdm)
0169 {
0170 u32 c = 0;
0171
0172
0173
0174
0175
0176
0177
0178
0179 while ((omap2_prm_read_mod_reg(pwrdm->prcm_offs, OMAP2_PM_PWSTST) &
0180 OMAP_INTRANSITION_MASK) &&
0181 (c++ < PWRDM_TRANSITION_BAILOUT))
0182 udelay(1);
0183
0184 if (c > PWRDM_TRANSITION_BAILOUT) {
0185 pr_err("powerdomain: %s: waited too long to complete transition\n",
0186 pwrdm->name);
0187 return -EAGAIN;
0188 }
0189
0190 pr_debug("powerdomain: completed transition in %d loops\n", c);
0191
0192 return 0;
0193 }
0194
0195 int omap2_clkdm_add_wkdep(struct clockdomain *clkdm1,
0196 struct clockdomain *clkdm2)
0197 {
0198 omap2_prm_set_mod_reg_bits((1 << clkdm2->dep_bit),
0199 clkdm1->pwrdm.ptr->prcm_offs, PM_WKDEP);
0200 return 0;
0201 }
0202
0203 int omap2_clkdm_del_wkdep(struct clockdomain *clkdm1,
0204 struct clockdomain *clkdm2)
0205 {
0206 omap2_prm_clear_mod_reg_bits((1 << clkdm2->dep_bit),
0207 clkdm1->pwrdm.ptr->prcm_offs, PM_WKDEP);
0208 return 0;
0209 }
0210
0211 int omap2_clkdm_read_wkdep(struct clockdomain *clkdm1,
0212 struct clockdomain *clkdm2)
0213 {
0214 return omap2_prm_read_mod_bits_shift(clkdm1->pwrdm.ptr->prcm_offs,
0215 PM_WKDEP, (1 << clkdm2->dep_bit));
0216 }
0217
0218
0219 int omap2_clkdm_clear_all_wkdeps(struct clockdomain *clkdm)
0220 {
0221 struct clkdm_dep *cd;
0222 u32 mask = 0;
0223
0224 for (cd = clkdm->wkdep_srcs; cd && cd->clkdm_name; cd++) {
0225 if (!cd->clkdm)
0226 continue;
0227
0228
0229 mask |= 1 << cd->clkdm->dep_bit;
0230 cd->wkdep_usecount = 0;
0231 }
0232
0233 omap2_prm_clear_mod_reg_bits(mask, clkdm->pwrdm.ptr->prcm_offs,
0234 PM_WKDEP);
0235 return 0;
0236 }
0237