1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <common.h>
25#include <asm/cpm_85xx.h>
26
27DECLARE_GLOBAL_DATA_PTR;
28
29
30
31
32
33#undef CPM_DATAONLY_SIZE
34#define CPM_DATAONLY_SIZE ((uint)(8 * 1024) - CPM_DATAONLY_BASE)
35
36void
37m8560_cpm_reset(void)
38{
39 volatile ccsr_cpm_t *cpm = (ccsr_cpm_t *)CONFIG_SYS_MPC85xx_CPM_ADDR;
40 volatile ulong count;
41
42 gd = (gd_t *) (CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_GBL_DATA_OFFSET);
43
44
45
46 gd->dp_alloc_base = CPM_DATAONLY_BASE;
47 gd->dp_alloc_top = gd->dp_alloc_base + CPM_DATAONLY_SIZE;
48
49
50
51
52 cpm->im_cpm_cp.cpcr = CPM_CR_RST;
53 count = 0;
54 do {
55 __asm__ __volatile__ ("eieio");
56 } while ((cpm->im_cpm_cp.cpcr & CPM_CR_FLG) && ++count < 1000000);
57}
58
59
60
61
62
63uint
64m8560_cpm_dpalloc(uint size, uint align)
65{
66 volatile ccsr_cpm_t *cpm = (ccsr_cpm_t *)CONFIG_SYS_MPC85xx_CPM_ADDR;
67 uint retloc;
68 uint align_mask, off;
69 uint savebase;
70
71 align_mask = align - 1;
72 savebase = gd->dp_alloc_base;
73
74 if ((off = (gd->dp_alloc_base & align_mask)) != 0)
75 gd->dp_alloc_base += (align - off);
76
77 if ((off = size & align_mask) != 0)
78 size += align - off;
79
80 if ((gd->dp_alloc_base + size) >= gd->dp_alloc_top) {
81 gd->dp_alloc_base = savebase;
82 panic("m8560_cpm_dpalloc: ran out of dual port ram!");
83 }
84
85 retloc = gd->dp_alloc_base;
86 gd->dp_alloc_base += size;
87
88 memset((void *)&(cpm->im_dprambase[retloc]), 0, size);
89
90 return(retloc);
91}
92
93
94
95
96uint
97m8560_cpm_hostalloc(uint size, uint align)
98{
99
100 return (m8560_cpm_dpalloc(size, align));
101}
102
103
104
105
106
107
108
109
110
111
112
113#define BRG_INT_CLK gd->brg_clk
114#define BRG_UART_CLK ((BRG_INT_CLK + 15) / 16)
115
116
117
118
119void
120m8560_cpm_setbrg(uint brg, uint rate)
121{
122 volatile ccsr_cpm_t *cpm = (ccsr_cpm_t *)CONFIG_SYS_MPC85xx_CPM_ADDR;
123 volatile uint *bp;
124
125
126
127 if (brg < 4) {
128 bp = (uint *)&(cpm->im_cpm_brg1.brgc1);
129 }
130 else {
131 bp = (uint *)&(cpm->im_cpm_brg2.brgc5);
132 brg -= 4;
133 }
134 bp += brg;
135 *bp = (((((BRG_UART_CLK+rate-1)/rate)-1)&0xfff)<<1)|CPM_BRG_EN;
136}
137
138
139
140
141void
142m8560_cpm_fastbrg(uint brg, uint rate, int div16)
143{
144 volatile ccsr_cpm_t *cpm = (ccsr_cpm_t *)CONFIG_SYS_MPC85xx_CPM_ADDR;
145 volatile uint *bp;
146
147
148
149 if (brg < 4) {
150 bp = (uint *)&(cpm->im_cpm_brg1.brgc1);
151 }
152 else {
153 bp = (uint *)&(cpm->im_cpm_brg2.brgc5);
154 brg -= 4;
155 }
156 bp += brg;
157 *bp = (((((BRG_INT_CLK+rate-1)/rate)-1)&0xfff)<<1)|CPM_BRG_EN;
158 if (div16)
159 *bp |= CPM_BRG_DIV16;
160}
161
162
163
164
165
166void
167m8560_cpm_extcbrg(uint brg, uint rate, uint extclk, int pinsel)
168{
169 volatile ccsr_cpm_t *cpm = (ccsr_cpm_t *)CONFIG_SYS_MPC85xx_CPM_ADDR;
170 volatile uint *bp;
171
172 if (brg < 4) {
173 bp = (uint *)&(cpm->im_cpm_brg1.brgc1);
174 }
175 else {
176 bp = (uint *)&(cpm->im_cpm_brg2.brgc5);
177 brg -= 4;
178 }
179 bp += brg;
180 *bp = ((((((extclk/16)+rate-1)/rate)-1)&0xfff)<<1)|CPM_BRG_EN;
181 if (pinsel == 0)
182 *bp |= CPM_BRG_EXTC_CLK3_9;
183 else
184 *bp |= CPM_BRG_EXTC_CLK5_15;
185}
186