1
2
3
4
5
6
7
8
9#include <linux/module.h>
10#include <linux/spinlock.h>
11#include <asm/mach-au1x00/au1000.h>
12
13#define VSS_GATE 0x00
14#define VSS_CLKRST 0x04
15#define VSS_FTR 0x08
16
17#define VSS_ADDR(blk) (KSEG1ADDR(AU1300_VSS_PHYS_ADDR) + (blk * 0x0c))
18
19static DEFINE_SPINLOCK(au1300_vss_lock);
20
21
22static inline void __enable_block(int block)
23{
24 void __iomem *base = (void __iomem *)VSS_ADDR(block);
25
26 __raw_writel(3, base + VSS_CLKRST);
27 wmb();
28
29 __raw_writel(0x01fffffe, base + VSS_GATE);
30 wmb();
31
32
33 __raw_writel(0x01, base + VSS_FTR);
34 wmb();
35 __raw_writel(0x03, base + VSS_FTR);
36 wmb();
37 __raw_writel(0x07, base + VSS_FTR);
38 wmb();
39 __raw_writel(0x0f, base + VSS_FTR);
40 wmb();
41
42 __raw_writel(0x01ffffff, base + VSS_GATE);
43 wmb();
44
45 __raw_writel(2, base + VSS_CLKRST);
46 wmb();
47
48 __raw_writel(0x1f, base + VSS_FTR);
49 wmb();
50}
51
52
53static inline void __disable_block(int block)
54{
55 void __iomem *base = (void __iomem *)VSS_ADDR(block);
56
57 __raw_writel(0x0f, base + VSS_FTR);
58 wmb();
59 __raw_writel(0, base + VSS_GATE);
60 wmb();
61 __raw_writel(3, base + VSS_CLKRST);
62 wmb();
63 __raw_writel(1, base + VSS_CLKRST);
64 wmb();
65 __raw_writel(0, base + VSS_FTR);
66 wmb();
67}
68
69void au1300_vss_block_control(int block, int enable)
70{
71 unsigned long flags;
72
73 if (alchemy_get_cputype() != ALCHEMY_CPU_AU1300)
74 return;
75
76
77 spin_lock_irqsave(&au1300_vss_lock, flags);
78 if (enable)
79 __enable_block(block);
80 else
81 __disable_block(block);
82 spin_unlock_irqrestore(&au1300_vss_lock, flags);
83}
84EXPORT_SYMBOL_GPL(au1300_vss_block_control);
85