aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/usb/musb/musb_core.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/usb/musb/musb_core.c')
-rw-r--r--drivers/usb/musb/musb_core.c146
1 files changed, 146 insertions, 0 deletions
diff --git a/drivers/usb/musb/musb_core.c b/drivers/usb/musb/musb_core.c
index 074d380bf88..2c53da77131 100644
--- a/drivers/usb/musb/musb_core.c
+++ b/drivers/usb/musb/musb_core.c
@@ -2167,6 +2167,148 @@ static int __exit musb_remove(struct platform_device *pdev)
2167 2167
2168#ifdef CONFIG_PM 2168#ifdef CONFIG_PM
2169 2169
2170static struct musb_context_registers musb_context;
2171
2172void musb_save_context(struct musb *musb)
2173{
2174 int i;
2175 void __iomem *musb_base = musb->mregs;
2176
2177 if (is_host_enabled(musb)) {
2178 musb_context.frame = musb_readw(musb_base, MUSB_FRAME);
2179 musb_context.testmode = musb_readb(musb_base, MUSB_TESTMODE);
2180 }
2181 musb_context.power = musb_readb(musb_base, MUSB_POWER);
2182 musb_context.intrtxe = musb_readw(musb_base, MUSB_INTRTXE);
2183 musb_context.intrrxe = musb_readw(musb_base, MUSB_INTRRXE);
2184 musb_context.intrusbe = musb_readb(musb_base, MUSB_INTRUSBE);
2185 musb_context.index = musb_readb(musb_base, MUSB_INDEX);
2186 musb_context.devctl = musb_readb(musb_base, MUSB_DEVCTL);
2187
2188 for (i = 0; i < MUSB_C_NUM_EPS; ++i) {
2189 musb_writeb(musb_base, MUSB_INDEX, i);
2190 musb_context.index_regs[i].txmaxp =
2191 musb_readw(musb_base, 0x10 + MUSB_TXMAXP);
2192 musb_context.index_regs[i].txcsr =
2193 musb_readw(musb_base, 0x10 + MUSB_TXCSR);
2194 musb_context.index_regs[i].rxmaxp =
2195 musb_readw(musb_base, 0x10 + MUSB_RXMAXP);
2196 musb_context.index_regs[i].rxcsr =
2197 musb_readw(musb_base, 0x10 + MUSB_RXCSR);
2198
2199 if (musb->dyn_fifo) {
2200 musb_context.index_regs[i].txfifoadd =
2201 musb_read_txfifoadd(musb_base);
2202 musb_context.index_regs[i].rxfifoadd =
2203 musb_read_rxfifoadd(musb_base);
2204 musb_context.index_regs[i].txfifosz =
2205 musb_read_txfifosz(musb_base);
2206 musb_context.index_regs[i].rxfifosz =
2207 musb_read_rxfifosz(musb_base);
2208 }
2209 if (is_host_enabled(musb)) {
2210 musb_context.index_regs[i].txtype =
2211 musb_readb(musb_base, 0x10 + MUSB_TXTYPE);
2212 musb_context.index_regs[i].txinterval =
2213 musb_readb(musb_base, 0x10 + MUSB_TXINTERVAL);
2214 musb_context.index_regs[i].rxtype =
2215 musb_readb(musb_base, 0x10 + MUSB_RXTYPE);
2216 musb_context.index_regs[i].rxinterval =
2217 musb_readb(musb_base, 0x10 + MUSB_RXINTERVAL);
2218
2219 musb_context.index_regs[i].txfunaddr =
2220 musb_read_txfunaddr(musb_base, i);
2221 musb_context.index_regs[i].txhubaddr =
2222 musb_read_txhubaddr(musb_base, i);
2223 musb_context.index_regs[i].txhubport =
2224 musb_read_txhubport(musb_base, i);
2225
2226 musb_context.index_regs[i].rxfunaddr =
2227 musb_read_rxfunaddr(musb_base, i);
2228 musb_context.index_regs[i].rxhubaddr =
2229 musb_read_rxhubaddr(musb_base, i);
2230 musb_context.index_regs[i].rxhubport =
2231 musb_read_rxhubport(musb_base, i);
2232 }
2233 }
2234
2235 musb_writeb(musb_base, MUSB_INDEX, musb_context.index);
2236
2237 musb_platform_save_context(&musb_context);
2238}
2239
2240void musb_restore_context(struct musb *musb)
2241{
2242 int i;
2243 void __iomem *musb_base = musb->mregs;
2244 void __iomem *ep_target_regs;
2245
2246 musb_platform_restore_context(&musb_context);
2247
2248 if (is_host_enabled(musb)) {
2249 musb_writew(musb_base, MUSB_FRAME, musb_context.frame);
2250 musb_writeb(musb_base, MUSB_TESTMODE, musb_context.testmode);
2251 }
2252 musb_writeb(musb_base, MUSB_POWER, musb_context.power);
2253 musb_writew(musb_base, MUSB_INTRTXE, musb_context.intrtxe);
2254 musb_writew(musb_base, MUSB_INTRRXE, musb_context.intrrxe);
2255 musb_writeb(musb_base, MUSB_INTRUSBE, musb_context.intrusbe);
2256 musb_writeb(musb_base, MUSB_DEVCTL, musb_context.devctl);
2257
2258 for (i = 0; i < MUSB_C_NUM_EPS; ++i) {
2259 musb_writeb(musb_base, MUSB_INDEX, i);
2260 musb_writew(musb_base, 0x10 + MUSB_TXMAXP,
2261 musb_context.index_regs[i].txmaxp);
2262 musb_writew(musb_base, 0x10 + MUSB_TXCSR,
2263 musb_context.index_regs[i].txcsr);
2264 musb_writew(musb_base, 0x10 + MUSB_RXMAXP,
2265 musb_context.index_regs[i].rxmaxp);
2266 musb_writew(musb_base, 0x10 + MUSB_RXCSR,
2267 musb_context.index_regs[i].rxcsr);
2268
2269 if (musb->dyn_fifo) {
2270 musb_write_txfifosz(musb_base,
2271 musb_context.index_regs[i].txfifosz);
2272 musb_write_rxfifosz(musb_base,
2273 musb_context.index_regs[i].rxfifosz);
2274 musb_write_txfifoadd(musb_base,
2275 musb_context.index_regs[i].txfifoadd);
2276 musb_write_rxfifoadd(musb_base,
2277 musb_context.index_regs[i].rxfifoadd);
2278 }
2279
2280 if (is_host_enabled(musb)) {
2281 musb_writeb(musb_base, 0x10 + MUSB_TXTYPE,
2282 musb_context.index_regs[i].txtype);
2283 musb_writeb(musb_base, 0x10 + MUSB_TXINTERVAL,
2284 musb_context.index_regs[i].txinterval);
2285 musb_writeb(musb_base, 0x10 + MUSB_RXTYPE,
2286 musb_context.index_regs[i].rxtype);
2287 musb_writeb(musb_base, 0x10 + MUSB_RXINTERVAL,
2288
2289 musb_context.index_regs[i].rxinterval);
2290 musb_write_txfunaddr(musb_base, i,
2291 musb_context.index_regs[i].txfunaddr);
2292 musb_write_txhubaddr(musb_base, i,
2293 musb_context.index_regs[i].txhubaddr);
2294 musb_write_txhubport(musb_base, i,
2295 musb_context.index_regs[i].txhubport);
2296
2297 ep_target_regs =
2298 musb_read_target_reg_base(i, musb_base);
2299
2300 musb_write_rxfunaddr(ep_target_regs,
2301 musb_context.index_regs[i].rxfunaddr);
2302 musb_write_rxhubaddr(ep_target_regs,
2303 musb_context.index_regs[i].rxhubaddr);
2304 musb_write_rxhubport(ep_target_regs,
2305 musb_context.index_regs[i].rxhubport);
2306 }
2307 }
2308
2309 musb_writeb(musb_base, MUSB_INDEX, musb_context.index);
2310}
2311
2170static int musb_suspend(struct device *dev) 2312static int musb_suspend(struct device *dev)
2171{ 2313{
2172 struct platform_device *pdev = to_platform_device(dev); 2314 struct platform_device *pdev = to_platform_device(dev);
@@ -2188,6 +2330,8 @@ static int musb_suspend(struct device *dev)
2188 */ 2330 */
2189 } 2331 }
2190 2332
2333 musb_save_context(musb);
2334
2191 if (musb->set_clock) 2335 if (musb->set_clock)
2192 musb->set_clock(musb->clock, 0); 2336 musb->set_clock(musb->clock, 0);
2193 else 2337 else
@@ -2209,6 +2353,8 @@ static int musb_resume_noirq(struct device *dev)
2209 else 2353 else
2210 clk_enable(musb->clock); 2354 clk_enable(musb->clock);
2211 2355
2356 musb_restore_context(musb);
2357
2212 /* for static cmos like DaVinci, register values were preserved 2358 /* for static cmos like DaVinci, register values were preserved
2213 * unless for some reason the whole soc powered down or the USB 2359 * unless for some reason the whole soc powered down or the USB
2214 * module got reset through the PSC (vs just being disabled). 2360 * module got reset through the PSC (vs just being disabled).
generated by cgit v1.2.2 (git 2.25.0) at 2024-10-19 15:31:43 -0400