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 414