1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#undef DEBUG
16
17#include <linux/module.h>
18#include <linux/kernel.h>
19#include <linux/device.h>
20#include <linux/list.h>
21#include <linux/errno.h>
22#include <linux/delay.h>
23#include <linux/clk.h>
24#include <linux/io.h>
25
26#include "common.h"
27#include "clock.h"
28#include "sdrc.h"
29
30static struct omap_sdrc_params *sdrc_init_params_cs0, *sdrc_init_params_cs1;
31
32void __iomem *omap2_sdrc_base;
33void __iomem *omap2_sms_base;
34
35struct omap2_sms_regs {
36 u32 sms_sysconfig;
37};
38
39static struct omap2_sms_regs sms_context;
40
41
42#define SDRC_POWER_EXTCLKDIS_SHIFT 3
43#define SDRC_POWER_PWDENA_SHIFT 2
44#define SDRC_POWER_PAGEPOLICY_SHIFT 0
45
46
47
48
49
50
51void omap2_sms_save_context(void)
52{
53 sms_context.sms_sysconfig = sms_read_reg(SMS_SYSCONFIG);
54}
55
56
57
58
59
60
61void omap2_sms_restore_context(void)
62{
63 sms_write_reg(sms_context.sms_sysconfig, SMS_SYSCONFIG);
64}
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88int omap2_sdrc_get_params(unsigned long r,
89 struct omap_sdrc_params **sdrc_cs0,
90 struct omap_sdrc_params **sdrc_cs1)
91{
92 struct omap_sdrc_params *sp0, *sp1;
93
94 if (!sdrc_init_params_cs0)
95 return -1;
96
97 sp0 = sdrc_init_params_cs0;
98 sp1 = sdrc_init_params_cs1;
99
100 while (sp0->rate && sp0->rate != r) {
101 sp0++;
102 if (sdrc_init_params_cs1)
103 sp1++;
104 }
105
106 if (!sp0->rate)
107 return -1;
108
109 *sdrc_cs0 = sp0;
110 *sdrc_cs1 = sp1;
111 return 0;
112}
113
114
115void __init omap2_set_globals_sdrc(void __iomem *sdrc, void __iomem *sms)
116{
117 omap2_sdrc_base = sdrc;
118 omap2_sms_base = sms;
119}
120
121
122
123
124
125
126
127
128
129
130void __init omap2_sdrc_init(struct omap_sdrc_params *sdrc_cs0,
131 struct omap_sdrc_params *sdrc_cs1)
132{
133 u32 l;
134
135 l = sms_read_reg(SMS_SYSCONFIG);
136 l &= ~(0x3 << 3);
137 l |= (0x2 << 3);
138 sms_write_reg(l, SMS_SYSCONFIG);
139
140 l = sdrc_read_reg(SDRC_SYSCONFIG);
141 l &= ~(0x3 << 3);
142 l |= (0x2 << 3);
143 sdrc_write_reg(l, SDRC_SYSCONFIG);
144
145 sdrc_init_params_cs0 = sdrc_cs0;
146 sdrc_init_params_cs1 = sdrc_cs1;
147
148
149
150
151
152
153 l = (1 << SDRC_POWER_EXTCLKDIS_SHIFT) |
154 (1 << SDRC_POWER_PAGEPOLICY_SHIFT);
155 sdrc_write_reg(l, SDRC_POWER);
156 omap2_sms_save_context();
157}
158