This source file includes following definitions.
- set_tdm_framer
- set_si_param
- ucc_of_parse_tdm
- ucc_tdm_init
1
2
3
4
5
6
7
8
9
10 #include <linux/io.h>
11 #include <linux/kernel.h>
12 #include <linux/of_address.h>
13 #include <linux/of_irq.h>
14 #include <linux/of_platform.h>
15 #include <soc/fsl/qe/qe_tdm.h>
16
17 static int set_tdm_framer(const char *tdm_framer_type)
18 {
19 if (strcmp(tdm_framer_type, "e1") == 0)
20 return TDM_FRAMER_E1;
21 else if (strcmp(tdm_framer_type, "t1") == 0)
22 return TDM_FRAMER_T1;
23 else
24 return -EINVAL;
25 }
26
27 static void set_si_param(struct ucc_tdm *utdm, struct ucc_tdm_info *ut_info)
28 {
29 struct si_mode_info *si_info = &ut_info->si_info;
30
31 if (utdm->tdm_mode == TDM_INTERNAL_LOOPBACK) {
32 si_info->simr_crt = 1;
33 si_info->simr_rfsd = 0;
34 }
35 }
36
37 int ucc_of_parse_tdm(struct device_node *np, struct ucc_tdm *utdm,
38 struct ucc_tdm_info *ut_info)
39 {
40 const char *sprop;
41 int ret = 0;
42 u32 val;
43
44 sprop = of_get_property(np, "fsl,rx-sync-clock", NULL);
45 if (sprop) {
46 ut_info->uf_info.rx_sync = qe_clock_source(sprop);
47 if ((ut_info->uf_info.rx_sync < QE_CLK_NONE) ||
48 (ut_info->uf_info.rx_sync > QE_RSYNC_PIN)) {
49 pr_err("QE-TDM: Invalid rx-sync-clock property\n");
50 return -EINVAL;
51 }
52 } else {
53 pr_err("QE-TDM: Invalid rx-sync-clock property\n");
54 return -EINVAL;
55 }
56
57 sprop = of_get_property(np, "fsl,tx-sync-clock", NULL);
58 if (sprop) {
59 ut_info->uf_info.tx_sync = qe_clock_source(sprop);
60 if ((ut_info->uf_info.tx_sync < QE_CLK_NONE) ||
61 (ut_info->uf_info.tx_sync > QE_TSYNC_PIN)) {
62 pr_err("QE-TDM: Invalid tx-sync-clock property\n");
63 return -EINVAL;
64 }
65 } else {
66 pr_err("QE-TDM: Invalid tx-sync-clock property\n");
67 return -EINVAL;
68 }
69
70 ret = of_property_read_u32_index(np, "fsl,tx-timeslot-mask", 0, &val);
71 if (ret) {
72 pr_err("QE-TDM: Invalid tx-timeslot-mask property\n");
73 return -EINVAL;
74 }
75 utdm->tx_ts_mask = val;
76
77 ret = of_property_read_u32_index(np, "fsl,rx-timeslot-mask", 0, &val);
78 if (ret) {
79 ret = -EINVAL;
80 pr_err("QE-TDM: Invalid rx-timeslot-mask property\n");
81 return ret;
82 }
83 utdm->rx_ts_mask = val;
84
85 ret = of_property_read_u32_index(np, "fsl,tdm-id", 0, &val);
86 if (ret) {
87 ret = -EINVAL;
88 pr_err("QE-TDM: No fsl,tdm-id property for this UCC\n");
89 return ret;
90 }
91 utdm->tdm_port = val;
92 ut_info->uf_info.tdm_num = utdm->tdm_port;
93
94 if (of_property_read_bool(np, "fsl,tdm-internal-loopback"))
95 utdm->tdm_mode = TDM_INTERNAL_LOOPBACK;
96 else
97 utdm->tdm_mode = TDM_NORMAL;
98
99 sprop = of_get_property(np, "fsl,tdm-framer-type", NULL);
100 if (!sprop) {
101 ret = -EINVAL;
102 pr_err("QE-TDM: No tdm-framer-type property for UCC\n");
103 return ret;
104 }
105 ret = set_tdm_framer(sprop);
106 if (ret < 0)
107 return -EINVAL;
108 utdm->tdm_framer_type = ret;
109
110 ret = of_property_read_u32_index(np, "fsl,siram-entry-id", 0, &val);
111 if (ret) {
112 ret = -EINVAL;
113 pr_err("QE-TDM: No siram entry id for UCC\n");
114 return ret;
115 }
116 utdm->siram_entry_id = val;
117
118 set_si_param(utdm, ut_info);
119 return ret;
120 }
121 EXPORT_SYMBOL(ucc_of_parse_tdm);
122
123 void ucc_tdm_init(struct ucc_tdm *utdm, struct ucc_tdm_info *ut_info)
124 {
125 struct si1 __iomem *si_regs;
126 u16 __iomem *siram;
127 u16 siram_entry_valid;
128 u16 siram_entry_closed;
129 u16 ucc_num;
130 u8 csel;
131 u16 sixmr;
132 u16 tdm_port;
133 u32 siram_entry_id;
134 u32 mask;
135 int i;
136
137 si_regs = utdm->si_regs;
138 siram = utdm->siram;
139 ucc_num = ut_info->uf_info.ucc_num;
140 tdm_port = utdm->tdm_port;
141 siram_entry_id = utdm->siram_entry_id;
142
143 if (utdm->tdm_framer_type == TDM_FRAMER_T1)
144 utdm->num_of_ts = 24;
145 if (utdm->tdm_framer_type == TDM_FRAMER_E1)
146 utdm->num_of_ts = 32;
147
148
149 csel = (ucc_num < 4) ? ucc_num + 9 : ucc_num - 3;
150
151 siram_entry_valid = SIR_CSEL(csel) | SIR_BYTE | SIR_CNT(0);
152 siram_entry_closed = SIR_IDLE | SIR_BYTE | SIR_CNT(0);
153
154 for (i = 0; i < utdm->num_of_ts; i++) {
155 mask = 0x01 << i;
156
157 if (utdm->tx_ts_mask & mask)
158 iowrite16be(siram_entry_valid,
159 &siram[siram_entry_id * 32 + i]);
160 else
161 iowrite16be(siram_entry_closed,
162 &siram[siram_entry_id * 32 + i]);
163
164 if (utdm->rx_ts_mask & mask)
165 iowrite16be(siram_entry_valid,
166 &siram[siram_entry_id * 32 + 0x200 + i]);
167 else
168 iowrite16be(siram_entry_closed,
169 &siram[siram_entry_id * 32 + 0x200 + i]);
170 }
171
172 setbits16(&siram[(siram_entry_id * 32) + (utdm->num_of_ts - 1)],
173 SIR_LAST);
174 setbits16(&siram[(siram_entry_id * 32) + 0x200 + (utdm->num_of_ts - 1)],
175 SIR_LAST);
176
177
178 sixmr = SIMR_SAD(siram_entry_id);
179
180 sixmr &= ~SIMR_SDM_MASK;
181
182 if (utdm->tdm_mode == TDM_INTERNAL_LOOPBACK)
183 sixmr |= SIMR_SDM_INTERNAL_LOOPBACK;
184 else
185 sixmr |= SIMR_SDM_NORMAL;
186
187 sixmr |= SIMR_RFSD(ut_info->si_info.simr_rfsd) |
188 SIMR_TFSD(ut_info->si_info.simr_tfsd);
189
190 if (ut_info->si_info.simr_crt)
191 sixmr |= SIMR_CRT;
192 if (ut_info->si_info.simr_sl)
193 sixmr |= SIMR_SL;
194 if (ut_info->si_info.simr_ce)
195 sixmr |= SIMR_CE;
196 if (ut_info->si_info.simr_fe)
197 sixmr |= SIMR_FE;
198 if (ut_info->si_info.simr_gm)
199 sixmr |= SIMR_GM;
200
201 switch (tdm_port) {
202 case 0:
203 iowrite16be(sixmr, &si_regs->sixmr1[0]);
204 break;
205 case 1:
206 iowrite16be(sixmr, &si_regs->sixmr1[1]);
207 break;
208 case 2:
209 iowrite16be(sixmr, &si_regs->sixmr1[2]);
210 break;
211 case 3:
212 iowrite16be(sixmr, &si_regs->sixmr1[3]);
213 break;
214 default:
215 pr_err("QE-TDM: can not find tdm sixmr reg\n");
216 break;
217 }
218 }
219 EXPORT_SYMBOL(ucc_tdm_init);