]>
Commit | Line | Data |
---|---|---|
1 | // SPDX-License-Identifier: GPL-2.0-only | |
2 | /* | |
3 | * FM Driver for Connectivity chip of Texas Instruments. | |
4 | * This sub-module of FM driver implements FM TX functionality. | |
5 | * | |
6 | * Copyright (C) 2011 Texas Instruments | |
7 | */ | |
8 | ||
9 | #include <linux/delay.h> | |
10 | #include "fmdrv.h" | |
11 | #include "fmdrv_common.h" | |
12 | #include "fmdrv_tx.h" | |
13 | ||
14 | int fm_tx_set_stereo_mono(struct fmdev *fmdev, u16 mode) | |
15 | { | |
16 | u16 payload; | |
17 | int ret; | |
18 | ||
19 | if (fmdev->tx_data.aud_mode == mode) | |
20 | return 0; | |
21 | ||
22 | fmdbg("stereo mode: %d\n", mode); | |
23 | ||
24 | /* Set Stereo/Mono mode */ | |
25 | payload = (1 - mode); | |
26 | ret = fmc_send_cmd(fmdev, MONO_SET, REG_WR, &payload, | |
27 | sizeof(payload), NULL, NULL); | |
28 | if (ret < 0) | |
29 | return ret; | |
30 | ||
31 | fmdev->tx_data.aud_mode = mode; | |
32 | ||
33 | return ret; | |
34 | } | |
35 | ||
36 | static int set_rds_text(struct fmdev *fmdev, u8 *rds_text) | |
37 | { | |
38 | u16 payload; | |
39 | int ret; | |
40 | ||
41 | ret = fmc_send_cmd(fmdev, RDS_DATA_SET, REG_WR, rds_text, | |
42 | strlen(rds_text), NULL, NULL); | |
43 | if (ret < 0) | |
44 | return ret; | |
45 | ||
46 | /* Scroll mode */ | |
47 | payload = (u16)0x1; | |
48 | ret = fmc_send_cmd(fmdev, DISPLAY_MODE, REG_WR, &payload, | |
49 | sizeof(payload), NULL, NULL); | |
50 | if (ret < 0) | |
51 | return ret; | |
52 | ||
53 | return 0; | |
54 | } | |
55 | ||
56 | static int set_rds_data_mode(struct fmdev *fmdev, u8 mode) | |
57 | { | |
58 | u16 payload; | |
59 | int ret; | |
60 | ||
61 | /* Setting unique PI TODO: how unique? */ | |
62 | payload = (u16)0xcafe; | |
63 | ret = fmc_send_cmd(fmdev, PI_SET, REG_WR, &payload, | |
64 | sizeof(payload), NULL, NULL); | |
65 | if (ret < 0) | |
66 | return ret; | |
67 | ||
68 | /* Set decoder id */ | |
69 | payload = (u16)0xa; | |
70 | ret = fmc_send_cmd(fmdev, DI_SET, REG_WR, &payload, | |
71 | sizeof(payload), NULL, NULL); | |
72 | if (ret < 0) | |
73 | return ret; | |
74 | ||
75 | /* TODO: RDS_MODE_GET? */ | |
76 | return 0; | |
77 | } | |
78 | ||
79 | static int set_rds_len(struct fmdev *fmdev, u8 type, u16 len) | |
80 | { | |
81 | u16 payload; | |
82 | int ret; | |
83 | ||
84 | len |= type << 8; | |
85 | payload = len; | |
86 | ret = fmc_send_cmd(fmdev, RDS_CONFIG_DATA_SET, REG_WR, &payload, | |
87 | sizeof(payload), NULL, NULL); | |
88 | if (ret < 0) | |
89 | return ret; | |
90 | ||
91 | /* TODO: LENGTH_GET? */ | |
92 | return 0; | |
93 | } | |
94 | ||
95 | int fm_tx_set_rds_mode(struct fmdev *fmdev, u8 rds_en_dis) | |
96 | { | |
97 | u16 payload; | |
98 | int ret; | |
99 | u8 rds_text[] = "Zoom2\n"; | |
100 | ||
101 | fmdbg("rds_en_dis:%d(E:%d, D:%d)\n", rds_en_dis, | |
102 | FM_RDS_ENABLE, FM_RDS_DISABLE); | |
103 | ||
104 | if (rds_en_dis == FM_RDS_ENABLE) { | |
105 | /* Set RDS length */ | |
106 | set_rds_len(fmdev, 0, strlen(rds_text)); | |
107 | ||
108 | /* Set RDS text */ | |
109 | set_rds_text(fmdev, rds_text); | |
110 | ||
111 | /* Set RDS mode */ | |
112 | set_rds_data_mode(fmdev, 0x0); | |
113 | } | |
114 | ||
115 | /* Send command to enable RDS */ | |
116 | if (rds_en_dis == FM_RDS_ENABLE) | |
117 | payload = 0x01; | |
118 | else | |
119 | payload = 0x00; | |
120 | ||
121 | ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload, | |
122 | sizeof(payload), NULL, NULL); | |
123 | if (ret < 0) | |
124 | return ret; | |
125 | ||
126 | if (rds_en_dis == FM_RDS_ENABLE) { | |
127 | /* Set RDS length */ | |
128 | set_rds_len(fmdev, 0, strlen(rds_text)); | |
129 | ||
130 | /* Set RDS text */ | |
131 | set_rds_text(fmdev, rds_text); | |
132 | } | |
133 | fmdev->tx_data.rds.flag = rds_en_dis; | |
134 | ||
135 | return 0; | |
136 | } | |
137 | ||
138 | int fm_tx_set_radio_text(struct fmdev *fmdev, u8 *rds_text, u8 rds_type) | |
139 | { | |
140 | u16 payload; | |
141 | int ret; | |
142 | ||
143 | if (fmdev->curr_fmmode != FM_MODE_TX) | |
144 | return -EPERM; | |
145 | ||
146 | fm_tx_set_rds_mode(fmdev, 0); | |
147 | ||
148 | /* Set RDS length */ | |
149 | set_rds_len(fmdev, rds_type, strlen(rds_text)); | |
150 | ||
151 | /* Set RDS text */ | |
152 | set_rds_text(fmdev, rds_text); | |
153 | ||
154 | /* Set RDS mode */ | |
155 | set_rds_data_mode(fmdev, 0x0); | |
156 | ||
157 | payload = 1; | |
158 | ret = fmc_send_cmd(fmdev, RDS_DATA_ENB, REG_WR, &payload, | |
159 | sizeof(payload), NULL, NULL); | |
160 | if (ret < 0) | |
161 | return ret; | |
162 | ||
163 | return 0; | |
164 | } | |
165 | ||
166 | int fm_tx_set_af(struct fmdev *fmdev, u32 af) | |
167 | { | |
168 | u16 payload; | |
169 | int ret; | |
170 | ||
171 | if (fmdev->curr_fmmode != FM_MODE_TX) | |
172 | return -EPERM; | |
173 | ||
174 | fmdbg("AF: %d\n", af); | |
175 | ||
176 | af = (af - 87500) / 100; | |
177 | payload = (u16)af; | |
178 | ret = fmc_send_cmd(fmdev, TA_SET, REG_WR, &payload, | |
179 | sizeof(payload), NULL, NULL); | |
180 | if (ret < 0) | |
181 | return ret; | |
182 | ||
183 | return 0; | |
184 | } | |
185 | ||
186 | int fm_tx_set_region(struct fmdev *fmdev, u8 region) | |
187 | { | |
188 | u16 payload; | |
189 | int ret; | |
190 | ||
191 | if (region != FM_BAND_EUROPE_US && region != FM_BAND_JAPAN) { | |
192 | fmerr("Invalid band\n"); | |
193 | return -EINVAL; | |
194 | } | |
195 | ||
196 | /* Send command to set the band */ | |
197 | payload = (u16)region; | |
198 | ret = fmc_send_cmd(fmdev, TX_BAND_SET, REG_WR, &payload, | |
199 | sizeof(payload), NULL, NULL); | |
200 | if (ret < 0) | |
201 | return ret; | |
202 | ||
203 | return 0; | |
204 | } | |
205 | ||
206 | int fm_tx_set_mute_mode(struct fmdev *fmdev, u8 mute_mode_toset) | |
207 | { | |
208 | u16 payload; | |
209 | int ret; | |
210 | ||
211 | fmdbg("tx: mute mode %d\n", mute_mode_toset); | |
212 | ||
213 | payload = mute_mode_toset; | |
214 | ret = fmc_send_cmd(fmdev, MUTE, REG_WR, &payload, | |
215 | sizeof(payload), NULL, NULL); | |
216 | if (ret < 0) | |
217 | return ret; | |
218 | ||
219 | return 0; | |
220 | } | |
221 | ||
222 | /* Set TX Audio I/O */ | |
223 | static int set_audio_io(struct fmdev *fmdev) | |
224 | { | |
225 | struct fmtx_data *tx = &fmdev->tx_data; | |
226 | u16 payload; | |
227 | int ret; | |
228 | ||
229 | /* Set Audio I/O Enable */ | |
230 | payload = tx->audio_io; | |
231 | ret = fmc_send_cmd(fmdev, AUDIO_IO_SET, REG_WR, &payload, | |
232 | sizeof(payload), NULL, NULL); | |
233 | if (ret < 0) | |
234 | return ret; | |
235 | ||
236 | /* TODO: is audio set? */ | |
237 | return 0; | |
238 | } | |
239 | ||
240 | /* Start TX Transmission */ | |
241 | static int enable_xmit(struct fmdev *fmdev, u8 new_xmit_state) | |
242 | { | |
243 | struct fmtx_data *tx = &fmdev->tx_data; | |
244 | unsigned long timeleft; | |
245 | u16 payload; | |
246 | int ret; | |
247 | ||
248 | /* Enable POWER_ENB interrupts */ | |
249 | payload = FM_POW_ENB_EVENT; | |
250 | ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload, | |
251 | sizeof(payload), NULL, NULL); | |
252 | if (ret < 0) | |
253 | return ret; | |
254 | ||
255 | /* Set Power Enable */ | |
256 | payload = new_xmit_state; | |
257 | ret = fmc_send_cmd(fmdev, POWER_ENB_SET, REG_WR, &payload, | |
258 | sizeof(payload), NULL, NULL); | |
259 | if (ret < 0) | |
260 | return ret; | |
261 | ||
262 | /* Wait for Power Enabled */ | |
263 | init_completion(&fmdev->maintask_comp); | |
264 | timeleft = wait_for_completion_timeout(&fmdev->maintask_comp, | |
265 | FM_DRV_TX_TIMEOUT); | |
266 | if (!timeleft) { | |
267 | fmerr("Timeout(%d sec),didn't get tune ended interrupt\n", | |
268 | jiffies_to_msecs(FM_DRV_TX_TIMEOUT) / 1000); | |
269 | return -ETIMEDOUT; | |
270 | } | |
271 | ||
272 | set_bit(FM_CORE_TX_XMITING, &fmdev->flag); | |
273 | tx->xmit_state = new_xmit_state; | |
274 | ||
275 | return 0; | |
276 | } | |
277 | ||
278 | /* Set TX power level */ | |
279 | int fm_tx_set_pwr_lvl(struct fmdev *fmdev, u8 new_pwr_lvl) | |
280 | { | |
281 | u16 payload; | |
282 | struct fmtx_data *tx = &fmdev->tx_data; | |
283 | int ret; | |
284 | ||
285 | if (fmdev->curr_fmmode != FM_MODE_TX) | |
286 | return -EPERM; | |
287 | fmdbg("tx: pwr_level_to_set %ld\n", (long int)new_pwr_lvl); | |
288 | ||
289 | /* If the core isn't ready update global variable */ | |
290 | if (!test_bit(FM_CORE_READY, &fmdev->flag)) { | |
291 | tx->pwr_lvl = new_pwr_lvl; | |
292 | return 0; | |
293 | } | |
294 | ||
295 | /* Set power level: Application will specify power level value in | |
296 | * units of dB/uV, whereas range and step are specific to FM chip. | |
297 | * For TI's WL chips, convert application specified power level value | |
298 | * to chip specific value by subtracting 122 from it. Refer to TI FM | |
299 | * data sheet for details. | |
300 | * */ | |
301 | ||
302 | payload = (FM_PWR_LVL_HIGH - new_pwr_lvl); | |
303 | ret = fmc_send_cmd(fmdev, POWER_LEV_SET, REG_WR, &payload, | |
304 | sizeof(payload), NULL, NULL); | |
305 | if (ret < 0) | |
306 | return ret; | |
307 | ||
308 | /* TODO: is the power level set? */ | |
309 | tx->pwr_lvl = new_pwr_lvl; | |
310 | ||
311 | return 0; | |
312 | } | |
313 | ||
314 | /* | |
315 | * Sets FM TX pre-emphasis filter value (OFF, 50us, or 75us) | |
316 | * Convert V4L2 specified filter values to chip specific filter values. | |
317 | */ | |
318 | int fm_tx_set_preemph_filter(struct fmdev *fmdev, u32 preemphasis) | |
319 | { | |
320 | struct fmtx_data *tx = &fmdev->tx_data; | |
321 | u16 payload; | |
322 | int ret; | |
323 | ||
324 | if (fmdev->curr_fmmode != FM_MODE_TX) | |
325 | return -EPERM; | |
326 | ||
327 | switch (preemphasis) { | |
328 | case V4L2_PREEMPHASIS_DISABLED: | |
329 | payload = FM_TX_PREEMPH_OFF; | |
330 | break; | |
331 | case V4L2_PREEMPHASIS_50_uS: | |
332 | payload = FM_TX_PREEMPH_50US; | |
333 | break; | |
334 | case V4L2_PREEMPHASIS_75_uS: | |
335 | payload = FM_TX_PREEMPH_75US; | |
336 | break; | |
337 | } | |
338 | ||
339 | ret = fmc_send_cmd(fmdev, PREMPH_SET, REG_WR, &payload, | |
340 | sizeof(payload), NULL, NULL); | |
341 | if (ret < 0) | |
342 | return ret; | |
343 | ||
344 | tx->preemph = payload; | |
345 | ||
346 | return ret; | |
347 | } | |
348 | ||
349 | /* Get the TX tuning capacitor value.*/ | |
350 | int fm_tx_get_tune_cap_val(struct fmdev *fmdev) | |
351 | { | |
352 | u16 curr_val; | |
353 | u32 resp_len; | |
354 | int ret; | |
355 | ||
356 | if (fmdev->curr_fmmode != FM_MODE_TX) | |
357 | return -EPERM; | |
358 | ||
359 | ret = fmc_send_cmd(fmdev, READ_FMANT_TUNE_VALUE, REG_RD, | |
360 | NULL, sizeof(curr_val), &curr_val, &resp_len); | |
361 | if (ret < 0) | |
362 | return ret; | |
363 | ||
364 | curr_val = be16_to_cpu((__force __be16)curr_val); | |
365 | ||
366 | return curr_val; | |
367 | } | |
368 | ||
369 | /* Set TX Frequency */ | |
370 | int fm_tx_set_freq(struct fmdev *fmdev, u32 freq_to_set) | |
371 | { | |
372 | struct fmtx_data *tx = &fmdev->tx_data; | |
373 | u16 payload, chanl_index; | |
374 | int ret; | |
375 | ||
376 | if (test_bit(FM_CORE_TX_XMITING, &fmdev->flag)) { | |
377 | enable_xmit(fmdev, 0); | |
378 | clear_bit(FM_CORE_TX_XMITING, &fmdev->flag); | |
379 | } | |
380 | ||
381 | /* Enable FR, BL interrupts */ | |
382 | payload = (FM_FR_EVENT | FM_BL_EVENT); | |
383 | ret = fmc_send_cmd(fmdev, INT_MASK_SET, REG_WR, &payload, | |
384 | sizeof(payload), NULL, NULL); | |
385 | if (ret < 0) | |
386 | return ret; | |
387 | ||
388 | tx->tx_frq = (unsigned long)freq_to_set; | |
389 | fmdbg("tx: freq_to_set %ld\n", (long int)tx->tx_frq); | |
390 | ||
391 | chanl_index = freq_to_set / 10; | |
392 | ||
393 | /* Set current tuner channel */ | |
394 | payload = chanl_index; | |
395 | ret = fmc_send_cmd(fmdev, CHANL_SET, REG_WR, &payload, | |
396 | sizeof(payload), NULL, NULL); | |
397 | if (ret < 0) | |
398 | return ret; | |
399 | ||
400 | fm_tx_set_pwr_lvl(fmdev, tx->pwr_lvl); | |
401 | fm_tx_set_preemph_filter(fmdev, tx->preemph); | |
402 | ||
403 | tx->audio_io = 0x01; /* I2S */ | |
404 | set_audio_io(fmdev); | |
405 | ||
406 | enable_xmit(fmdev, 0x01); /* Enable transmission */ | |
407 | ||
408 | tx->aud_mode = FM_STEREO_MODE; | |
409 | tx->rds.flag = FM_RDS_DISABLE; | |
410 | ||
411 | return 0; | |
412 | } | |
413 |