kernel/drivers/media/radio/wl128x/fmdrv_tx.c

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