187d1a50cSMatti Aaltonen /* 287d1a50cSMatti Aaltonen * Driver for the Texas Instruments WL1273 FM radio. 387d1a50cSMatti Aaltonen * 487d1a50cSMatti Aaltonen * Copyright (C) 2010 Nokia Corporation 587d1a50cSMatti Aaltonen * Author: Matti J. Aaltonen <matti.j.aaltonen@nokia.com> 687d1a50cSMatti Aaltonen * 787d1a50cSMatti Aaltonen * This program is free software; you can redistribute it and/or 887d1a50cSMatti Aaltonen * modify it under the terms of the GNU General Public License 987d1a50cSMatti Aaltonen * version 2 as published by the Free Software Foundation. 1087d1a50cSMatti Aaltonen * 1187d1a50cSMatti Aaltonen * This program is distributed in the hope that it will be useful, 1287d1a50cSMatti Aaltonen * but WITHOUT ANY WARRANTY; without even the implied warranty of 1387d1a50cSMatti Aaltonen * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1487d1a50cSMatti Aaltonen * GNU General Public License for more details. 1587d1a50cSMatti Aaltonen * 1687d1a50cSMatti Aaltonen * You should have received a copy of the GNU General Public License 1787d1a50cSMatti Aaltonen * along with this program; if not, write to the Free Software 1887d1a50cSMatti Aaltonen * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 1987d1a50cSMatti Aaltonen */ 2087d1a50cSMatti Aaltonen 2187d1a50cSMatti Aaltonen #include <linux/delay.h> 2287d1a50cSMatti Aaltonen #include <linux/firmware.h> 2387d1a50cSMatti Aaltonen #include <linux/interrupt.h> 2487d1a50cSMatti Aaltonen #include <linux/mfd/wl1273-core.h> 2587d1a50cSMatti Aaltonen #include <linux/slab.h> 2687d1a50cSMatti Aaltonen #include <media/v4l2-common.h> 2787d1a50cSMatti Aaltonen #include <media/v4l2-ctrls.h> 2887d1a50cSMatti Aaltonen #include <media/v4l2-device.h> 2987d1a50cSMatti Aaltonen #include <media/v4l2-ioctl.h> 3087d1a50cSMatti Aaltonen 3187d1a50cSMatti Aaltonen #define DRIVER_DESC "Wl1273 FM Radio" 3287d1a50cSMatti Aaltonen 3387d1a50cSMatti Aaltonen #define WL1273_POWER_SET_OFF 0 3487d1a50cSMatti Aaltonen #define WL1273_POWER_SET_FM BIT(0) 3587d1a50cSMatti Aaltonen #define WL1273_POWER_SET_RDS BIT(1) 3687d1a50cSMatti Aaltonen #define WL1273_POWER_SET_RETENTION BIT(4) 3787d1a50cSMatti Aaltonen 3887d1a50cSMatti Aaltonen #define WL1273_PUPD_SET_OFF 0x00 3987d1a50cSMatti Aaltonen #define WL1273_PUPD_SET_ON 0x01 4087d1a50cSMatti Aaltonen #define WL1273_PUPD_SET_RETENTION 0x10 4187d1a50cSMatti Aaltonen 4287d1a50cSMatti Aaltonen #define WL1273_FREQ(x) (x * 10000 / 625) 4387d1a50cSMatti Aaltonen #define WL1273_INV_FREQ(x) (x * 625 / 10000) 4487d1a50cSMatti Aaltonen 4587d1a50cSMatti Aaltonen /* 4687d1a50cSMatti Aaltonen * static int radio_nr - The number of the radio device 4787d1a50cSMatti Aaltonen * 4887d1a50cSMatti Aaltonen * The default is 0. 4987d1a50cSMatti Aaltonen */ 5087d1a50cSMatti Aaltonen static int radio_nr; 5187d1a50cSMatti Aaltonen module_param(radio_nr, int, 0); 5287d1a50cSMatti Aaltonen MODULE_PARM_DESC(radio_nr, "The number of the radio device. Default = 0"); 5387d1a50cSMatti Aaltonen 5487d1a50cSMatti Aaltonen struct wl1273_device { 5587d1a50cSMatti Aaltonen char *bus_type; 5687d1a50cSMatti Aaltonen 5787d1a50cSMatti Aaltonen u8 forbidden; 5887d1a50cSMatti Aaltonen unsigned int preemphasis; 5987d1a50cSMatti Aaltonen unsigned int spacing; 6087d1a50cSMatti Aaltonen unsigned int tx_power; 6187d1a50cSMatti Aaltonen unsigned int rx_frequency; 6287d1a50cSMatti Aaltonen unsigned int tx_frequency; 6387d1a50cSMatti Aaltonen unsigned int rangelow; 6487d1a50cSMatti Aaltonen unsigned int rangehigh; 6587d1a50cSMatti Aaltonen unsigned int band; 6687d1a50cSMatti Aaltonen bool stereo; 6787d1a50cSMatti Aaltonen 6887d1a50cSMatti Aaltonen /* RDS */ 6987d1a50cSMatti Aaltonen unsigned int rds_on; 7087d1a50cSMatti Aaltonen struct delayed_work work; 7187d1a50cSMatti Aaltonen 7287d1a50cSMatti Aaltonen wait_queue_head_t read_queue; 7387d1a50cSMatti Aaltonen struct mutex lock; /* for serializing fm radio operations */ 7487d1a50cSMatti Aaltonen struct completion busy; 7587d1a50cSMatti Aaltonen 7687d1a50cSMatti Aaltonen unsigned char *buffer; 7787d1a50cSMatti Aaltonen unsigned int buf_size; 7887d1a50cSMatti Aaltonen unsigned int rd_index; 7987d1a50cSMatti Aaltonen unsigned int wr_index; 8087d1a50cSMatti Aaltonen 8187d1a50cSMatti Aaltonen /* Selected interrupts */ 8287d1a50cSMatti Aaltonen u16 irq_flags; 8387d1a50cSMatti Aaltonen u16 irq_received; 8487d1a50cSMatti Aaltonen 8587d1a50cSMatti Aaltonen struct v4l2_ctrl_handler ctrl_handler; 8687d1a50cSMatti Aaltonen struct v4l2_device v4l2dev; 8787d1a50cSMatti Aaltonen struct video_device videodev; 8887d1a50cSMatti Aaltonen struct device *dev; 8987d1a50cSMatti Aaltonen struct wl1273_core *core; 9087d1a50cSMatti Aaltonen struct file *owner; 9187d1a50cSMatti Aaltonen char *write_buf; 9287d1a50cSMatti Aaltonen unsigned int rds_users; 9387d1a50cSMatti Aaltonen }; 9487d1a50cSMatti Aaltonen 9587d1a50cSMatti Aaltonen #define WL1273_IRQ_MASK (WL1273_FR_EVENT | \ 9687d1a50cSMatti Aaltonen WL1273_POW_ENB_EVENT) 9787d1a50cSMatti Aaltonen 9887d1a50cSMatti Aaltonen /* 9987d1a50cSMatti Aaltonen * static unsigned int rds_buf - the number of RDS buffer blocks used. 10087d1a50cSMatti Aaltonen * 10187d1a50cSMatti Aaltonen * The default number is 100. 10287d1a50cSMatti Aaltonen */ 10387d1a50cSMatti Aaltonen static unsigned int rds_buf = 100; 10487d1a50cSMatti Aaltonen module_param(rds_buf, uint, 0); 10587d1a50cSMatti Aaltonen MODULE_PARM_DESC(rds_buf, "Number of RDS buffer entries. Default = 100"); 10687d1a50cSMatti Aaltonen 10787d1a50cSMatti Aaltonen static int wl1273_fm_read_reg(struct wl1273_core *core, u8 reg, u16 *value) 10887d1a50cSMatti Aaltonen { 10987d1a50cSMatti Aaltonen struct i2c_client *client = core->client; 11087d1a50cSMatti Aaltonen u8 b[2]; 11187d1a50cSMatti Aaltonen int r; 11287d1a50cSMatti Aaltonen 11387d1a50cSMatti Aaltonen r = i2c_smbus_read_i2c_block_data(client, reg, sizeof(b), b); 11487d1a50cSMatti Aaltonen if (r != 2) { 11587d1a50cSMatti Aaltonen dev_err(&client->dev, "%s: Read: %d fails.\n", __func__, reg); 11687d1a50cSMatti Aaltonen return -EREMOTEIO; 11787d1a50cSMatti Aaltonen } 11887d1a50cSMatti Aaltonen 11987d1a50cSMatti Aaltonen *value = (u16)b[0] << 8 | b[1]; 12087d1a50cSMatti Aaltonen 12187d1a50cSMatti Aaltonen return 0; 12287d1a50cSMatti Aaltonen } 12387d1a50cSMatti Aaltonen 12487d1a50cSMatti Aaltonen static int wl1273_fm_write_cmd(struct wl1273_core *core, u8 cmd, u16 param) 12587d1a50cSMatti Aaltonen { 12687d1a50cSMatti Aaltonen struct i2c_client *client = core->client; 12787d1a50cSMatti Aaltonen u8 buf[] = { (param >> 8) & 0xff, param & 0xff }; 12887d1a50cSMatti Aaltonen int r; 12987d1a50cSMatti Aaltonen 13087d1a50cSMatti Aaltonen r = i2c_smbus_write_i2c_block_data(client, cmd, sizeof(buf), buf); 13187d1a50cSMatti Aaltonen if (r) { 13287d1a50cSMatti Aaltonen dev_err(&client->dev, "%s: Cmd: %d fails.\n", __func__, cmd); 13387d1a50cSMatti Aaltonen return r; 13487d1a50cSMatti Aaltonen } 13587d1a50cSMatti Aaltonen 13687d1a50cSMatti Aaltonen return 0; 13787d1a50cSMatti Aaltonen } 13887d1a50cSMatti Aaltonen 13987d1a50cSMatti Aaltonen static int wl1273_fm_write_data(struct wl1273_core *core, u8 *data, u16 len) 14087d1a50cSMatti Aaltonen { 14187d1a50cSMatti Aaltonen struct i2c_client *client = core->client; 14287d1a50cSMatti Aaltonen struct i2c_msg msg; 14387d1a50cSMatti Aaltonen int r; 14487d1a50cSMatti Aaltonen 14587d1a50cSMatti Aaltonen msg.addr = client->addr; 14687d1a50cSMatti Aaltonen msg.flags = 0; 14787d1a50cSMatti Aaltonen msg.buf = data; 14887d1a50cSMatti Aaltonen msg.len = len; 14987d1a50cSMatti Aaltonen 15087d1a50cSMatti Aaltonen r = i2c_transfer(client->adapter, &msg, 1); 15187d1a50cSMatti Aaltonen if (r != 1) { 15287d1a50cSMatti Aaltonen dev_err(&client->dev, "%s: write error.\n", __func__); 15387d1a50cSMatti Aaltonen return -EREMOTEIO; 15487d1a50cSMatti Aaltonen } 15587d1a50cSMatti Aaltonen 15687d1a50cSMatti Aaltonen return 0; 15787d1a50cSMatti Aaltonen } 15887d1a50cSMatti Aaltonen 15987d1a50cSMatti Aaltonen static int wl1273_fm_write_fw(struct wl1273_core *core, 16087d1a50cSMatti Aaltonen __u8 *fw, int len) 16187d1a50cSMatti Aaltonen { 16287d1a50cSMatti Aaltonen struct i2c_client *client = core->client; 16387d1a50cSMatti Aaltonen struct i2c_msg msg; 16487d1a50cSMatti Aaltonen int i, r = 0; 16587d1a50cSMatti Aaltonen 16687d1a50cSMatti Aaltonen msg.addr = client->addr; 16787d1a50cSMatti Aaltonen msg.flags = 0; 16887d1a50cSMatti Aaltonen 16987d1a50cSMatti Aaltonen for (i = 0; i <= len; i++) { 17087d1a50cSMatti Aaltonen msg.len = fw[0]; 17187d1a50cSMatti Aaltonen msg.buf = fw + 1; 17287d1a50cSMatti Aaltonen 17387d1a50cSMatti Aaltonen fw += msg.len + 1; 17487d1a50cSMatti Aaltonen dev_dbg(&client->dev, "%s:len[%d]: %d\n", __func__, i, msg.len); 17587d1a50cSMatti Aaltonen 17687d1a50cSMatti Aaltonen r = i2c_transfer(client->adapter, &msg, 1); 17787d1a50cSMatti Aaltonen if (r < 0 && i < len + 1) 17887d1a50cSMatti Aaltonen break; 17987d1a50cSMatti Aaltonen } 18087d1a50cSMatti Aaltonen 18187d1a50cSMatti Aaltonen dev_dbg(&client->dev, "%s: i: %d\n", __func__, i); 18287d1a50cSMatti Aaltonen dev_dbg(&client->dev, "%s: len + 1: %d\n", __func__, len + 1); 18387d1a50cSMatti Aaltonen 18487d1a50cSMatti Aaltonen /* Last transfer always fails. */ 18587d1a50cSMatti Aaltonen if (i == len || r == 1) 18687d1a50cSMatti Aaltonen r = 0; 18787d1a50cSMatti Aaltonen 18887d1a50cSMatti Aaltonen return r; 18987d1a50cSMatti Aaltonen } 19087d1a50cSMatti Aaltonen 19187d1a50cSMatti Aaltonen /** 19287d1a50cSMatti Aaltonen * wl1273_fm_set_audio() - Set audio mode. 19387d1a50cSMatti Aaltonen * @core: A pointer to the device struct. 19487d1a50cSMatti Aaltonen * @new_mode: The new audio mode. 19587d1a50cSMatti Aaltonen * 19687d1a50cSMatti Aaltonen * Audio modes are WL1273_AUDIO_DIGITAL and WL1273_AUDIO_ANALOG. 19787d1a50cSMatti Aaltonen */ 19887d1a50cSMatti Aaltonen static int wl1273_fm_set_audio(struct wl1273_core *core, unsigned int new_mode) 19987d1a50cSMatti Aaltonen { 20087d1a50cSMatti Aaltonen int r = 0; 20187d1a50cSMatti Aaltonen 20287d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF || 20387d1a50cSMatti Aaltonen core->mode == WL1273_MODE_SUSPENDED) 20487d1a50cSMatti Aaltonen return -EPERM; 20587d1a50cSMatti Aaltonen 20687d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX && new_mode == WL1273_AUDIO_DIGITAL) { 20787d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PCM_MODE_SET, 20887d1a50cSMatti Aaltonen WL1273_PCM_DEF_MODE); 20987d1a50cSMatti Aaltonen if (r) 21087d1a50cSMatti Aaltonen goto out; 21187d1a50cSMatti Aaltonen 21287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_I2S_MODE_CONFIG_SET, 21387d1a50cSMatti Aaltonen core->i2s_mode); 21487d1a50cSMatti Aaltonen if (r) 21587d1a50cSMatti Aaltonen goto out; 21687d1a50cSMatti Aaltonen 21787d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_AUDIO_ENABLE, 21887d1a50cSMatti Aaltonen WL1273_AUDIO_ENABLE_I2S); 21987d1a50cSMatti Aaltonen if (r) 22087d1a50cSMatti Aaltonen goto out; 22187d1a50cSMatti Aaltonen 22287d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_RX && 22387d1a50cSMatti Aaltonen new_mode == WL1273_AUDIO_ANALOG) { 22487d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_AUDIO_ENABLE, 22587d1a50cSMatti Aaltonen WL1273_AUDIO_ENABLE_ANALOG); 22687d1a50cSMatti Aaltonen if (r) 22787d1a50cSMatti Aaltonen goto out; 22887d1a50cSMatti Aaltonen 22987d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_TX && 23087d1a50cSMatti Aaltonen new_mode == WL1273_AUDIO_DIGITAL) { 23187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_I2S_MODE_CONFIG_SET, 23287d1a50cSMatti Aaltonen core->i2s_mode); 23387d1a50cSMatti Aaltonen if (r) 23487d1a50cSMatti Aaltonen goto out; 23587d1a50cSMatti Aaltonen 23687d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_AUDIO_IO_SET, 23787d1a50cSMatti Aaltonen WL1273_AUDIO_IO_SET_I2S); 23887d1a50cSMatti Aaltonen if (r) 23987d1a50cSMatti Aaltonen goto out; 24087d1a50cSMatti Aaltonen 24187d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_TX && 24287d1a50cSMatti Aaltonen new_mode == WL1273_AUDIO_ANALOG) { 24387d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_AUDIO_IO_SET, 24487d1a50cSMatti Aaltonen WL1273_AUDIO_IO_SET_ANALOG); 24587d1a50cSMatti Aaltonen if (r) 24687d1a50cSMatti Aaltonen goto out; 24787d1a50cSMatti Aaltonen } 24887d1a50cSMatti Aaltonen 24987d1a50cSMatti Aaltonen core->audio_mode = new_mode; 25087d1a50cSMatti Aaltonen out: 25187d1a50cSMatti Aaltonen return r; 25287d1a50cSMatti Aaltonen } 25387d1a50cSMatti Aaltonen 25487d1a50cSMatti Aaltonen /** 25587d1a50cSMatti Aaltonen * wl1273_fm_set_volume() - Set volume. 25687d1a50cSMatti Aaltonen * @core: A pointer to the device struct. 25787d1a50cSMatti Aaltonen * @volume: The new volume value. 25887d1a50cSMatti Aaltonen */ 25987d1a50cSMatti Aaltonen static int wl1273_fm_set_volume(struct wl1273_core *core, unsigned int volume) 26087d1a50cSMatti Aaltonen { 26187d1a50cSMatti Aaltonen u16 val; 26287d1a50cSMatti Aaltonen int r; 26387d1a50cSMatti Aaltonen 26487d1a50cSMatti Aaltonen if (volume > WL1273_MAX_VOLUME) 26587d1a50cSMatti Aaltonen return -EINVAL; 26687d1a50cSMatti Aaltonen 26787d1a50cSMatti Aaltonen if (core->volume == volume) 26887d1a50cSMatti Aaltonen return 0; 26987d1a50cSMatti Aaltonen 27087d1a50cSMatti Aaltonen val = volume; 27187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_VOLUME_SET, &val); 27287d1a50cSMatti Aaltonen if (r) 27387d1a50cSMatti Aaltonen return r; 27487d1a50cSMatti Aaltonen 27587d1a50cSMatti Aaltonen core->volume = volume; 27687d1a50cSMatti Aaltonen return 0; 27787d1a50cSMatti Aaltonen } 27887d1a50cSMatti Aaltonen 27987d1a50cSMatti Aaltonen #define WL1273_FIFO_HAS_DATA(status) (1 << 5 & status) 28087d1a50cSMatti Aaltonen #define WL1273_RDS_CORRECTABLE_ERROR (1 << 3) 28187d1a50cSMatti Aaltonen #define WL1273_RDS_UNCORRECTABLE_ERROR (1 << 4) 28287d1a50cSMatti Aaltonen 28387d1a50cSMatti Aaltonen static int wl1273_fm_rds(struct wl1273_device *radio) 28487d1a50cSMatti Aaltonen { 28587d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 28687d1a50cSMatti Aaltonen struct i2c_client *client = core->client; 28787d1a50cSMatti Aaltonen u16 val; 28887d1a50cSMatti Aaltonen u8 b0 = WL1273_RDS_DATA_GET, status; 28987d1a50cSMatti Aaltonen struct v4l2_rds_data rds = { 0, 0, 0 }; 29087d1a50cSMatti Aaltonen struct i2c_msg msg[] = { 29187d1a50cSMatti Aaltonen { 29287d1a50cSMatti Aaltonen .addr = client->addr, 29387d1a50cSMatti Aaltonen .flags = 0, 29487d1a50cSMatti Aaltonen .buf = &b0, 29587d1a50cSMatti Aaltonen .len = 1, 29687d1a50cSMatti Aaltonen }, 29787d1a50cSMatti Aaltonen { 29887d1a50cSMatti Aaltonen .addr = client->addr, 29987d1a50cSMatti Aaltonen .flags = I2C_M_RD, 30087d1a50cSMatti Aaltonen .buf = (u8 *) &rds, 30187d1a50cSMatti Aaltonen .len = sizeof(rds), 30287d1a50cSMatti Aaltonen } 30387d1a50cSMatti Aaltonen }; 30487d1a50cSMatti Aaltonen int r; 30587d1a50cSMatti Aaltonen 30687d1a50cSMatti Aaltonen if (core->mode != WL1273_MODE_RX) 30787d1a50cSMatti Aaltonen return 0; 30887d1a50cSMatti Aaltonen 30987d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RDS_SYNC_GET, &val); 31087d1a50cSMatti Aaltonen if (r) 31187d1a50cSMatti Aaltonen return r; 31287d1a50cSMatti Aaltonen 31387d1a50cSMatti Aaltonen if ((val & 0x01) == 0) { 31487d1a50cSMatti Aaltonen /* RDS decoder not synchronized */ 31587d1a50cSMatti Aaltonen return -EAGAIN; 31687d1a50cSMatti Aaltonen } 31787d1a50cSMatti Aaltonen 31887d1a50cSMatti Aaltonen /* copy all four RDS blocks to internal buffer */ 31987d1a50cSMatti Aaltonen do { 32087d1a50cSMatti Aaltonen r = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); 32187d1a50cSMatti Aaltonen if (r != ARRAY_SIZE(msg)) { 32287d1a50cSMatti Aaltonen dev_err(radio->dev, WL1273_FM_DRIVER_NAME 32387d1a50cSMatti Aaltonen ": %s: read_rds error r == %i)\n", 32487d1a50cSMatti Aaltonen __func__, r); 32587d1a50cSMatti Aaltonen } 32687d1a50cSMatti Aaltonen 32787d1a50cSMatti Aaltonen status = rds.block; 32887d1a50cSMatti Aaltonen 32987d1a50cSMatti Aaltonen if (!WL1273_FIFO_HAS_DATA(status)) 33087d1a50cSMatti Aaltonen break; 33187d1a50cSMatti Aaltonen 33287d1a50cSMatti Aaltonen /* copy bits 0-2 (the block ID) to bits 3-5 */ 33387d1a50cSMatti Aaltonen rds.block = V4L2_RDS_BLOCK_MSK & status; 33487d1a50cSMatti Aaltonen rds.block |= rds.block << 3; 33587d1a50cSMatti Aaltonen 33687d1a50cSMatti Aaltonen /* copy the error bits to standard positions */ 33787d1a50cSMatti Aaltonen if (WL1273_RDS_UNCORRECTABLE_ERROR & status) { 33887d1a50cSMatti Aaltonen rds.block |= V4L2_RDS_BLOCK_ERROR; 33987d1a50cSMatti Aaltonen rds.block &= ~V4L2_RDS_BLOCK_CORRECTED; 34087d1a50cSMatti Aaltonen } else if (WL1273_RDS_CORRECTABLE_ERROR & status) { 34187d1a50cSMatti Aaltonen rds.block &= ~V4L2_RDS_BLOCK_ERROR; 34287d1a50cSMatti Aaltonen rds.block |= V4L2_RDS_BLOCK_CORRECTED; 34387d1a50cSMatti Aaltonen } 34487d1a50cSMatti Aaltonen 34587d1a50cSMatti Aaltonen /* copy RDS block to internal buffer */ 34687d1a50cSMatti Aaltonen memcpy(&radio->buffer[radio->wr_index], &rds, RDS_BLOCK_SIZE); 34787d1a50cSMatti Aaltonen radio->wr_index += 3; 34887d1a50cSMatti Aaltonen 34987d1a50cSMatti Aaltonen /* wrap write pointer */ 35087d1a50cSMatti Aaltonen if (radio->wr_index >= radio->buf_size) 35187d1a50cSMatti Aaltonen radio->wr_index = 0; 35287d1a50cSMatti Aaltonen 35387d1a50cSMatti Aaltonen /* check for overflow & start over */ 35487d1a50cSMatti Aaltonen if (radio->wr_index == radio->rd_index) { 35587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "RDS OVERFLOW"); 35687d1a50cSMatti Aaltonen 35787d1a50cSMatti Aaltonen radio->rd_index = 0; 35887d1a50cSMatti Aaltonen radio->wr_index = 0; 35987d1a50cSMatti Aaltonen break; 36087d1a50cSMatti Aaltonen } 36187d1a50cSMatti Aaltonen } while (WL1273_FIFO_HAS_DATA(status)); 36287d1a50cSMatti Aaltonen 36387d1a50cSMatti Aaltonen /* wake up read queue */ 36487d1a50cSMatti Aaltonen if (radio->wr_index != radio->rd_index) 36587d1a50cSMatti Aaltonen wake_up_interruptible(&radio->read_queue); 36687d1a50cSMatti Aaltonen 36787d1a50cSMatti Aaltonen return 0; 36887d1a50cSMatti Aaltonen } 36987d1a50cSMatti Aaltonen 37087d1a50cSMatti Aaltonen static irqreturn_t wl1273_fm_irq_thread_handler(int irq, void *dev_id) 37187d1a50cSMatti Aaltonen { 37287d1a50cSMatti Aaltonen struct wl1273_device *radio = dev_id; 37387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 37487d1a50cSMatti Aaltonen u16 flags; 37587d1a50cSMatti Aaltonen int r; 37687d1a50cSMatti Aaltonen 37787d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_FLAG_GET, &flags); 37887d1a50cSMatti Aaltonen if (r) 37987d1a50cSMatti Aaltonen goto out; 38087d1a50cSMatti Aaltonen 38187d1a50cSMatti Aaltonen if (flags & WL1273_BL_EVENT) { 38287d1a50cSMatti Aaltonen radio->irq_received = flags; 38387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: BL\n"); 38487d1a50cSMatti Aaltonen } 38587d1a50cSMatti Aaltonen 38687d1a50cSMatti Aaltonen if (flags & WL1273_RDS_EVENT) { 38787d1a50cSMatti Aaltonen msleep(200); 38887d1a50cSMatti Aaltonen 38987d1a50cSMatti Aaltonen wl1273_fm_rds(radio); 39087d1a50cSMatti Aaltonen } 39187d1a50cSMatti Aaltonen 39287d1a50cSMatti Aaltonen if (flags & WL1273_BBLK_EVENT) 39387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: BBLK\n"); 39487d1a50cSMatti Aaltonen 39587d1a50cSMatti Aaltonen if (flags & WL1273_LSYNC_EVENT) 39687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: LSYNC\n"); 39787d1a50cSMatti Aaltonen 39887d1a50cSMatti Aaltonen if (flags & WL1273_LEV_EVENT) { 39987d1a50cSMatti Aaltonen u16 level; 40087d1a50cSMatti Aaltonen 40187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RSSI_LVL_GET, &level); 40287d1a50cSMatti Aaltonen if (r) 40387d1a50cSMatti Aaltonen goto out; 40487d1a50cSMatti Aaltonen 40587d1a50cSMatti Aaltonen if (level > 14) 40687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: LEV: 0x%x04\n", level); 40787d1a50cSMatti Aaltonen } 40887d1a50cSMatti Aaltonen 40987d1a50cSMatti Aaltonen if (flags & WL1273_IFFR_EVENT) 41087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: IFFR\n"); 41187d1a50cSMatti Aaltonen 41287d1a50cSMatti Aaltonen if (flags & WL1273_PI_EVENT) 41387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: PI\n"); 41487d1a50cSMatti Aaltonen 41587d1a50cSMatti Aaltonen if (flags & WL1273_PD_EVENT) 41687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: PD\n"); 41787d1a50cSMatti Aaltonen 41887d1a50cSMatti Aaltonen if (flags & WL1273_STIC_EVENT) 41987d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: STIC\n"); 42087d1a50cSMatti Aaltonen 42187d1a50cSMatti Aaltonen if (flags & WL1273_MAL_EVENT) 42287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: MAL\n"); 42387d1a50cSMatti Aaltonen 42487d1a50cSMatti Aaltonen if (flags & WL1273_POW_ENB_EVENT) { 42587d1a50cSMatti Aaltonen complete(&radio->busy); 42687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "NOT BUSY\n"); 42787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: POW_ENB\n"); 42887d1a50cSMatti Aaltonen } 42987d1a50cSMatti Aaltonen 43087d1a50cSMatti Aaltonen if (flags & WL1273_SCAN_OVER_EVENT) 43187d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: SCAN_OVER\n"); 43287d1a50cSMatti Aaltonen 43387d1a50cSMatti Aaltonen if (flags & WL1273_ERROR_EVENT) 43487d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: ERROR\n"); 43587d1a50cSMatti Aaltonen 43687d1a50cSMatti Aaltonen if (flags & WL1273_FR_EVENT) { 43787d1a50cSMatti Aaltonen u16 freq; 43887d1a50cSMatti Aaltonen 43987d1a50cSMatti Aaltonen dev_dbg(radio->dev, "IRQ: FR:\n"); 44087d1a50cSMatti Aaltonen 44187d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 44287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_TUNER_MODE_SET, 44387d1a50cSMatti Aaltonen TUNER_MODE_STOP_SEARCH); 44487d1a50cSMatti Aaltonen if (r) { 44587d1a50cSMatti Aaltonen dev_err(radio->dev, 44687d1a50cSMatti Aaltonen "%s: TUNER_MODE_SET fails: %d\n", 44787d1a50cSMatti Aaltonen __func__, r); 44887d1a50cSMatti Aaltonen goto out; 44987d1a50cSMatti Aaltonen } 45087d1a50cSMatti Aaltonen 45187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_FREQ_SET, &freq); 45287d1a50cSMatti Aaltonen if (r) 45387d1a50cSMatti Aaltonen goto out; 45487d1a50cSMatti Aaltonen 45587d1a50cSMatti Aaltonen if (radio->band == WL1273_BAND_JAPAN) 45687d1a50cSMatti Aaltonen radio->rx_frequency = WL1273_BAND_JAPAN_LOW + 45787d1a50cSMatti Aaltonen freq * 50; 45887d1a50cSMatti Aaltonen else 45987d1a50cSMatti Aaltonen radio->rx_frequency = WL1273_BAND_OTHER_LOW + 46087d1a50cSMatti Aaltonen freq * 50; 46187d1a50cSMatti Aaltonen /* 46287d1a50cSMatti Aaltonen * The driver works better with this msleep, 46387d1a50cSMatti Aaltonen * the documentation doesn't mention it. 46487d1a50cSMatti Aaltonen */ 46587d1a50cSMatti Aaltonen usleep_range(10000, 15000); 46687d1a50cSMatti Aaltonen 46787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%dkHz\n", radio->rx_frequency); 46887d1a50cSMatti Aaltonen 46987d1a50cSMatti Aaltonen } else { 47087d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_CHANL_SET, &freq); 47187d1a50cSMatti Aaltonen if (r) 47287d1a50cSMatti Aaltonen goto out; 47387d1a50cSMatti Aaltonen 47487d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%dkHz\n", freq); 47587d1a50cSMatti Aaltonen } 47687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: NOT BUSY\n", __func__); 47787d1a50cSMatti Aaltonen } 47887d1a50cSMatti Aaltonen 47987d1a50cSMatti Aaltonen out: 48087d1a50cSMatti Aaltonen wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, 48187d1a50cSMatti Aaltonen radio->irq_flags); 48287d1a50cSMatti Aaltonen complete(&radio->busy); 48387d1a50cSMatti Aaltonen 48487d1a50cSMatti Aaltonen return IRQ_HANDLED; 48587d1a50cSMatti Aaltonen } 48687d1a50cSMatti Aaltonen 48787d1a50cSMatti Aaltonen static int wl1273_fm_set_tx_freq(struct wl1273_device *radio, unsigned int freq) 48887d1a50cSMatti Aaltonen { 48987d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 49087d1a50cSMatti Aaltonen int r = 0; 49187d1a50cSMatti Aaltonen 49287d1a50cSMatti Aaltonen if (freq < WL1273_BAND_TX_LOW) { 49387d1a50cSMatti Aaltonen dev_err(radio->dev, 49487d1a50cSMatti Aaltonen "Frequency out of range: %d < %d\n", freq, 49587d1a50cSMatti Aaltonen WL1273_BAND_TX_LOW); 49687d1a50cSMatti Aaltonen return -ERANGE; 49787d1a50cSMatti Aaltonen } 49887d1a50cSMatti Aaltonen 49987d1a50cSMatti Aaltonen if (freq > WL1273_BAND_TX_HIGH) { 50087d1a50cSMatti Aaltonen dev_err(radio->dev, 50187d1a50cSMatti Aaltonen "Frequency out of range: %d > %d\n", freq, 50287d1a50cSMatti Aaltonen WL1273_BAND_TX_HIGH); 50387d1a50cSMatti Aaltonen return -ERANGE; 50487d1a50cSMatti Aaltonen } 50587d1a50cSMatti Aaltonen 50687d1a50cSMatti Aaltonen /* 50787d1a50cSMatti Aaltonen * The driver works better with this sleep, 50887d1a50cSMatti Aaltonen * the documentation doesn't mention it. 50987d1a50cSMatti Aaltonen */ 51087d1a50cSMatti Aaltonen usleep_range(5000, 10000); 51187d1a50cSMatti Aaltonen 51287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: freq: %d kHz\n", __func__, freq); 51387d1a50cSMatti Aaltonen 51487d1a50cSMatti Aaltonen /* Set the current tx channel */ 51587d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_CHANL_SET, freq / 10); 51687d1a50cSMatti Aaltonen if (r) 51787d1a50cSMatti Aaltonen return r; 51887d1a50cSMatti Aaltonen 51987d1a50cSMatti Aaltonen INIT_COMPLETION(radio->busy); 52087d1a50cSMatti Aaltonen 52187d1a50cSMatti Aaltonen /* wait for the FR IRQ */ 52287d1a50cSMatti Aaltonen r = wait_for_completion_timeout(&radio->busy, msecs_to_jiffies(2000)); 52387d1a50cSMatti Aaltonen if (!r) 52487d1a50cSMatti Aaltonen return -ETIMEDOUT; 52587d1a50cSMatti Aaltonen 52687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "WL1273_CHANL_SET: %d\n", r); 52787d1a50cSMatti Aaltonen 52887d1a50cSMatti Aaltonen /* Enable the output power */ 52987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_ENB_SET, 1); 53087d1a50cSMatti Aaltonen if (r) 53187d1a50cSMatti Aaltonen return r; 53287d1a50cSMatti Aaltonen 53387d1a50cSMatti Aaltonen INIT_COMPLETION(radio->busy); 53487d1a50cSMatti Aaltonen 53587d1a50cSMatti Aaltonen /* wait for the POWER_ENB IRQ */ 53687d1a50cSMatti Aaltonen r = wait_for_completion_timeout(&radio->busy, msecs_to_jiffies(1000)); 53787d1a50cSMatti Aaltonen if (!r) 53887d1a50cSMatti Aaltonen return -ETIMEDOUT; 53987d1a50cSMatti Aaltonen 54087d1a50cSMatti Aaltonen radio->tx_frequency = freq; 54187d1a50cSMatti Aaltonen dev_dbg(radio->dev, "WL1273_POWER_ENB_SET: %d\n", r); 54287d1a50cSMatti Aaltonen 54387d1a50cSMatti Aaltonen return 0; 54487d1a50cSMatti Aaltonen } 54587d1a50cSMatti Aaltonen 54687d1a50cSMatti Aaltonen static int wl1273_fm_set_rx_freq(struct wl1273_device *radio, unsigned int freq) 54787d1a50cSMatti Aaltonen { 54887d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 54987d1a50cSMatti Aaltonen int r, f; 55087d1a50cSMatti Aaltonen 55187d1a50cSMatti Aaltonen if (freq < radio->rangelow) { 55287d1a50cSMatti Aaltonen dev_err(radio->dev, 55387d1a50cSMatti Aaltonen "Frequency out of range: %d < %d\n", freq, 55487d1a50cSMatti Aaltonen radio->rangelow); 55587d1a50cSMatti Aaltonen r = -ERANGE; 55687d1a50cSMatti Aaltonen goto err; 55787d1a50cSMatti Aaltonen } 55887d1a50cSMatti Aaltonen 55987d1a50cSMatti Aaltonen if (freq > radio->rangehigh) { 56087d1a50cSMatti Aaltonen dev_err(radio->dev, 56187d1a50cSMatti Aaltonen "Frequency out of range: %d > %d\n", freq, 56287d1a50cSMatti Aaltonen radio->rangehigh); 56387d1a50cSMatti Aaltonen r = -ERANGE; 56487d1a50cSMatti Aaltonen goto err; 56587d1a50cSMatti Aaltonen } 56687d1a50cSMatti Aaltonen 56787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: %dkHz\n", __func__, freq); 56887d1a50cSMatti Aaltonen 56987d1a50cSMatti Aaltonen wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, radio->irq_flags); 57087d1a50cSMatti Aaltonen 57187d1a50cSMatti Aaltonen if (radio->band == WL1273_BAND_JAPAN) 57287d1a50cSMatti Aaltonen f = (freq - WL1273_BAND_JAPAN_LOW) / 50; 57387d1a50cSMatti Aaltonen else 57487d1a50cSMatti Aaltonen f = (freq - WL1273_BAND_OTHER_LOW) / 50; 57587d1a50cSMatti Aaltonen 57687d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_FREQ_SET, f); 57787d1a50cSMatti Aaltonen if (r) { 57887d1a50cSMatti Aaltonen dev_err(radio->dev, "FREQ_SET fails\n"); 57987d1a50cSMatti Aaltonen goto err; 58087d1a50cSMatti Aaltonen } 58187d1a50cSMatti Aaltonen 58287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_TUNER_MODE_SET, TUNER_MODE_PRESET); 58387d1a50cSMatti Aaltonen if (r) { 58487d1a50cSMatti Aaltonen dev_err(radio->dev, "TUNER_MODE_SET fails\n"); 58587d1a50cSMatti Aaltonen goto err; 58687d1a50cSMatti Aaltonen } 58787d1a50cSMatti Aaltonen 58887d1a50cSMatti Aaltonen INIT_COMPLETION(radio->busy); 58987d1a50cSMatti Aaltonen 59087d1a50cSMatti Aaltonen r = wait_for_completion_timeout(&radio->busy, msecs_to_jiffies(2000)); 59187d1a50cSMatti Aaltonen if (!r) { 59287d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: TIMEOUT\n", __func__); 59387d1a50cSMatti Aaltonen return -ETIMEDOUT; 59487d1a50cSMatti Aaltonen } 59587d1a50cSMatti Aaltonen 59687d1a50cSMatti Aaltonen radio->rd_index = 0; 59787d1a50cSMatti Aaltonen radio->wr_index = 0; 59887d1a50cSMatti Aaltonen radio->rx_frequency = freq; 59987d1a50cSMatti Aaltonen return 0; 60087d1a50cSMatti Aaltonen err: 60187d1a50cSMatti Aaltonen return r; 60287d1a50cSMatti Aaltonen } 60387d1a50cSMatti Aaltonen 60487d1a50cSMatti Aaltonen static int wl1273_fm_get_freq(struct wl1273_device *radio) 60587d1a50cSMatti Aaltonen { 60687d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 60787d1a50cSMatti Aaltonen unsigned int freq; 60887d1a50cSMatti Aaltonen u16 f; 60987d1a50cSMatti Aaltonen int r; 61087d1a50cSMatti Aaltonen 61187d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 61287d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_FREQ_SET, &f); 61387d1a50cSMatti Aaltonen if (r) 61487d1a50cSMatti Aaltonen return r; 61587d1a50cSMatti Aaltonen 61687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Freq get: 0x%04x\n", f); 61787d1a50cSMatti Aaltonen if (radio->band == WL1273_BAND_JAPAN) 61887d1a50cSMatti Aaltonen freq = WL1273_BAND_JAPAN_LOW + 50 * f; 61987d1a50cSMatti Aaltonen else 62087d1a50cSMatti Aaltonen freq = WL1273_BAND_OTHER_LOW + 50 * f; 62187d1a50cSMatti Aaltonen } else { 62287d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_CHANL_SET, &f); 62387d1a50cSMatti Aaltonen if (r) 62487d1a50cSMatti Aaltonen return r; 62587d1a50cSMatti Aaltonen 62687d1a50cSMatti Aaltonen freq = f * 10; 62787d1a50cSMatti Aaltonen } 62887d1a50cSMatti Aaltonen 62987d1a50cSMatti Aaltonen return freq; 63087d1a50cSMatti Aaltonen } 63187d1a50cSMatti Aaltonen 63287d1a50cSMatti Aaltonen /** 63387d1a50cSMatti Aaltonen * wl1273_fm_upload_firmware_patch() - Upload the firmware. 63487d1a50cSMatti Aaltonen * @radio: A pointer to the device struct. 63587d1a50cSMatti Aaltonen * 63687d1a50cSMatti Aaltonen * The firmware file consists of arrays of bytes where the first byte 63787d1a50cSMatti Aaltonen * gives the array length. The first byte in the file gives the 63887d1a50cSMatti Aaltonen * number of these arrays. 63987d1a50cSMatti Aaltonen */ 64087d1a50cSMatti Aaltonen static int wl1273_fm_upload_firmware_patch(struct wl1273_device *radio) 64187d1a50cSMatti Aaltonen { 64287d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 64387d1a50cSMatti Aaltonen unsigned int packet_num; 64487d1a50cSMatti Aaltonen const struct firmware *fw_p; 64587d1a50cSMatti Aaltonen const char *fw_name = "radio-wl1273-fw.bin"; 64687d1a50cSMatti Aaltonen struct device *dev = radio->dev; 64787d1a50cSMatti Aaltonen __u8 *ptr; 64887d1a50cSMatti Aaltonen int i, n, r; 64987d1a50cSMatti Aaltonen 65087d1a50cSMatti Aaltonen dev_dbg(dev, "%s:\n", __func__); 65187d1a50cSMatti Aaltonen 65287d1a50cSMatti Aaltonen /* 65387d1a50cSMatti Aaltonen * Uploading the firmware patch is not always necessary, 65487d1a50cSMatti Aaltonen * so we only print an info message. 65587d1a50cSMatti Aaltonen */ 65687d1a50cSMatti Aaltonen if (request_firmware(&fw_p, fw_name, dev)) { 65787d1a50cSMatti Aaltonen dev_info(dev, "%s - %s not found\n", __func__, fw_name); 65887d1a50cSMatti Aaltonen 65987d1a50cSMatti Aaltonen return 0; 66087d1a50cSMatti Aaltonen } 66187d1a50cSMatti Aaltonen 66287d1a50cSMatti Aaltonen ptr = (__u8 *) fw_p->data; 66387d1a50cSMatti Aaltonen packet_num = ptr[0]; 66487d1a50cSMatti Aaltonen dev_dbg(dev, "%s: packets: %d\n", __func__, packet_num); 66587d1a50cSMatti Aaltonen 66687d1a50cSMatti Aaltonen r = wl1273_fm_write_fw(core, ptr + 1, packet_num); 66787d1a50cSMatti Aaltonen if (r) { 66887d1a50cSMatti Aaltonen dev_err(dev, "FW upload error: %d\n", r); 66987d1a50cSMatti Aaltonen goto out; 67087d1a50cSMatti Aaltonen } 67187d1a50cSMatti Aaltonen 67287d1a50cSMatti Aaltonen /* ignore possible error here */ 67387d1a50cSMatti Aaltonen wl1273_fm_write_cmd(core, WL1273_RESET, 0); 67487d1a50cSMatti Aaltonen 67587d1a50cSMatti Aaltonen dev_dbg(dev, "n: %d, i: %d\n", n, i); 67687d1a50cSMatti Aaltonen dev_dbg(dev, "%s - download OK, r: %d\n", __func__, r); 67787d1a50cSMatti Aaltonen out: 67887d1a50cSMatti Aaltonen release_firmware(fw_p); 67987d1a50cSMatti Aaltonen return r; 68087d1a50cSMatti Aaltonen } 68187d1a50cSMatti Aaltonen 68287d1a50cSMatti Aaltonen static int wl1273_fm_stop(struct wl1273_device *radio) 68387d1a50cSMatti Aaltonen { 68487d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 68587d1a50cSMatti Aaltonen 68687d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 68787d1a50cSMatti Aaltonen int r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, 68887d1a50cSMatti Aaltonen WL1273_POWER_SET_OFF); 68987d1a50cSMatti Aaltonen if (r) 69087d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: POWER_SET fails: %d\n", 69187d1a50cSMatti Aaltonen __func__, r); 69287d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_TX) { 69387d1a50cSMatti Aaltonen int r = wl1273_fm_write_cmd(core, WL1273_PUPD_SET, 69487d1a50cSMatti Aaltonen WL1273_PUPD_SET_OFF); 69587d1a50cSMatti Aaltonen if (r) 69687d1a50cSMatti Aaltonen dev_err(radio->dev, 69787d1a50cSMatti Aaltonen "%s: PUPD_SET fails: %d\n", __func__, r); 69887d1a50cSMatti Aaltonen } 69987d1a50cSMatti Aaltonen 70087d1a50cSMatti Aaltonen if (core->pdata->disable) { 70187d1a50cSMatti Aaltonen core->pdata->disable(); 70287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Back to reset\n"); 70387d1a50cSMatti Aaltonen } 70487d1a50cSMatti Aaltonen 70587d1a50cSMatti Aaltonen return 0; 70687d1a50cSMatti Aaltonen } 70787d1a50cSMatti Aaltonen 70887d1a50cSMatti Aaltonen static int wl1273_fm_start(struct wl1273_device *radio, int new_mode) 70987d1a50cSMatti Aaltonen { 71087d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 71187d1a50cSMatti Aaltonen struct wl1273_fm_platform_data *pdata = core->pdata; 71287d1a50cSMatti Aaltonen struct device *dev = radio->dev; 71387d1a50cSMatti Aaltonen int r = -EINVAL; 71487d1a50cSMatti Aaltonen 71587d1a50cSMatti Aaltonen if (pdata->enable && core->mode == WL1273_MODE_OFF) { 71687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Out of reset\n"); 71787d1a50cSMatti Aaltonen 71887d1a50cSMatti Aaltonen pdata->enable(); 71987d1a50cSMatti Aaltonen msleep(250); 72087d1a50cSMatti Aaltonen } 72187d1a50cSMatti Aaltonen 72287d1a50cSMatti Aaltonen if (new_mode == WL1273_MODE_RX) { 72387d1a50cSMatti Aaltonen u16 val = WL1273_POWER_SET_FM; 72487d1a50cSMatti Aaltonen 72587d1a50cSMatti Aaltonen if (radio->rds_on) 72687d1a50cSMatti Aaltonen val |= WL1273_POWER_SET_RDS; 72787d1a50cSMatti Aaltonen 72887d1a50cSMatti Aaltonen /* If this fails try again */ 72987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, val); 73087d1a50cSMatti Aaltonen if (r) { 73187d1a50cSMatti Aaltonen msleep(100); 73287d1a50cSMatti Aaltonen 73387d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, val); 73487d1a50cSMatti Aaltonen if (r) { 73587d1a50cSMatti Aaltonen dev_err(dev, "%s: POWER_SET fails\n", __func__); 73687d1a50cSMatti Aaltonen goto fail; 73787d1a50cSMatti Aaltonen } 73887d1a50cSMatti Aaltonen } 73987d1a50cSMatti Aaltonen 74087d1a50cSMatti Aaltonen /* rds buffer configuration */ 74187d1a50cSMatti Aaltonen radio->wr_index = 0; 74287d1a50cSMatti Aaltonen radio->rd_index = 0; 74387d1a50cSMatti Aaltonen 74487d1a50cSMatti Aaltonen } else if (new_mode == WL1273_MODE_TX) { 74587d1a50cSMatti Aaltonen /* If this fails try again once */ 74687d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PUPD_SET, 74787d1a50cSMatti Aaltonen WL1273_PUPD_SET_ON); 74887d1a50cSMatti Aaltonen if (r) { 74987d1a50cSMatti Aaltonen msleep(100); 75087d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PUPD_SET, 75187d1a50cSMatti Aaltonen WL1273_PUPD_SET_ON); 75287d1a50cSMatti Aaltonen if (r) { 75387d1a50cSMatti Aaltonen dev_err(dev, "%s: PUPD_SET fails\n", __func__); 75487d1a50cSMatti Aaltonen goto fail; 75587d1a50cSMatti Aaltonen } 75687d1a50cSMatti Aaltonen } 75787d1a50cSMatti Aaltonen 75887d1a50cSMatti Aaltonen if (radio->rds_on) 75987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_RDS_DATA_ENB, 1); 76087d1a50cSMatti Aaltonen else 76187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_RDS_DATA_ENB, 0); 76287d1a50cSMatti Aaltonen } else { 76387d1a50cSMatti Aaltonen dev_warn(dev, "%s: Illegal mode.\n", __func__); 76487d1a50cSMatti Aaltonen } 76587d1a50cSMatti Aaltonen 76687d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF) { 76787d1a50cSMatti Aaltonen r = wl1273_fm_upload_firmware_patch(radio); 76887d1a50cSMatti Aaltonen if (r) 76987d1a50cSMatti Aaltonen dev_warn(dev, "Firmware upload failed.\n"); 77087d1a50cSMatti Aaltonen 77187d1a50cSMatti Aaltonen /* 77287d1a50cSMatti Aaltonen * Sometimes the chip is in a wrong power state at this point. 77387d1a50cSMatti Aaltonen * So we set the power once again. 77487d1a50cSMatti Aaltonen */ 77587d1a50cSMatti Aaltonen if (new_mode == WL1273_MODE_RX) { 77687d1a50cSMatti Aaltonen u16 val = WL1273_POWER_SET_FM; 77787d1a50cSMatti Aaltonen 77887d1a50cSMatti Aaltonen if (radio->rds_on) 77987d1a50cSMatti Aaltonen val |= WL1273_POWER_SET_RDS; 78087d1a50cSMatti Aaltonen 78187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, val); 78287d1a50cSMatti Aaltonen if (r) { 78387d1a50cSMatti Aaltonen dev_err(dev, "%s: POWER_SET fails\n", __func__); 78487d1a50cSMatti Aaltonen goto fail; 78587d1a50cSMatti Aaltonen } 78687d1a50cSMatti Aaltonen } else if (new_mode == WL1273_MODE_TX) { 78787d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PUPD_SET, 78887d1a50cSMatti Aaltonen WL1273_PUPD_SET_ON); 78987d1a50cSMatti Aaltonen if (r) { 79087d1a50cSMatti Aaltonen dev_err(dev, "%s: PUPD_SET fails\n", __func__); 79187d1a50cSMatti Aaltonen goto fail; 79287d1a50cSMatti Aaltonen } 79387d1a50cSMatti Aaltonen } 79487d1a50cSMatti Aaltonen } 79587d1a50cSMatti Aaltonen 79687d1a50cSMatti Aaltonen return 0; 79787d1a50cSMatti Aaltonen fail: 79887d1a50cSMatti Aaltonen if (pdata->disable) 79987d1a50cSMatti Aaltonen pdata->disable(); 80087d1a50cSMatti Aaltonen 80187d1a50cSMatti Aaltonen dev_dbg(dev, "%s: return: %d\n", __func__, r); 80287d1a50cSMatti Aaltonen return r; 80387d1a50cSMatti Aaltonen } 80487d1a50cSMatti Aaltonen 80587d1a50cSMatti Aaltonen static int wl1273_fm_suspend(struct wl1273_device *radio) 80687d1a50cSMatti Aaltonen { 80787d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 80887d1a50cSMatti Aaltonen int r = 0; 80987d1a50cSMatti Aaltonen 81087d1a50cSMatti Aaltonen /* Cannot go from OFF to SUSPENDED */ 81187d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) 81287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, 81387d1a50cSMatti Aaltonen WL1273_POWER_SET_RETENTION); 81487d1a50cSMatti Aaltonen else if (core->mode == WL1273_MODE_TX) 81587d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PUPD_SET, 81687d1a50cSMatti Aaltonen WL1273_PUPD_SET_RETENTION); 81787d1a50cSMatti Aaltonen else 81887d1a50cSMatti Aaltonen r = -EINVAL; 81987d1a50cSMatti Aaltonen 82087d1a50cSMatti Aaltonen if (r) { 82187d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: POWER_SET fails: %d\n", __func__, r); 82287d1a50cSMatti Aaltonen goto out; 82387d1a50cSMatti Aaltonen } 82487d1a50cSMatti Aaltonen 82587d1a50cSMatti Aaltonen out: 82687d1a50cSMatti Aaltonen return r; 82787d1a50cSMatti Aaltonen } 82887d1a50cSMatti Aaltonen 82987d1a50cSMatti Aaltonen static int wl1273_fm_set_mode(struct wl1273_device *radio, int mode) 83087d1a50cSMatti Aaltonen { 83187d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 83287d1a50cSMatti Aaltonen struct device *dev = radio->dev; 83387d1a50cSMatti Aaltonen int old_mode; 83487d1a50cSMatti Aaltonen int r; 83587d1a50cSMatti Aaltonen 83687d1a50cSMatti Aaltonen dev_dbg(dev, "%s\n", __func__); 83787d1a50cSMatti Aaltonen dev_dbg(dev, "Forbidden modes: 0x%02x\n", radio->forbidden); 83887d1a50cSMatti Aaltonen 83987d1a50cSMatti Aaltonen old_mode = core->mode; 84087d1a50cSMatti Aaltonen if (mode & radio->forbidden) { 84187d1a50cSMatti Aaltonen r = -EPERM; 84287d1a50cSMatti Aaltonen goto out; 84387d1a50cSMatti Aaltonen } 84487d1a50cSMatti Aaltonen 84587d1a50cSMatti Aaltonen switch (mode) { 84687d1a50cSMatti Aaltonen case WL1273_MODE_RX: 84787d1a50cSMatti Aaltonen case WL1273_MODE_TX: 84887d1a50cSMatti Aaltonen r = wl1273_fm_start(radio, mode); 84987d1a50cSMatti Aaltonen if (r) { 85087d1a50cSMatti Aaltonen dev_err(dev, "%s: Cannot start.\n", __func__); 85187d1a50cSMatti Aaltonen wl1273_fm_stop(radio); 85287d1a50cSMatti Aaltonen goto out; 85387d1a50cSMatti Aaltonen } 85487d1a50cSMatti Aaltonen 85587d1a50cSMatti Aaltonen core->mode = mode; 85687d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, 85787d1a50cSMatti Aaltonen radio->irq_flags); 85887d1a50cSMatti Aaltonen if (r) { 85987d1a50cSMatti Aaltonen dev_err(dev, "INT_MASK_SET fails.\n"); 86087d1a50cSMatti Aaltonen goto out; 86187d1a50cSMatti Aaltonen } 86287d1a50cSMatti Aaltonen 86387d1a50cSMatti Aaltonen /* remember previous settings */ 86487d1a50cSMatti Aaltonen if (mode == WL1273_MODE_RX) { 86587d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, radio->rx_frequency); 86687d1a50cSMatti Aaltonen if (r) { 86787d1a50cSMatti Aaltonen dev_err(dev, "set freq fails: %d.\n", r); 86887d1a50cSMatti Aaltonen goto out; 86987d1a50cSMatti Aaltonen } 87087d1a50cSMatti Aaltonen 87187d1a50cSMatti Aaltonen r = core->set_volume(core, core->volume); 87287d1a50cSMatti Aaltonen if (r) { 87387d1a50cSMatti Aaltonen dev_err(dev, "set volume fails: %d.\n", r); 87487d1a50cSMatti Aaltonen goto out; 87587d1a50cSMatti Aaltonen } 87687d1a50cSMatti Aaltonen 87787d1a50cSMatti Aaltonen dev_dbg(dev, "%s: Set vol: %d.\n", __func__, 87887d1a50cSMatti Aaltonen core->volume); 87987d1a50cSMatti Aaltonen } else { 88087d1a50cSMatti Aaltonen r = wl1273_fm_set_tx_freq(radio, radio->tx_frequency); 88187d1a50cSMatti Aaltonen if (r) { 88287d1a50cSMatti Aaltonen dev_err(dev, "set freq fails: %d.\n", r); 88387d1a50cSMatti Aaltonen goto out; 88487d1a50cSMatti Aaltonen } 88587d1a50cSMatti Aaltonen } 88687d1a50cSMatti Aaltonen 88787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: Set audio mode.\n", __func__); 88887d1a50cSMatti Aaltonen 88987d1a50cSMatti Aaltonen r = core->set_audio(core, core->audio_mode); 89087d1a50cSMatti Aaltonen if (r) 89187d1a50cSMatti Aaltonen dev_err(dev, "Cannot set audio mode.\n"); 89287d1a50cSMatti Aaltonen break; 89387d1a50cSMatti Aaltonen 89487d1a50cSMatti Aaltonen case WL1273_MODE_OFF: 89587d1a50cSMatti Aaltonen r = wl1273_fm_stop(radio); 89687d1a50cSMatti Aaltonen if (r) 89787d1a50cSMatti Aaltonen dev_err(dev, "%s: Off fails: %d\n", __func__, r); 89887d1a50cSMatti Aaltonen else 89987d1a50cSMatti Aaltonen core->mode = WL1273_MODE_OFF; 90087d1a50cSMatti Aaltonen 90187d1a50cSMatti Aaltonen break; 90287d1a50cSMatti Aaltonen 90387d1a50cSMatti Aaltonen case WL1273_MODE_SUSPENDED: 90487d1a50cSMatti Aaltonen r = wl1273_fm_suspend(radio); 90587d1a50cSMatti Aaltonen if (r) 90687d1a50cSMatti Aaltonen dev_err(dev, "%s: Suspend fails: %d\n", __func__, r); 90787d1a50cSMatti Aaltonen else 90887d1a50cSMatti Aaltonen core->mode = WL1273_MODE_SUSPENDED; 90987d1a50cSMatti Aaltonen 91087d1a50cSMatti Aaltonen break; 91187d1a50cSMatti Aaltonen 91287d1a50cSMatti Aaltonen default: 91387d1a50cSMatti Aaltonen dev_err(dev, "%s: Unknown mode: %d\n", __func__, mode); 91487d1a50cSMatti Aaltonen r = -EINVAL; 91587d1a50cSMatti Aaltonen break; 91687d1a50cSMatti Aaltonen } 91787d1a50cSMatti Aaltonen out: 91887d1a50cSMatti Aaltonen if (r) 91987d1a50cSMatti Aaltonen core->mode = old_mode; 92087d1a50cSMatti Aaltonen 92187d1a50cSMatti Aaltonen return r; 92287d1a50cSMatti Aaltonen } 92387d1a50cSMatti Aaltonen 92487d1a50cSMatti Aaltonen static int wl1273_fm_set_seek(struct wl1273_device *radio, 92587d1a50cSMatti Aaltonen unsigned int wrap_around, 92687d1a50cSMatti Aaltonen unsigned int seek_upward, 92787d1a50cSMatti Aaltonen int level) 92887d1a50cSMatti Aaltonen { 92987d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 93087d1a50cSMatti Aaltonen int r = 0; 93187d1a50cSMatti Aaltonen unsigned int dir = (seek_upward == 0) ? 0 : 1; 93287d1a50cSMatti Aaltonen unsigned int f; 93387d1a50cSMatti Aaltonen 93487d1a50cSMatti Aaltonen f = radio->rx_frequency; 93587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "rx_frequency: %d\n", f); 93687d1a50cSMatti Aaltonen 93787d1a50cSMatti Aaltonen if (dir && f + radio->spacing <= radio->rangehigh) 93887d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, f + radio->spacing); 93987d1a50cSMatti Aaltonen else if (dir && wrap_around) 94087d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, radio->rangelow); 94187d1a50cSMatti Aaltonen else if (f - radio->spacing >= radio->rangelow) 94287d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, f - radio->spacing); 94387d1a50cSMatti Aaltonen else if (wrap_around) 94487d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, radio->rangehigh); 94587d1a50cSMatti Aaltonen 94687d1a50cSMatti Aaltonen if (r) 94787d1a50cSMatti Aaltonen goto out; 94887d1a50cSMatti Aaltonen 94987d1a50cSMatti Aaltonen if (level < SCHAR_MIN || level > SCHAR_MAX) 95087d1a50cSMatti Aaltonen return -EINVAL; 95187d1a50cSMatti Aaltonen 95287d1a50cSMatti Aaltonen INIT_COMPLETION(radio->busy); 95387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: BUSY\n", __func__); 95487d1a50cSMatti Aaltonen 95587d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, radio->irq_flags); 95687d1a50cSMatti Aaltonen if (r) 95787d1a50cSMatti Aaltonen goto out; 95887d1a50cSMatti Aaltonen 95987d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 96087d1a50cSMatti Aaltonen 96187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_SEARCH_LVL_SET, level); 96287d1a50cSMatti Aaltonen if (r) 96387d1a50cSMatti Aaltonen goto out; 96487d1a50cSMatti Aaltonen 96587d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_SEARCH_DIR_SET, dir); 96687d1a50cSMatti Aaltonen if (r) 96787d1a50cSMatti Aaltonen goto out; 96887d1a50cSMatti Aaltonen 96987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_TUNER_MODE_SET, 97087d1a50cSMatti Aaltonen TUNER_MODE_AUTO_SEEK); 97187d1a50cSMatti Aaltonen if (r) 97287d1a50cSMatti Aaltonen goto out; 97387d1a50cSMatti Aaltonen 97487d1a50cSMatti Aaltonen wait_for_completion_timeout(&radio->busy, msecs_to_jiffies(1000)); 97587d1a50cSMatti Aaltonen if (!(radio->irq_received & WL1273_BL_EVENT)) 97687d1a50cSMatti Aaltonen goto out; 97787d1a50cSMatti Aaltonen 97887d1a50cSMatti Aaltonen radio->irq_received &= ~WL1273_BL_EVENT; 97987d1a50cSMatti Aaltonen 98087d1a50cSMatti Aaltonen if (!wrap_around) 98187d1a50cSMatti Aaltonen goto out; 98287d1a50cSMatti Aaltonen 98387d1a50cSMatti Aaltonen /* Wrap around */ 98487d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Wrap around in HW seek.\n"); 98587d1a50cSMatti Aaltonen 98687d1a50cSMatti Aaltonen if (seek_upward) 98787d1a50cSMatti Aaltonen f = radio->rangelow; 98887d1a50cSMatti Aaltonen else 98987d1a50cSMatti Aaltonen f = radio->rangehigh; 99087d1a50cSMatti Aaltonen 99187d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, f); 99287d1a50cSMatti Aaltonen if (r) 99387d1a50cSMatti Aaltonen goto out; 99487d1a50cSMatti Aaltonen 99587d1a50cSMatti Aaltonen INIT_COMPLETION(radio->busy); 99687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: BUSY\n", __func__); 99787d1a50cSMatti Aaltonen 99887d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_TUNER_MODE_SET, 99987d1a50cSMatti Aaltonen TUNER_MODE_AUTO_SEEK); 100087d1a50cSMatti Aaltonen if (r) 100187d1a50cSMatti Aaltonen goto out; 100287d1a50cSMatti Aaltonen 100387d1a50cSMatti Aaltonen wait_for_completion_timeout(&radio->busy, msecs_to_jiffies(1000)); 100487d1a50cSMatti Aaltonen out: 100587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: Err: %d\n", __func__, r); 100687d1a50cSMatti Aaltonen return r; 100787d1a50cSMatti Aaltonen } 100887d1a50cSMatti Aaltonen 100987d1a50cSMatti Aaltonen /** 101087d1a50cSMatti Aaltonen * wl1273_fm_get_tx_ctune() - Get the TX tuning capacitor value. 101187d1a50cSMatti Aaltonen * @radio: A pointer to the device struct. 101287d1a50cSMatti Aaltonen */ 101387d1a50cSMatti Aaltonen static unsigned int wl1273_fm_get_tx_ctune(struct wl1273_device *radio) 101487d1a50cSMatti Aaltonen { 101587d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 101687d1a50cSMatti Aaltonen struct device *dev = radio->dev; 101787d1a50cSMatti Aaltonen u16 val; 101887d1a50cSMatti Aaltonen int r; 101987d1a50cSMatti Aaltonen 102087d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF || 102187d1a50cSMatti Aaltonen core->mode == WL1273_MODE_SUSPENDED) 102287d1a50cSMatti Aaltonen return -EPERM; 102387d1a50cSMatti Aaltonen 102487d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_READ_FMANT_TUNE_VALUE, &val); 102587d1a50cSMatti Aaltonen if (r) { 102687d1a50cSMatti Aaltonen dev_err(dev, "%s: read error: %d\n", __func__, r); 102787d1a50cSMatti Aaltonen goto out; 102887d1a50cSMatti Aaltonen } 102987d1a50cSMatti Aaltonen 103087d1a50cSMatti Aaltonen out: 103187d1a50cSMatti Aaltonen return val; 103287d1a50cSMatti Aaltonen } 103387d1a50cSMatti Aaltonen 103487d1a50cSMatti Aaltonen /** 103587d1a50cSMatti Aaltonen * wl1273_fm_set_preemphasis() - Set the TX pre-emphasis value. 103687d1a50cSMatti Aaltonen * @radio: A pointer to the device struct. 103787d1a50cSMatti Aaltonen * @preemphasis: The new pre-amphasis value. 103887d1a50cSMatti Aaltonen * 103987d1a50cSMatti Aaltonen * Possible pre-emphasis values are: V4L2_PREEMPHASIS_DISABLED, 104087d1a50cSMatti Aaltonen * V4L2_PREEMPHASIS_50_uS and V4L2_PREEMPHASIS_75_uS. 104187d1a50cSMatti Aaltonen */ 104287d1a50cSMatti Aaltonen static int wl1273_fm_set_preemphasis(struct wl1273_device *radio, 104387d1a50cSMatti Aaltonen unsigned int preemphasis) 104487d1a50cSMatti Aaltonen { 104587d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 104687d1a50cSMatti Aaltonen int r; 104787d1a50cSMatti Aaltonen u16 em; 104887d1a50cSMatti Aaltonen 104987d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF || 105087d1a50cSMatti Aaltonen core->mode == WL1273_MODE_SUSPENDED) 105187d1a50cSMatti Aaltonen return -EPERM; 105287d1a50cSMatti Aaltonen 105387d1a50cSMatti Aaltonen mutex_lock(&core->lock); 105487d1a50cSMatti Aaltonen 105587d1a50cSMatti Aaltonen switch (preemphasis) { 105687d1a50cSMatti Aaltonen case V4L2_PREEMPHASIS_DISABLED: 105787d1a50cSMatti Aaltonen em = 1; 105887d1a50cSMatti Aaltonen break; 105987d1a50cSMatti Aaltonen case V4L2_PREEMPHASIS_50_uS: 106087d1a50cSMatti Aaltonen em = 0; 106187d1a50cSMatti Aaltonen break; 106287d1a50cSMatti Aaltonen case V4L2_PREEMPHASIS_75_uS: 106387d1a50cSMatti Aaltonen em = 2; 106487d1a50cSMatti Aaltonen break; 106587d1a50cSMatti Aaltonen default: 106687d1a50cSMatti Aaltonen r = -EINVAL; 106787d1a50cSMatti Aaltonen goto out; 106887d1a50cSMatti Aaltonen } 106987d1a50cSMatti Aaltonen 107087d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_PREMPH_SET, em); 107187d1a50cSMatti Aaltonen if (r) 107287d1a50cSMatti Aaltonen goto out; 107387d1a50cSMatti Aaltonen 107487d1a50cSMatti Aaltonen radio->preemphasis = preemphasis; 107587d1a50cSMatti Aaltonen 107687d1a50cSMatti Aaltonen out: 107787d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 107887d1a50cSMatti Aaltonen return r; 107987d1a50cSMatti Aaltonen } 108087d1a50cSMatti Aaltonen 108187d1a50cSMatti Aaltonen static int wl1273_fm_rds_on(struct wl1273_device *radio) 108287d1a50cSMatti Aaltonen { 108387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 108487d1a50cSMatti Aaltonen int r; 108587d1a50cSMatti Aaltonen 108687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 108787d1a50cSMatti Aaltonen if (radio->rds_on) 108887d1a50cSMatti Aaltonen return 0; 108987d1a50cSMatti Aaltonen 109087d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, 109187d1a50cSMatti Aaltonen WL1273_POWER_SET_FM | WL1273_POWER_SET_RDS); 109287d1a50cSMatti Aaltonen if (r) 109387d1a50cSMatti Aaltonen goto out; 109487d1a50cSMatti Aaltonen 109587d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, radio->rx_frequency); 109687d1a50cSMatti Aaltonen if (r) 109787d1a50cSMatti Aaltonen dev_err(radio->dev, "set freq fails: %d.\n", r); 109887d1a50cSMatti Aaltonen out: 109987d1a50cSMatti Aaltonen return r; 110087d1a50cSMatti Aaltonen } 110187d1a50cSMatti Aaltonen 110287d1a50cSMatti Aaltonen static int wl1273_fm_rds_off(struct wl1273_device *radio) 110387d1a50cSMatti Aaltonen { 110487d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 110587d1a50cSMatti Aaltonen int r; 110687d1a50cSMatti Aaltonen 110787d1a50cSMatti Aaltonen if (!radio->rds_on) 110887d1a50cSMatti Aaltonen return 0; 110987d1a50cSMatti Aaltonen 111087d1a50cSMatti Aaltonen radio->irq_flags &= ~WL1273_RDS_EVENT; 111187d1a50cSMatti Aaltonen 111287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, radio->irq_flags); 111387d1a50cSMatti Aaltonen if (r) 111487d1a50cSMatti Aaltonen goto out; 111587d1a50cSMatti Aaltonen 111687d1a50cSMatti Aaltonen /* stop rds reception */ 111787d1a50cSMatti Aaltonen cancel_delayed_work(&radio->work); 111887d1a50cSMatti Aaltonen 111987d1a50cSMatti Aaltonen /* Service pending read */ 112087d1a50cSMatti Aaltonen wake_up_interruptible(&radio->read_queue); 112187d1a50cSMatti Aaltonen 112287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 112387d1a50cSMatti Aaltonen 112487d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_POWER_SET, WL1273_POWER_SET_FM); 112587d1a50cSMatti Aaltonen if (r) 112687d1a50cSMatti Aaltonen goto out; 112787d1a50cSMatti Aaltonen 112887d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, radio->rx_frequency); 112987d1a50cSMatti Aaltonen if (r) 113087d1a50cSMatti Aaltonen dev_err(radio->dev, "set freq fails: %d.\n", r); 113187d1a50cSMatti Aaltonen out: 113287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: exiting...\n", __func__); 113387d1a50cSMatti Aaltonen 113487d1a50cSMatti Aaltonen return r; 113587d1a50cSMatti Aaltonen } 113687d1a50cSMatti Aaltonen 113787d1a50cSMatti Aaltonen static int wl1273_fm_set_rds(struct wl1273_device *radio, unsigned int new_mode) 113887d1a50cSMatti Aaltonen { 113987d1a50cSMatti Aaltonen int r = 0; 114087d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 114187d1a50cSMatti Aaltonen 114287d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF || 114387d1a50cSMatti Aaltonen core->mode == WL1273_MODE_SUSPENDED) 114487d1a50cSMatti Aaltonen return -EPERM; 114587d1a50cSMatti Aaltonen 114687d1a50cSMatti Aaltonen if (new_mode == WL1273_RDS_RESET) { 114787d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_RDS_CNTRL_SET, 1); 114887d1a50cSMatti Aaltonen return r; 114987d1a50cSMatti Aaltonen } 115087d1a50cSMatti Aaltonen 115187d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_TX && new_mode == WL1273_RDS_OFF) { 115287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_RDS_DATA_ENB, 0); 115387d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_TX && new_mode == WL1273_RDS_ON) { 115487d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_RDS_DATA_ENB, 1); 115587d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_RX && new_mode == WL1273_RDS_OFF) { 115687d1a50cSMatti Aaltonen r = wl1273_fm_rds_off(radio); 115787d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_RX && new_mode == WL1273_RDS_ON) { 115887d1a50cSMatti Aaltonen r = wl1273_fm_rds_on(radio); 115987d1a50cSMatti Aaltonen } else { 116087d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: Unknown mode: %d\n", 116187d1a50cSMatti Aaltonen __func__, new_mode); 116287d1a50cSMatti Aaltonen r = -EINVAL; 116387d1a50cSMatti Aaltonen } 116487d1a50cSMatti Aaltonen 116587d1a50cSMatti Aaltonen if (!r) 116687d1a50cSMatti Aaltonen radio->rds_on = (new_mode == WL1273_RDS_ON) ? true : false; 116787d1a50cSMatti Aaltonen 116887d1a50cSMatti Aaltonen return r; 116987d1a50cSMatti Aaltonen } 117087d1a50cSMatti Aaltonen 117187d1a50cSMatti Aaltonen static ssize_t wl1273_fm_fops_write(struct file *file, const char __user *buf, 117287d1a50cSMatti Aaltonen size_t count, loff_t *ppos) 117387d1a50cSMatti Aaltonen { 117487d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 117587d1a50cSMatti Aaltonen u16 val; 117687d1a50cSMatti Aaltonen int r; 117787d1a50cSMatti Aaltonen 117887d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 117987d1a50cSMatti Aaltonen 118087d1a50cSMatti Aaltonen if (radio->core->mode != WL1273_MODE_TX) 118187d1a50cSMatti Aaltonen return count; 118287d1a50cSMatti Aaltonen 118387d1a50cSMatti Aaltonen if (radio->rds_users == 0) { 118487d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: RDS not on.\n", __func__); 118587d1a50cSMatti Aaltonen return 0; 118687d1a50cSMatti Aaltonen } 118787d1a50cSMatti Aaltonen 118887d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&radio->core->lock)) 118987d1a50cSMatti Aaltonen return -EINTR; 119087d1a50cSMatti Aaltonen /* 119187d1a50cSMatti Aaltonen * Multiple processes can open the device, but only 119287d1a50cSMatti Aaltonen * one gets to write to it. 119387d1a50cSMatti Aaltonen */ 119487d1a50cSMatti Aaltonen if (radio->owner && radio->owner != file) { 119587d1a50cSMatti Aaltonen r = -EBUSY; 119687d1a50cSMatti Aaltonen goto out; 119787d1a50cSMatti Aaltonen } 119887d1a50cSMatti Aaltonen radio->owner = file; 119987d1a50cSMatti Aaltonen 120087d1a50cSMatti Aaltonen /* Manual Mode */ 120187d1a50cSMatti Aaltonen if (count > 255) 120287d1a50cSMatti Aaltonen val = 255; 120387d1a50cSMatti Aaltonen else 120487d1a50cSMatti Aaltonen val = count; 120587d1a50cSMatti Aaltonen 120687d1a50cSMatti Aaltonen wl1273_fm_write_cmd(radio->core, WL1273_RDS_CONFIG_DATA_SET, val); 120787d1a50cSMatti Aaltonen 120887d1a50cSMatti Aaltonen if (copy_from_user(radio->write_buf + 1, buf, val)) { 120987d1a50cSMatti Aaltonen r = -EFAULT; 121087d1a50cSMatti Aaltonen goto out; 121187d1a50cSMatti Aaltonen } 121287d1a50cSMatti Aaltonen 121387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Count: %d\n", val); 121487d1a50cSMatti Aaltonen dev_dbg(radio->dev, "From user: \"%s\"\n", radio->write_buf); 121587d1a50cSMatti Aaltonen 121687d1a50cSMatti Aaltonen radio->write_buf[0] = WL1273_RDS_DATA_SET; 121787d1a50cSMatti Aaltonen wl1273_fm_write_data(radio->core, radio->write_buf, val + 1); 121887d1a50cSMatti Aaltonen 121987d1a50cSMatti Aaltonen r = val; 122087d1a50cSMatti Aaltonen out: 122187d1a50cSMatti Aaltonen mutex_unlock(&radio->core->lock); 122287d1a50cSMatti Aaltonen 122387d1a50cSMatti Aaltonen return r; 122487d1a50cSMatti Aaltonen } 122587d1a50cSMatti Aaltonen 122687d1a50cSMatti Aaltonen static unsigned int wl1273_fm_fops_poll(struct file *file, 122787d1a50cSMatti Aaltonen struct poll_table_struct *pts) 122887d1a50cSMatti Aaltonen { 122987d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 123087d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 123187d1a50cSMatti Aaltonen 123287d1a50cSMatti Aaltonen if (radio->owner && radio->owner != file) 123387d1a50cSMatti Aaltonen return -EBUSY; 123487d1a50cSMatti Aaltonen 123587d1a50cSMatti Aaltonen radio->owner = file; 123687d1a50cSMatti Aaltonen 123787d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 123887d1a50cSMatti Aaltonen poll_wait(file, &radio->read_queue, pts); 123987d1a50cSMatti Aaltonen 124087d1a50cSMatti Aaltonen if (radio->rd_index != radio->wr_index) 124187d1a50cSMatti Aaltonen return POLLIN | POLLRDNORM; 124287d1a50cSMatti Aaltonen 124387d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_TX) { 124487d1a50cSMatti Aaltonen return POLLOUT | POLLWRNORM; 124587d1a50cSMatti Aaltonen } 124687d1a50cSMatti Aaltonen 124787d1a50cSMatti Aaltonen return 0; 124887d1a50cSMatti Aaltonen } 124987d1a50cSMatti Aaltonen 125087d1a50cSMatti Aaltonen static int wl1273_fm_fops_open(struct file *file) 125187d1a50cSMatti Aaltonen { 125287d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 125387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 125487d1a50cSMatti Aaltonen int r = 0; 125587d1a50cSMatti Aaltonen 125687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 125787d1a50cSMatti Aaltonen 125887d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX && radio->rds_on && 125987d1a50cSMatti Aaltonen !radio->rds_users) { 126087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: Mode: %d\n", __func__, core->mode); 126187d1a50cSMatti Aaltonen 126287d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 126387d1a50cSMatti Aaltonen return -EINTR; 126487d1a50cSMatti Aaltonen 126587d1a50cSMatti Aaltonen radio->irq_flags |= WL1273_RDS_EVENT; 126687d1a50cSMatti Aaltonen 126787d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_INT_MASK_SET, 126887d1a50cSMatti Aaltonen radio->irq_flags); 126987d1a50cSMatti Aaltonen if (r) { 127087d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 127187d1a50cSMatti Aaltonen goto out; 127287d1a50cSMatti Aaltonen } 127387d1a50cSMatti Aaltonen 127487d1a50cSMatti Aaltonen radio->rds_users++; 127587d1a50cSMatti Aaltonen 127687d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 127787d1a50cSMatti Aaltonen } 127887d1a50cSMatti Aaltonen out: 127987d1a50cSMatti Aaltonen return r; 128087d1a50cSMatti Aaltonen } 128187d1a50cSMatti Aaltonen 128287d1a50cSMatti Aaltonen static int wl1273_fm_fops_release(struct file *file) 128387d1a50cSMatti Aaltonen { 128487d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 128587d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 128687d1a50cSMatti Aaltonen int r = 0; 128787d1a50cSMatti Aaltonen 128887d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 128987d1a50cSMatti Aaltonen 129087d1a50cSMatti Aaltonen if (radio->rds_users > 0) { 129187d1a50cSMatti Aaltonen radio->rds_users--; 129287d1a50cSMatti Aaltonen if (radio->rds_users == 0) { 129387d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 129487d1a50cSMatti Aaltonen return -EINTR; 129587d1a50cSMatti Aaltonen 129687d1a50cSMatti Aaltonen radio->irq_flags &= ~WL1273_RDS_EVENT; 129787d1a50cSMatti Aaltonen 129887d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 129987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, 130087d1a50cSMatti Aaltonen WL1273_INT_MASK_SET, 130187d1a50cSMatti Aaltonen radio->irq_flags); 130287d1a50cSMatti Aaltonen if (r) { 130387d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 130487d1a50cSMatti Aaltonen goto out; 130587d1a50cSMatti Aaltonen } 130687d1a50cSMatti Aaltonen } 130787d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 130887d1a50cSMatti Aaltonen } 130987d1a50cSMatti Aaltonen } 131087d1a50cSMatti Aaltonen 131187d1a50cSMatti Aaltonen if (file == radio->owner) 131287d1a50cSMatti Aaltonen radio->owner = NULL; 131387d1a50cSMatti Aaltonen out: 131487d1a50cSMatti Aaltonen return r; 131587d1a50cSMatti Aaltonen } 131687d1a50cSMatti Aaltonen 131787d1a50cSMatti Aaltonen static ssize_t wl1273_fm_fops_read(struct file *file, char __user *buf, 131887d1a50cSMatti Aaltonen size_t count, loff_t *ppos) 131987d1a50cSMatti Aaltonen { 132087d1a50cSMatti Aaltonen int r = 0; 132187d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 132287d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 132387d1a50cSMatti Aaltonen unsigned int block_count = 0; 132487d1a50cSMatti Aaltonen u16 val; 132587d1a50cSMatti Aaltonen 132687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 132787d1a50cSMatti Aaltonen 132887d1a50cSMatti Aaltonen if (radio->core->mode != WL1273_MODE_RX) 132987d1a50cSMatti Aaltonen return 0; 133087d1a50cSMatti Aaltonen 133187d1a50cSMatti Aaltonen if (radio->rds_users == 0) { 133287d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: RDS not on.\n", __func__); 133387d1a50cSMatti Aaltonen return 0; 133487d1a50cSMatti Aaltonen } 133587d1a50cSMatti Aaltonen 133687d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 133787d1a50cSMatti Aaltonen return -EINTR; 133887d1a50cSMatti Aaltonen 133987d1a50cSMatti Aaltonen /* 134087d1a50cSMatti Aaltonen * Multiple processes can open the device, but only 134187d1a50cSMatti Aaltonen * one at a time gets read access. 134287d1a50cSMatti Aaltonen */ 134387d1a50cSMatti Aaltonen if (radio->owner && radio->owner != file) { 134487d1a50cSMatti Aaltonen r = -EBUSY; 134587d1a50cSMatti Aaltonen goto out; 134687d1a50cSMatti Aaltonen } 134787d1a50cSMatti Aaltonen radio->owner = file; 134887d1a50cSMatti Aaltonen 134987d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RDS_SYNC_GET, &val); 135087d1a50cSMatti Aaltonen if (r) { 135187d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: Get RDS_SYNC fails.\n", __func__); 135287d1a50cSMatti Aaltonen goto out; 135387d1a50cSMatti Aaltonen } else if (val == 0) { 135487d1a50cSMatti Aaltonen dev_info(radio->dev, "RDS_SYNC: Not synchronized\n"); 135587d1a50cSMatti Aaltonen r = -ENODATA; 135687d1a50cSMatti Aaltonen goto out; 135787d1a50cSMatti Aaltonen } 135887d1a50cSMatti Aaltonen 135987d1a50cSMatti Aaltonen /* block if no new data available */ 136087d1a50cSMatti Aaltonen while (radio->wr_index == radio->rd_index) { 136187d1a50cSMatti Aaltonen if (file->f_flags & O_NONBLOCK) { 136287d1a50cSMatti Aaltonen r = -EWOULDBLOCK; 136387d1a50cSMatti Aaltonen goto out; 136487d1a50cSMatti Aaltonen } 136587d1a50cSMatti Aaltonen 136687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: Wait for RDS data.\n", __func__); 136787d1a50cSMatti Aaltonen if (wait_event_interruptible(radio->read_queue, 136887d1a50cSMatti Aaltonen radio->wr_index != 136987d1a50cSMatti Aaltonen radio->rd_index) < 0) { 137087d1a50cSMatti Aaltonen r = -EINTR; 137187d1a50cSMatti Aaltonen goto out; 137287d1a50cSMatti Aaltonen } 137387d1a50cSMatti Aaltonen } 137487d1a50cSMatti Aaltonen 137587d1a50cSMatti Aaltonen /* calculate block count from byte count */ 137687d1a50cSMatti Aaltonen count /= RDS_BLOCK_SIZE; 137787d1a50cSMatti Aaltonen 137887d1a50cSMatti Aaltonen /* copy RDS blocks from the internal buffer and to user buffer */ 137987d1a50cSMatti Aaltonen while (block_count < count) { 138087d1a50cSMatti Aaltonen if (radio->rd_index == radio->wr_index) 138187d1a50cSMatti Aaltonen break; 138287d1a50cSMatti Aaltonen 138387d1a50cSMatti Aaltonen /* always transfer complete RDS blocks */ 138487d1a50cSMatti Aaltonen if (copy_to_user(buf, &radio->buffer[radio->rd_index], 138587d1a50cSMatti Aaltonen RDS_BLOCK_SIZE)) 138687d1a50cSMatti Aaltonen break; 138787d1a50cSMatti Aaltonen 138887d1a50cSMatti Aaltonen /* increment and wrap the read pointer */ 138987d1a50cSMatti Aaltonen radio->rd_index += RDS_BLOCK_SIZE; 139087d1a50cSMatti Aaltonen if (radio->rd_index >= radio->buf_size) 139187d1a50cSMatti Aaltonen radio->rd_index = 0; 139287d1a50cSMatti Aaltonen 139387d1a50cSMatti Aaltonen /* increment counters */ 139487d1a50cSMatti Aaltonen block_count++; 139587d1a50cSMatti Aaltonen buf += RDS_BLOCK_SIZE; 139687d1a50cSMatti Aaltonen r += RDS_BLOCK_SIZE; 139787d1a50cSMatti Aaltonen } 139887d1a50cSMatti Aaltonen 139987d1a50cSMatti Aaltonen out: 140087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: exit\n", __func__); 140187d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 140287d1a50cSMatti Aaltonen 140387d1a50cSMatti Aaltonen return r; 140487d1a50cSMatti Aaltonen } 140587d1a50cSMatti Aaltonen 140687d1a50cSMatti Aaltonen static const struct v4l2_file_operations wl1273_fops = { 140787d1a50cSMatti Aaltonen .owner = THIS_MODULE, 140887d1a50cSMatti Aaltonen .read = wl1273_fm_fops_read, 140987d1a50cSMatti Aaltonen .write = wl1273_fm_fops_write, 141087d1a50cSMatti Aaltonen .poll = wl1273_fm_fops_poll, 141187d1a50cSMatti Aaltonen .ioctl = video_ioctl2, 141287d1a50cSMatti Aaltonen .open = wl1273_fm_fops_open, 141387d1a50cSMatti Aaltonen .release = wl1273_fm_fops_release, 141487d1a50cSMatti Aaltonen }; 141587d1a50cSMatti Aaltonen 141687d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_querycap(struct file *file, void *priv, 141787d1a50cSMatti Aaltonen struct v4l2_capability *capability) 141887d1a50cSMatti Aaltonen { 141987d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 142087d1a50cSMatti Aaltonen 142187d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 142287d1a50cSMatti Aaltonen 142387d1a50cSMatti Aaltonen strlcpy(capability->driver, WL1273_FM_DRIVER_NAME, 142487d1a50cSMatti Aaltonen sizeof(capability->driver)); 142587d1a50cSMatti Aaltonen strlcpy(capability->card, "Texas Instruments Wl1273 FM Radio", 142687d1a50cSMatti Aaltonen sizeof(capability->card)); 142787d1a50cSMatti Aaltonen strlcpy(capability->bus_info, radio->bus_type, 142887d1a50cSMatti Aaltonen sizeof(capability->bus_info)); 142987d1a50cSMatti Aaltonen 143087d1a50cSMatti Aaltonen capability->capabilities = V4L2_CAP_HW_FREQ_SEEK | 143187d1a50cSMatti Aaltonen V4L2_CAP_TUNER | V4L2_CAP_RADIO | V4L2_CAP_AUDIO | 143287d1a50cSMatti Aaltonen V4L2_CAP_RDS_CAPTURE | V4L2_CAP_MODULATOR | 143387d1a50cSMatti Aaltonen V4L2_CAP_RDS_OUTPUT; 143487d1a50cSMatti Aaltonen 143587d1a50cSMatti Aaltonen return 0; 143687d1a50cSMatti Aaltonen } 143787d1a50cSMatti Aaltonen 143887d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_g_input(struct file *file, void *priv, 143987d1a50cSMatti Aaltonen unsigned int *i) 144087d1a50cSMatti Aaltonen { 144187d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 144287d1a50cSMatti Aaltonen 144387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 144487d1a50cSMatti Aaltonen 144587d1a50cSMatti Aaltonen *i = 0; 144687d1a50cSMatti Aaltonen 144787d1a50cSMatti Aaltonen return 0; 144887d1a50cSMatti Aaltonen } 144987d1a50cSMatti Aaltonen 145087d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_input(struct file *file, void *priv, 145187d1a50cSMatti Aaltonen unsigned int i) 145287d1a50cSMatti Aaltonen { 145387d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 145487d1a50cSMatti Aaltonen 145587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 145687d1a50cSMatti Aaltonen 145787d1a50cSMatti Aaltonen if (i != 0) 145887d1a50cSMatti Aaltonen return -EINVAL; 145987d1a50cSMatti Aaltonen 146087d1a50cSMatti Aaltonen return 0; 146187d1a50cSMatti Aaltonen } 146287d1a50cSMatti Aaltonen 146387d1a50cSMatti Aaltonen /** 146487d1a50cSMatti Aaltonen * wl1273_fm_set_tx_power() - Set the transmission power value. 146587d1a50cSMatti Aaltonen * @core: A pointer to the device struct. 146687d1a50cSMatti Aaltonen * @power: The new power value. 146787d1a50cSMatti Aaltonen */ 146887d1a50cSMatti Aaltonen static int wl1273_fm_set_tx_power(struct wl1273_device *radio, u16 power) 146987d1a50cSMatti Aaltonen { 147087d1a50cSMatti Aaltonen int r; 147187d1a50cSMatti Aaltonen 147287d1a50cSMatti Aaltonen if (radio->core->mode == WL1273_MODE_OFF || 147387d1a50cSMatti Aaltonen radio->core->mode == WL1273_MODE_SUSPENDED) 147487d1a50cSMatti Aaltonen return -EPERM; 147587d1a50cSMatti Aaltonen 147687d1a50cSMatti Aaltonen mutex_lock(&radio->core->lock); 147787d1a50cSMatti Aaltonen 147887d1a50cSMatti Aaltonen /* Convert the dBuV value to chip presentation */ 147987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(radio->core, WL1273_POWER_LEV_SET, 122 - power); 148087d1a50cSMatti Aaltonen if (r) 148187d1a50cSMatti Aaltonen goto out; 148287d1a50cSMatti Aaltonen 148387d1a50cSMatti Aaltonen radio->tx_power = power; 148487d1a50cSMatti Aaltonen 148587d1a50cSMatti Aaltonen out: 148687d1a50cSMatti Aaltonen mutex_unlock(&radio->core->lock); 148787d1a50cSMatti Aaltonen return r; 148887d1a50cSMatti Aaltonen } 148987d1a50cSMatti Aaltonen 149087d1a50cSMatti Aaltonen #define WL1273_SPACING_50kHz 1 149187d1a50cSMatti Aaltonen #define WL1273_SPACING_100kHz 2 149287d1a50cSMatti Aaltonen #define WL1273_SPACING_200kHz 4 149387d1a50cSMatti Aaltonen 149487d1a50cSMatti Aaltonen static int wl1273_fm_tx_set_spacing(struct wl1273_device *radio, 149587d1a50cSMatti Aaltonen unsigned int spacing) 149687d1a50cSMatti Aaltonen { 149787d1a50cSMatti Aaltonen int r; 149887d1a50cSMatti Aaltonen 149987d1a50cSMatti Aaltonen if (spacing == 0) { 150087d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(radio->core, WL1273_SCAN_SPACING_SET, 150187d1a50cSMatti Aaltonen WL1273_SPACING_100kHz); 150287d1a50cSMatti Aaltonen radio->spacing = 100; 150387d1a50cSMatti Aaltonen } else if (spacing - 50000 < 25000) { 150487d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(radio->core, WL1273_SCAN_SPACING_SET, 150587d1a50cSMatti Aaltonen WL1273_SPACING_50kHz); 150687d1a50cSMatti Aaltonen radio->spacing = 50; 150787d1a50cSMatti Aaltonen } else if (spacing - 100000 < 50000) { 150887d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(radio->core, WL1273_SCAN_SPACING_SET, 150987d1a50cSMatti Aaltonen WL1273_SPACING_100kHz); 151087d1a50cSMatti Aaltonen radio->spacing = 100; 151187d1a50cSMatti Aaltonen } else { 151287d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(radio->core, WL1273_SCAN_SPACING_SET, 151387d1a50cSMatti Aaltonen WL1273_SPACING_200kHz); 151487d1a50cSMatti Aaltonen radio->spacing = 200; 151587d1a50cSMatti Aaltonen } 151687d1a50cSMatti Aaltonen 151787d1a50cSMatti Aaltonen return r; 151887d1a50cSMatti Aaltonen } 151987d1a50cSMatti Aaltonen 152087d1a50cSMatti Aaltonen static int wl1273_fm_g_volatile_ctrl(struct v4l2_ctrl *ctrl) 152187d1a50cSMatti Aaltonen { 152287d1a50cSMatti Aaltonen struct wl1273_device *radio = ctrl->priv; 152387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 152487d1a50cSMatti Aaltonen 152587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 152687d1a50cSMatti Aaltonen 152787d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 152887d1a50cSMatti Aaltonen return -EINTR; 152987d1a50cSMatti Aaltonen 153087d1a50cSMatti Aaltonen switch (ctrl->id) { 153187d1a50cSMatti Aaltonen case V4L2_CID_TUNE_ANTENNA_CAPACITOR: 153287d1a50cSMatti Aaltonen ctrl->val = wl1273_fm_get_tx_ctune(radio); 153387d1a50cSMatti Aaltonen break; 153487d1a50cSMatti Aaltonen 153587d1a50cSMatti Aaltonen default: 153687d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: Unknown IOCTL: %d\n", 153787d1a50cSMatti Aaltonen __func__, ctrl->id); 153887d1a50cSMatti Aaltonen break; 153987d1a50cSMatti Aaltonen } 154087d1a50cSMatti Aaltonen 154187d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 154287d1a50cSMatti Aaltonen 154387d1a50cSMatti Aaltonen return 0; 154487d1a50cSMatti Aaltonen } 154587d1a50cSMatti Aaltonen 154687d1a50cSMatti Aaltonen #define WL1273_MUTE_SOFT_ENABLE (1 << 0) 154787d1a50cSMatti Aaltonen #define WL1273_MUTE_AC (1 << 1) 154887d1a50cSMatti Aaltonen #define WL1273_MUTE_HARD_LEFT (1 << 2) 154987d1a50cSMatti Aaltonen #define WL1273_MUTE_HARD_RIGHT (1 << 3) 155087d1a50cSMatti Aaltonen #define WL1273_MUTE_SOFT_FORCE (1 << 4) 155187d1a50cSMatti Aaltonen 155287d1a50cSMatti Aaltonen static inline struct wl1273_device *to_radio(struct v4l2_ctrl *ctrl) 155387d1a50cSMatti Aaltonen { 155487d1a50cSMatti Aaltonen return container_of(ctrl->handler, struct wl1273_device, ctrl_handler); 155587d1a50cSMatti Aaltonen } 155687d1a50cSMatti Aaltonen 155787d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_ctrl(struct v4l2_ctrl *ctrl) 155887d1a50cSMatti Aaltonen { 155987d1a50cSMatti Aaltonen struct wl1273_device *radio = to_radio(ctrl); 156087d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 156187d1a50cSMatti Aaltonen int r = 0; 156287d1a50cSMatti Aaltonen 156387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 156487d1a50cSMatti Aaltonen 156587d1a50cSMatti Aaltonen switch (ctrl->id) { 156687d1a50cSMatti Aaltonen case V4L2_CID_AUDIO_MUTE: 156787d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 156887d1a50cSMatti Aaltonen return -EINTR; 156987d1a50cSMatti Aaltonen 157087d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX && ctrl->val) 157187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, 157287d1a50cSMatti Aaltonen WL1273_MUTE_STATUS_SET, 157387d1a50cSMatti Aaltonen WL1273_MUTE_HARD_LEFT | 157487d1a50cSMatti Aaltonen WL1273_MUTE_HARD_RIGHT); 157587d1a50cSMatti Aaltonen else if (core->mode == WL1273_MODE_RX) 157687d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, 157787d1a50cSMatti Aaltonen WL1273_MUTE_STATUS_SET, 0x0); 157887d1a50cSMatti Aaltonen else if (core->mode == WL1273_MODE_TX && ctrl->val) 157987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MUTE, 1); 158087d1a50cSMatti Aaltonen else if (core->mode == WL1273_MODE_TX) 158187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MUTE, 0); 158287d1a50cSMatti Aaltonen 158387d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 158487d1a50cSMatti Aaltonen break; 158587d1a50cSMatti Aaltonen 158687d1a50cSMatti Aaltonen case V4L2_CID_AUDIO_VOLUME: 158787d1a50cSMatti Aaltonen if (ctrl->val == 0) 158887d1a50cSMatti Aaltonen r = wl1273_fm_set_mode(radio, WL1273_MODE_OFF); 158987d1a50cSMatti Aaltonen else 159087d1a50cSMatti Aaltonen r = core->set_volume(core, core->volume); 159187d1a50cSMatti Aaltonen break; 159287d1a50cSMatti Aaltonen 159387d1a50cSMatti Aaltonen case V4L2_CID_TUNE_PREEMPHASIS: 159487d1a50cSMatti Aaltonen r = wl1273_fm_set_preemphasis(radio, ctrl->val); 159587d1a50cSMatti Aaltonen break; 159687d1a50cSMatti Aaltonen 159787d1a50cSMatti Aaltonen case V4L2_CID_TUNE_POWER_LEVEL: 159887d1a50cSMatti Aaltonen r = wl1273_fm_set_tx_power(radio, ctrl->val); 159987d1a50cSMatti Aaltonen break; 160087d1a50cSMatti Aaltonen 160187d1a50cSMatti Aaltonen default: 160287d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: Unknown IOCTL: %d\n", 160387d1a50cSMatti Aaltonen __func__, ctrl->id); 160487d1a50cSMatti Aaltonen break; 160587d1a50cSMatti Aaltonen } 160687d1a50cSMatti Aaltonen 160787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 160887d1a50cSMatti Aaltonen return r; 160987d1a50cSMatti Aaltonen } 161087d1a50cSMatti Aaltonen 161187d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_g_audio(struct file *file, void *priv, 161287d1a50cSMatti Aaltonen struct v4l2_audio *audio) 161387d1a50cSMatti Aaltonen { 161487d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 161587d1a50cSMatti Aaltonen 161687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 161787d1a50cSMatti Aaltonen 161887d1a50cSMatti Aaltonen if (audio->index > 1) 161987d1a50cSMatti Aaltonen return -EINVAL; 162087d1a50cSMatti Aaltonen 162187d1a50cSMatti Aaltonen strlcpy(audio->name, "Radio", sizeof(audio->name)); 162287d1a50cSMatti Aaltonen audio->capability = V4L2_AUDCAP_STEREO; 162387d1a50cSMatti Aaltonen 162487d1a50cSMatti Aaltonen return 0; 162587d1a50cSMatti Aaltonen } 162687d1a50cSMatti Aaltonen 162787d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_audio(struct file *file, void *priv, 162887d1a50cSMatti Aaltonen struct v4l2_audio *audio) 162987d1a50cSMatti Aaltonen { 163087d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 163187d1a50cSMatti Aaltonen 163287d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 163387d1a50cSMatti Aaltonen 163487d1a50cSMatti Aaltonen if (audio->index != 0) 163587d1a50cSMatti Aaltonen return -EINVAL; 163687d1a50cSMatti Aaltonen 163787d1a50cSMatti Aaltonen return 0; 163887d1a50cSMatti Aaltonen } 163987d1a50cSMatti Aaltonen 164087d1a50cSMatti Aaltonen #define WL1273_RDS_NOT_SYNCHRONIZED 0 164187d1a50cSMatti Aaltonen #define WL1273_RDS_SYNCHRONIZED 1 164287d1a50cSMatti Aaltonen 164387d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_g_tuner(struct file *file, void *priv, 164487d1a50cSMatti Aaltonen struct v4l2_tuner *tuner) 164587d1a50cSMatti Aaltonen { 164687d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 164787d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 164887d1a50cSMatti Aaltonen u16 val; 164987d1a50cSMatti Aaltonen int r; 165087d1a50cSMatti Aaltonen 165187d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 165287d1a50cSMatti Aaltonen 165387d1a50cSMatti Aaltonen if (tuner->index > 0) 165487d1a50cSMatti Aaltonen return -EINVAL; 165587d1a50cSMatti Aaltonen 165687d1a50cSMatti Aaltonen strlcpy(tuner->name, WL1273_FM_DRIVER_NAME, sizeof(tuner->name)); 165787d1a50cSMatti Aaltonen tuner->type = V4L2_TUNER_RADIO; 165887d1a50cSMatti Aaltonen 165987d1a50cSMatti Aaltonen tuner->rangelow = WL1273_FREQ(WL1273_BAND_JAPAN_LOW); 166087d1a50cSMatti Aaltonen tuner->rangehigh = WL1273_FREQ(WL1273_BAND_OTHER_HIGH); 166187d1a50cSMatti Aaltonen 166287d1a50cSMatti Aaltonen tuner->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_RDS | 166387d1a50cSMatti Aaltonen V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_RDS_BLOCK_IO; 166487d1a50cSMatti Aaltonen 166587d1a50cSMatti Aaltonen if (radio->stereo) 166687d1a50cSMatti Aaltonen tuner->audmode = V4L2_TUNER_MODE_STEREO; 166787d1a50cSMatti Aaltonen else 166887d1a50cSMatti Aaltonen tuner->audmode = V4L2_TUNER_MODE_MONO; 166987d1a50cSMatti Aaltonen 167087d1a50cSMatti Aaltonen if (core->mode != WL1273_MODE_RX) 167187d1a50cSMatti Aaltonen return 0; 167287d1a50cSMatti Aaltonen 167387d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 167487d1a50cSMatti Aaltonen return -EINTR; 167587d1a50cSMatti Aaltonen 167687d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_STEREO_GET, &val); 167787d1a50cSMatti Aaltonen if (r) 167887d1a50cSMatti Aaltonen goto out; 167987d1a50cSMatti Aaltonen 168087d1a50cSMatti Aaltonen if (val == 1) 168187d1a50cSMatti Aaltonen tuner->rxsubchans = V4L2_TUNER_SUB_STEREO; 168287d1a50cSMatti Aaltonen else 168387d1a50cSMatti Aaltonen tuner->rxsubchans = V4L2_TUNER_SUB_MONO; 168487d1a50cSMatti Aaltonen 168587d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RSSI_LVL_GET, &val); 168687d1a50cSMatti Aaltonen if (r) 168787d1a50cSMatti Aaltonen goto out; 168887d1a50cSMatti Aaltonen 168987d1a50cSMatti Aaltonen tuner->signal = (s16) val; 169087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "Signal: %d\n", tuner->signal); 169187d1a50cSMatti Aaltonen 169287d1a50cSMatti Aaltonen tuner->afc = 0; 169387d1a50cSMatti Aaltonen 169487d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RDS_SYNC_GET, &val); 169587d1a50cSMatti Aaltonen if (r) 169687d1a50cSMatti Aaltonen goto out; 169787d1a50cSMatti Aaltonen 169887d1a50cSMatti Aaltonen if (val == WL1273_RDS_SYNCHRONIZED) 169987d1a50cSMatti Aaltonen tuner->rxsubchans |= V4L2_TUNER_SUB_RDS; 170087d1a50cSMatti Aaltonen out: 170187d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 170287d1a50cSMatti Aaltonen 170387d1a50cSMatti Aaltonen return r; 170487d1a50cSMatti Aaltonen } 170587d1a50cSMatti Aaltonen 170687d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_tuner(struct file *file, void *priv, 170787d1a50cSMatti Aaltonen struct v4l2_tuner *tuner) 170887d1a50cSMatti Aaltonen { 170987d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 171087d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 171187d1a50cSMatti Aaltonen int r = 0; 171287d1a50cSMatti Aaltonen 171387d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 171487d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->index: %d\n", tuner->index); 171587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->name: %s\n", tuner->name); 171687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->capability: 0x%04x\n", tuner->capability); 171787d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->rxsubchans: 0x%04x\n", tuner->rxsubchans); 171887d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->rangelow: %d\n", tuner->rangelow); 171987d1a50cSMatti Aaltonen dev_dbg(radio->dev, "tuner->rangehigh: %d\n", tuner->rangehigh); 172087d1a50cSMatti Aaltonen 172187d1a50cSMatti Aaltonen if (tuner->index > 0) 172287d1a50cSMatti Aaltonen return -EINVAL; 172387d1a50cSMatti Aaltonen 172487d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 172587d1a50cSMatti Aaltonen return -EINTR; 172687d1a50cSMatti Aaltonen 172787d1a50cSMatti Aaltonen r = wl1273_fm_set_mode(radio, WL1273_MODE_RX); 172887d1a50cSMatti Aaltonen if (r) 172987d1a50cSMatti Aaltonen goto out; 173087d1a50cSMatti Aaltonen 173187d1a50cSMatti Aaltonen if (tuner->rxsubchans & V4L2_TUNER_SUB_RDS) 173287d1a50cSMatti Aaltonen r = wl1273_fm_set_rds(radio, WL1273_RDS_ON); 173387d1a50cSMatti Aaltonen else 173487d1a50cSMatti Aaltonen r = wl1273_fm_set_rds(radio, WL1273_RDS_OFF); 173587d1a50cSMatti Aaltonen 173687d1a50cSMatti Aaltonen if (r) 173787d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: RDS fails: %d\n", __func__, r); 173887d1a50cSMatti Aaltonen 173987d1a50cSMatti Aaltonen if (tuner->audmode == V4L2_TUNER_MODE_MONO) { 174087d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MOST_MODE_SET, 174187d1a50cSMatti Aaltonen WL1273_RX_MONO); 174287d1a50cSMatti Aaltonen if (r < 0) { 174387d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: MOST_MODE fails: %d\n", 174487d1a50cSMatti Aaltonen __func__, r); 174587d1a50cSMatti Aaltonen goto out; 174687d1a50cSMatti Aaltonen } 174787d1a50cSMatti Aaltonen radio->stereo = false; 174887d1a50cSMatti Aaltonen } else if (tuner->audmode == V4L2_TUNER_MODE_STEREO) { 174987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MOST_MODE_SET, 175087d1a50cSMatti Aaltonen WL1273_RX_STEREO); 175187d1a50cSMatti Aaltonen if (r < 0) { 175287d1a50cSMatti Aaltonen dev_warn(radio->dev, "%s: MOST_MODE fails: %d\n", 175387d1a50cSMatti Aaltonen __func__, r); 175487d1a50cSMatti Aaltonen goto out; 175587d1a50cSMatti Aaltonen } 175687d1a50cSMatti Aaltonen radio->stereo = true; 175787d1a50cSMatti Aaltonen } else { 175887d1a50cSMatti Aaltonen dev_err(radio->dev, "%s: tuner->audmode: %d\n", 175987d1a50cSMatti Aaltonen __func__, tuner->audmode); 176087d1a50cSMatti Aaltonen r = -EINVAL; 176187d1a50cSMatti Aaltonen goto out; 176287d1a50cSMatti Aaltonen } 176387d1a50cSMatti Aaltonen 176487d1a50cSMatti Aaltonen out: 176587d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 176687d1a50cSMatti Aaltonen 176787d1a50cSMatti Aaltonen return r; 176887d1a50cSMatti Aaltonen } 176987d1a50cSMatti Aaltonen 177087d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_g_frequency(struct file *file, void *priv, 177187d1a50cSMatti Aaltonen struct v4l2_frequency *freq) 177287d1a50cSMatti Aaltonen { 177387d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 177487d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 177587d1a50cSMatti Aaltonen 177687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 177787d1a50cSMatti Aaltonen 177887d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 177987d1a50cSMatti Aaltonen return -EINTR; 178087d1a50cSMatti Aaltonen 178187d1a50cSMatti Aaltonen freq->type = V4L2_TUNER_RADIO; 178287d1a50cSMatti Aaltonen freq->frequency = WL1273_FREQ(wl1273_fm_get_freq(radio)); 178387d1a50cSMatti Aaltonen 178487d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 178587d1a50cSMatti Aaltonen 178687d1a50cSMatti Aaltonen return 0; 178787d1a50cSMatti Aaltonen } 178887d1a50cSMatti Aaltonen 178987d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_frequency(struct file *file, void *priv, 179087d1a50cSMatti Aaltonen struct v4l2_frequency *freq) 179187d1a50cSMatti Aaltonen { 179287d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 179387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 179487d1a50cSMatti Aaltonen int r; 179587d1a50cSMatti Aaltonen 179687d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s: %d\n", __func__, freq->frequency); 179787d1a50cSMatti Aaltonen 179887d1a50cSMatti Aaltonen if (freq->type != V4L2_TUNER_RADIO) { 179987d1a50cSMatti Aaltonen dev_dbg(radio->dev, 180087d1a50cSMatti Aaltonen "freq->type != V4L2_TUNER_RADIO: %d\n", freq->type); 180187d1a50cSMatti Aaltonen return -EINVAL; 180287d1a50cSMatti Aaltonen } 180387d1a50cSMatti Aaltonen 180487d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 180587d1a50cSMatti Aaltonen return -EINTR; 180687d1a50cSMatti Aaltonen 180787d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_RX) { 180887d1a50cSMatti Aaltonen dev_dbg(radio->dev, "freq: %d\n", freq->frequency); 180987d1a50cSMatti Aaltonen 181087d1a50cSMatti Aaltonen r = wl1273_fm_set_rx_freq(radio, 181187d1a50cSMatti Aaltonen WL1273_INV_FREQ(freq->frequency)); 181287d1a50cSMatti Aaltonen if (r) 181387d1a50cSMatti Aaltonen dev_warn(radio->dev, WL1273_FM_DRIVER_NAME 181487d1a50cSMatti Aaltonen ": set frequency failed with %d\n", r); 181587d1a50cSMatti Aaltonen } else { 181687d1a50cSMatti Aaltonen r = wl1273_fm_set_tx_freq(radio, 181787d1a50cSMatti Aaltonen WL1273_INV_FREQ(freq->frequency)); 181887d1a50cSMatti Aaltonen if (r) 181987d1a50cSMatti Aaltonen dev_warn(radio->dev, WL1273_FM_DRIVER_NAME 182087d1a50cSMatti Aaltonen ": set frequency failed with %d\n", r); 182187d1a50cSMatti Aaltonen } 182287d1a50cSMatti Aaltonen 182387d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 182487d1a50cSMatti Aaltonen 182587d1a50cSMatti Aaltonen dev_dbg(radio->dev, "wl1273_vidioc_s_frequency: DONE\n"); 182687d1a50cSMatti Aaltonen return r; 182787d1a50cSMatti Aaltonen } 182887d1a50cSMatti Aaltonen 182987d1a50cSMatti Aaltonen #define WL1273_DEFAULT_SEEK_LEVEL 7 183087d1a50cSMatti Aaltonen 183187d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_hw_freq_seek(struct file *file, void *priv, 183287d1a50cSMatti Aaltonen struct v4l2_hw_freq_seek *seek) 183387d1a50cSMatti Aaltonen { 183487d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 183587d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 183687d1a50cSMatti Aaltonen int r; 183787d1a50cSMatti Aaltonen 183887d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 183987d1a50cSMatti Aaltonen 184087d1a50cSMatti Aaltonen if (seek->tuner != 0 || seek->type != V4L2_TUNER_RADIO) 184187d1a50cSMatti Aaltonen return -EINVAL; 184287d1a50cSMatti Aaltonen 184387d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 184487d1a50cSMatti Aaltonen return -EINTR; 184587d1a50cSMatti Aaltonen 184687d1a50cSMatti Aaltonen r = wl1273_fm_set_mode(radio, WL1273_MODE_RX); 184787d1a50cSMatti Aaltonen if (r) 184887d1a50cSMatti Aaltonen goto out; 184987d1a50cSMatti Aaltonen 185087d1a50cSMatti Aaltonen r = wl1273_fm_tx_set_spacing(radio, seek->spacing); 185187d1a50cSMatti Aaltonen if (r) 185287d1a50cSMatti Aaltonen dev_warn(radio->dev, "HW seek failed: %d\n", r); 185387d1a50cSMatti Aaltonen 185487d1a50cSMatti Aaltonen r = wl1273_fm_set_seek(radio, seek->wrap_around, seek->seek_upward, 185587d1a50cSMatti Aaltonen WL1273_DEFAULT_SEEK_LEVEL); 185687d1a50cSMatti Aaltonen if (r) 185787d1a50cSMatti Aaltonen dev_warn(radio->dev, "HW seek failed: %d\n", r); 185887d1a50cSMatti Aaltonen 185987d1a50cSMatti Aaltonen out: 186087d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 186187d1a50cSMatti Aaltonen return r; 186287d1a50cSMatti Aaltonen } 186387d1a50cSMatti Aaltonen 186487d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_s_modulator(struct file *file, void *priv, 186587d1a50cSMatti Aaltonen struct v4l2_modulator *modulator) 186687d1a50cSMatti Aaltonen { 186787d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 186887d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 186987d1a50cSMatti Aaltonen int r = 0; 187087d1a50cSMatti Aaltonen 187187d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 187287d1a50cSMatti Aaltonen 187387d1a50cSMatti Aaltonen if (modulator->index > 0) 187487d1a50cSMatti Aaltonen return -EINVAL; 187587d1a50cSMatti Aaltonen 187687d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 187787d1a50cSMatti Aaltonen return -EINTR; 187887d1a50cSMatti Aaltonen 187987d1a50cSMatti Aaltonen r = wl1273_fm_set_mode(radio, WL1273_MODE_TX); 188087d1a50cSMatti Aaltonen if (r) 188187d1a50cSMatti Aaltonen goto out; 188287d1a50cSMatti Aaltonen 188387d1a50cSMatti Aaltonen if (modulator->txsubchans & V4L2_TUNER_SUB_RDS) 188487d1a50cSMatti Aaltonen r = wl1273_fm_set_rds(radio, WL1273_RDS_ON); 188587d1a50cSMatti Aaltonen else 188687d1a50cSMatti Aaltonen r = wl1273_fm_set_rds(radio, WL1273_RDS_OFF); 188787d1a50cSMatti Aaltonen 188887d1a50cSMatti Aaltonen if (modulator->txsubchans & V4L2_TUNER_SUB_MONO) 188987d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MONO_SET, WL1273_TX_MONO); 189087d1a50cSMatti Aaltonen else 189187d1a50cSMatti Aaltonen r = wl1273_fm_write_cmd(core, WL1273_MONO_SET, 189287d1a50cSMatti Aaltonen WL1273_RX_STEREO); 189387d1a50cSMatti Aaltonen if (r < 0) 189487d1a50cSMatti Aaltonen dev_warn(radio->dev, WL1273_FM_DRIVER_NAME 189587d1a50cSMatti Aaltonen "MONO_SET fails: %d\n", r); 189687d1a50cSMatti Aaltonen out: 189787d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 189887d1a50cSMatti Aaltonen 189987d1a50cSMatti Aaltonen return r; 190087d1a50cSMatti Aaltonen } 190187d1a50cSMatti Aaltonen 190287d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_g_modulator(struct file *file, void *priv, 190387d1a50cSMatti Aaltonen struct v4l2_modulator *modulator) 190487d1a50cSMatti Aaltonen { 190587d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 190687d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 190787d1a50cSMatti Aaltonen u16 val; 190887d1a50cSMatti Aaltonen int r; 190987d1a50cSMatti Aaltonen 191087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "%s\n", __func__); 191187d1a50cSMatti Aaltonen 191287d1a50cSMatti Aaltonen strlcpy(modulator->name, WL1273_FM_DRIVER_NAME, 191387d1a50cSMatti Aaltonen sizeof(modulator->name)); 191487d1a50cSMatti Aaltonen 191587d1a50cSMatti Aaltonen modulator->rangelow = WL1273_FREQ(WL1273_BAND_JAPAN_LOW); 191687d1a50cSMatti Aaltonen modulator->rangehigh = WL1273_FREQ(WL1273_BAND_OTHER_HIGH); 191787d1a50cSMatti Aaltonen 191887d1a50cSMatti Aaltonen modulator->capability = V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_RDS | 191987d1a50cSMatti Aaltonen V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_RDS_BLOCK_IO; 192087d1a50cSMatti Aaltonen 192187d1a50cSMatti Aaltonen if (core->mode != WL1273_MODE_TX) 192287d1a50cSMatti Aaltonen return 0; 192387d1a50cSMatti Aaltonen 192487d1a50cSMatti Aaltonen if (mutex_lock_interruptible(&core->lock)) 192587d1a50cSMatti Aaltonen return -EINTR; 192687d1a50cSMatti Aaltonen 192787d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_MONO_SET, &val); 192887d1a50cSMatti Aaltonen if (r) 192987d1a50cSMatti Aaltonen goto out; 193087d1a50cSMatti Aaltonen 193187d1a50cSMatti Aaltonen if (val == WL1273_TX_STEREO) 193287d1a50cSMatti Aaltonen modulator->txsubchans = V4L2_TUNER_SUB_STEREO; 193387d1a50cSMatti Aaltonen else 193487d1a50cSMatti Aaltonen modulator->txsubchans = V4L2_TUNER_SUB_MONO; 193587d1a50cSMatti Aaltonen 193687d1a50cSMatti Aaltonen if (radio->rds_on) 193787d1a50cSMatti Aaltonen modulator->txsubchans |= V4L2_TUNER_SUB_RDS; 193887d1a50cSMatti Aaltonen out: 193987d1a50cSMatti Aaltonen mutex_unlock(&core->lock); 194087d1a50cSMatti Aaltonen 194187d1a50cSMatti Aaltonen return 0; 194287d1a50cSMatti Aaltonen } 194387d1a50cSMatti Aaltonen 194487d1a50cSMatti Aaltonen static int wl1273_fm_vidioc_log_status(struct file *file, void *priv) 194587d1a50cSMatti Aaltonen { 194687d1a50cSMatti Aaltonen struct wl1273_device *radio = video_get_drvdata(video_devdata(file)); 194787d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 194887d1a50cSMatti Aaltonen struct device *dev = radio->dev; 194987d1a50cSMatti Aaltonen u16 val; 195087d1a50cSMatti Aaltonen int r; 195187d1a50cSMatti Aaltonen 195287d1a50cSMatti Aaltonen dev_info(dev, DRIVER_DESC); 195387d1a50cSMatti Aaltonen 195487d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_OFF) { 195587d1a50cSMatti Aaltonen dev_info(dev, "Mode: Off\n"); 195687d1a50cSMatti Aaltonen return 0; 195787d1a50cSMatti Aaltonen } 195887d1a50cSMatti Aaltonen 195987d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_SUSPENDED) { 196087d1a50cSMatti Aaltonen dev_info(dev, "Mode: Suspended\n"); 196187d1a50cSMatti Aaltonen return 0; 196287d1a50cSMatti Aaltonen } 196387d1a50cSMatti Aaltonen 196487d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_ASIC_ID_GET, &val); 196587d1a50cSMatti Aaltonen if (r) 196687d1a50cSMatti Aaltonen dev_err(dev, "%s: Get ASIC_ID fails.\n", __func__); 196787d1a50cSMatti Aaltonen else 196887d1a50cSMatti Aaltonen dev_info(dev, "ASIC_ID: 0x%04x\n", val); 196987d1a50cSMatti Aaltonen 197087d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_ASIC_VER_GET, &val); 197187d1a50cSMatti Aaltonen if (r) 197287d1a50cSMatti Aaltonen dev_err(dev, "%s: Get ASIC_VER fails.\n", __func__); 197387d1a50cSMatti Aaltonen else 197487d1a50cSMatti Aaltonen dev_info(dev, "ASIC Version: 0x%04x\n", val); 197587d1a50cSMatti Aaltonen 197687d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_FIRM_VER_GET, &val); 197787d1a50cSMatti Aaltonen if (r) 197887d1a50cSMatti Aaltonen dev_err(dev, "%s: Get FIRM_VER fails.\n", __func__); 197987d1a50cSMatti Aaltonen else 198087d1a50cSMatti Aaltonen dev_info(dev, "FW version: %d(0x%04x)\n", val, val); 198187d1a50cSMatti Aaltonen 198287d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_BAND_SET, &val); 198387d1a50cSMatti Aaltonen if (r) 198487d1a50cSMatti Aaltonen dev_err(dev, "%s: Get BAND fails.\n", __func__); 198587d1a50cSMatti Aaltonen else 198687d1a50cSMatti Aaltonen dev_info(dev, "BAND: %d\n", val); 198787d1a50cSMatti Aaltonen 198887d1a50cSMatti Aaltonen if (core->mode == WL1273_MODE_TX) { 198987d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_PUPD_SET, &val); 199087d1a50cSMatti Aaltonen if (r) 199187d1a50cSMatti Aaltonen dev_err(dev, "%s: Get PUPD fails.\n", __func__); 199287d1a50cSMatti Aaltonen else 199387d1a50cSMatti Aaltonen dev_info(dev, "PUPD: 0x%04x\n", val); 199487d1a50cSMatti Aaltonen 199587d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_CHANL_SET, &val); 199687d1a50cSMatti Aaltonen if (r) 199787d1a50cSMatti Aaltonen dev_err(dev, "%s: Get CHANL fails.\n", __func__); 199887d1a50cSMatti Aaltonen else 199987d1a50cSMatti Aaltonen dev_info(dev, "Tx frequency: %dkHz\n", val*10); 200087d1a50cSMatti Aaltonen } else if (core->mode == WL1273_MODE_RX) { 200187d1a50cSMatti Aaltonen int bf = radio->rangelow; 200287d1a50cSMatti Aaltonen 200387d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_FREQ_SET, &val); 200487d1a50cSMatti Aaltonen if (r) 200587d1a50cSMatti Aaltonen dev_err(dev, "%s: Get FREQ fails.\n", __func__); 200687d1a50cSMatti Aaltonen else 200787d1a50cSMatti Aaltonen dev_info(dev, "RX Frequency: %dkHz\n", bf + val*50); 200887d1a50cSMatti Aaltonen 200987d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_MOST_MODE_SET, &val); 201087d1a50cSMatti Aaltonen if (r) 201187d1a50cSMatti Aaltonen dev_err(dev, "%s: Get MOST_MODE fails.\n", 201287d1a50cSMatti Aaltonen __func__); 201387d1a50cSMatti Aaltonen else if (val == 0) 201487d1a50cSMatti Aaltonen dev_info(dev, "MOST_MODE: Stereo according to blend\n"); 201587d1a50cSMatti Aaltonen else if (val == 1) 201687d1a50cSMatti Aaltonen dev_info(dev, "MOST_MODE: Force mono output\n"); 201787d1a50cSMatti Aaltonen else 201887d1a50cSMatti Aaltonen dev_info(dev, "MOST_MODE: Unexpected value: %d\n", val); 201987d1a50cSMatti Aaltonen 202087d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_MOST_BLEND_SET, &val); 202187d1a50cSMatti Aaltonen if (r) 202287d1a50cSMatti Aaltonen dev_err(dev, "%s: Get MOST_BLEND fails.\n", __func__); 202387d1a50cSMatti Aaltonen else if (val == 0) 202487d1a50cSMatti Aaltonen dev_info(dev, 202587d1a50cSMatti Aaltonen "MOST_BLEND: Switched blend & hysteresis.\n"); 202687d1a50cSMatti Aaltonen else if (val == 1) 202787d1a50cSMatti Aaltonen dev_info(dev, "MOST_BLEND: Soft blend.\n"); 202887d1a50cSMatti Aaltonen else 202987d1a50cSMatti Aaltonen dev_info(dev, "MOST_BLEND: Unexpected val: %d\n", val); 203087d1a50cSMatti Aaltonen 203187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_STEREO_GET, &val); 203287d1a50cSMatti Aaltonen if (r) 203387d1a50cSMatti Aaltonen dev_err(dev, "%s: Get STEREO fails.\n", __func__); 203487d1a50cSMatti Aaltonen else if (val == 0) 203587d1a50cSMatti Aaltonen dev_info(dev, "STEREO: Not detected\n"); 203687d1a50cSMatti Aaltonen else if (val == 1) 203787d1a50cSMatti Aaltonen dev_info(dev, "STEREO: Detected\n"); 203887d1a50cSMatti Aaltonen else 203987d1a50cSMatti Aaltonen dev_info(dev, "STEREO: Unexpected value: %d\n", val); 204087d1a50cSMatti Aaltonen 204187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RSSI_LVL_GET, &val); 204287d1a50cSMatti Aaltonen if (r) 204387d1a50cSMatti Aaltonen dev_err(dev, "%s: Get RSSI_LVL fails.\n", __func__); 204487d1a50cSMatti Aaltonen else 204587d1a50cSMatti Aaltonen dev_info(dev, "RX signal strength: %d\n", (s16) val); 204687d1a50cSMatti Aaltonen 204787d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_POWER_SET, &val); 204887d1a50cSMatti Aaltonen if (r) 204987d1a50cSMatti Aaltonen dev_err(dev, "%s: Get POWER fails.\n", __func__); 205087d1a50cSMatti Aaltonen else 205187d1a50cSMatti Aaltonen dev_info(dev, "POWER: 0x%04x\n", val); 205287d1a50cSMatti Aaltonen 205387d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_INT_MASK_SET, &val); 205487d1a50cSMatti Aaltonen if (r) 205587d1a50cSMatti Aaltonen dev_err(dev, "%s: Get INT_MASK fails.\n", __func__); 205687d1a50cSMatti Aaltonen else 205787d1a50cSMatti Aaltonen dev_info(dev, "INT_MASK: 0x%04x\n", val); 205887d1a50cSMatti Aaltonen 205987d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_RDS_SYNC_GET, &val); 206087d1a50cSMatti Aaltonen if (r) 206187d1a50cSMatti Aaltonen dev_err(dev, "%s: Get RDS_SYNC fails.\n", 206287d1a50cSMatti Aaltonen __func__); 206387d1a50cSMatti Aaltonen else if (val == 0) 206487d1a50cSMatti Aaltonen dev_info(dev, "RDS_SYNC: Not synchronized\n"); 206587d1a50cSMatti Aaltonen 206687d1a50cSMatti Aaltonen else if (val == 1) 206787d1a50cSMatti Aaltonen dev_info(dev, "RDS_SYNC: Synchronized\n"); 206887d1a50cSMatti Aaltonen else 206987d1a50cSMatti Aaltonen dev_info(dev, "RDS_SYNC: Unexpected value: %d\n", val); 207087d1a50cSMatti Aaltonen 207187d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_I2S_MODE_CONFIG_SET, &val); 207287d1a50cSMatti Aaltonen if (r) 207387d1a50cSMatti Aaltonen dev_err(dev, "%s: Get I2S_MODE_CONFIG fails.\n", 207487d1a50cSMatti Aaltonen __func__); 207587d1a50cSMatti Aaltonen else 207687d1a50cSMatti Aaltonen dev_info(dev, "I2S_MODE_CONFIG: 0x%04x\n", val); 207787d1a50cSMatti Aaltonen 207887d1a50cSMatti Aaltonen r = wl1273_fm_read_reg(core, WL1273_VOLUME_SET, &val); 207987d1a50cSMatti Aaltonen if (r) 208087d1a50cSMatti Aaltonen dev_err(dev, "%s: Get VOLUME fails.\n", __func__); 208187d1a50cSMatti Aaltonen else 208287d1a50cSMatti Aaltonen dev_info(dev, "VOLUME: 0x%04x\n", val); 208387d1a50cSMatti Aaltonen } 208487d1a50cSMatti Aaltonen 208587d1a50cSMatti Aaltonen return 0; 208687d1a50cSMatti Aaltonen } 208787d1a50cSMatti Aaltonen 208887d1a50cSMatti Aaltonen static void wl1273_vdev_release(struct video_device *dev) 208987d1a50cSMatti Aaltonen { 209087d1a50cSMatti Aaltonen } 209187d1a50cSMatti Aaltonen 209287d1a50cSMatti Aaltonen static const struct v4l2_ctrl_ops wl1273_ctrl_ops = { 209387d1a50cSMatti Aaltonen .s_ctrl = wl1273_fm_vidioc_s_ctrl, 209487d1a50cSMatti Aaltonen .g_volatile_ctrl = wl1273_fm_g_volatile_ctrl, 209587d1a50cSMatti Aaltonen }; 209687d1a50cSMatti Aaltonen 209787d1a50cSMatti Aaltonen static const struct v4l2_ioctl_ops wl1273_ioctl_ops = { 209887d1a50cSMatti Aaltonen .vidioc_querycap = wl1273_fm_vidioc_querycap, 209987d1a50cSMatti Aaltonen .vidioc_g_input = wl1273_fm_vidioc_g_input, 210087d1a50cSMatti Aaltonen .vidioc_s_input = wl1273_fm_vidioc_s_input, 210187d1a50cSMatti Aaltonen .vidioc_g_audio = wl1273_fm_vidioc_g_audio, 210287d1a50cSMatti Aaltonen .vidioc_s_audio = wl1273_fm_vidioc_s_audio, 210387d1a50cSMatti Aaltonen .vidioc_g_tuner = wl1273_fm_vidioc_g_tuner, 210487d1a50cSMatti Aaltonen .vidioc_s_tuner = wl1273_fm_vidioc_s_tuner, 210587d1a50cSMatti Aaltonen .vidioc_g_frequency = wl1273_fm_vidioc_g_frequency, 210687d1a50cSMatti Aaltonen .vidioc_s_frequency = wl1273_fm_vidioc_s_frequency, 210787d1a50cSMatti Aaltonen .vidioc_s_hw_freq_seek = wl1273_fm_vidioc_s_hw_freq_seek, 210887d1a50cSMatti Aaltonen .vidioc_g_modulator = wl1273_fm_vidioc_g_modulator, 210987d1a50cSMatti Aaltonen .vidioc_s_modulator = wl1273_fm_vidioc_s_modulator, 211087d1a50cSMatti Aaltonen .vidioc_log_status = wl1273_fm_vidioc_log_status, 211187d1a50cSMatti Aaltonen }; 211287d1a50cSMatti Aaltonen 211387d1a50cSMatti Aaltonen static struct video_device wl1273_viddev_template = { 211487d1a50cSMatti Aaltonen .fops = &wl1273_fops, 211587d1a50cSMatti Aaltonen .ioctl_ops = &wl1273_ioctl_ops, 211687d1a50cSMatti Aaltonen .name = WL1273_FM_DRIVER_NAME, 211787d1a50cSMatti Aaltonen .release = wl1273_vdev_release, 211887d1a50cSMatti Aaltonen }; 211987d1a50cSMatti Aaltonen 212087d1a50cSMatti Aaltonen static int wl1273_fm_radio_remove(struct platform_device *pdev) 212187d1a50cSMatti Aaltonen { 212287d1a50cSMatti Aaltonen struct wl1273_device *radio = platform_get_drvdata(pdev); 212387d1a50cSMatti Aaltonen struct wl1273_core *core = radio->core; 212487d1a50cSMatti Aaltonen 212587d1a50cSMatti Aaltonen dev_info(&pdev->dev, "%s.\n", __func__); 212687d1a50cSMatti Aaltonen 212787d1a50cSMatti Aaltonen free_irq(core->client->irq, radio); 212887d1a50cSMatti Aaltonen core->pdata->free_resources(); 212987d1a50cSMatti Aaltonen 213087d1a50cSMatti Aaltonen v4l2_ctrl_handler_free(&radio->ctrl_handler); 213187d1a50cSMatti Aaltonen video_unregister_device(&radio->videodev); 213287d1a50cSMatti Aaltonen v4l2_device_unregister(&radio->v4l2dev); 213387d1a50cSMatti Aaltonen kfree(radio->buffer); 213487d1a50cSMatti Aaltonen kfree(radio->write_buf); 213587d1a50cSMatti Aaltonen kfree(radio); 213687d1a50cSMatti Aaltonen 213787d1a50cSMatti Aaltonen return 0; 213887d1a50cSMatti Aaltonen } 213987d1a50cSMatti Aaltonen 214087d1a50cSMatti Aaltonen static int __devinit wl1273_fm_radio_probe(struct platform_device *pdev) 214187d1a50cSMatti Aaltonen { 214287d1a50cSMatti Aaltonen struct wl1273_core **core = pdev->dev.platform_data; 214387d1a50cSMatti Aaltonen struct wl1273_device *radio; 214487d1a50cSMatti Aaltonen struct v4l2_ctrl *ctrl; 214587d1a50cSMatti Aaltonen int r = 0; 214687d1a50cSMatti Aaltonen 214787d1a50cSMatti Aaltonen pr_debug("%s\n", __func__); 214887d1a50cSMatti Aaltonen 214987d1a50cSMatti Aaltonen if (!core) { 215087d1a50cSMatti Aaltonen dev_err(&pdev->dev, "No platform data.\n"); 215187d1a50cSMatti Aaltonen r = -EINVAL; 215287d1a50cSMatti Aaltonen goto pdata_err; 215387d1a50cSMatti Aaltonen } 215487d1a50cSMatti Aaltonen 215587d1a50cSMatti Aaltonen radio = kzalloc(sizeof(*radio), GFP_KERNEL); 215687d1a50cSMatti Aaltonen if (!radio) { 215787d1a50cSMatti Aaltonen r = -ENOMEM; 215887d1a50cSMatti Aaltonen goto pdata_err; 215987d1a50cSMatti Aaltonen } 216087d1a50cSMatti Aaltonen 216187d1a50cSMatti Aaltonen /* RDS buffer allocation */ 216287d1a50cSMatti Aaltonen radio->buf_size = rds_buf * RDS_BLOCK_SIZE; 216387d1a50cSMatti Aaltonen radio->buffer = kmalloc(radio->buf_size, GFP_KERNEL); 216487d1a50cSMatti Aaltonen if (!radio->buffer) { 216587d1a50cSMatti Aaltonen pr_err("Cannot allocate memory for RDS buffer.\n"); 216687d1a50cSMatti Aaltonen r = -ENOMEM; 216787d1a50cSMatti Aaltonen goto err_kmalloc; 216887d1a50cSMatti Aaltonen } 216987d1a50cSMatti Aaltonen 217087d1a50cSMatti Aaltonen radio->core = *core; 217187d1a50cSMatti Aaltonen radio->irq_flags = WL1273_IRQ_MASK; 217287d1a50cSMatti Aaltonen radio->dev = &radio->core->client->dev; 217387d1a50cSMatti Aaltonen radio->rds_on = false; 217487d1a50cSMatti Aaltonen radio->core->mode = WL1273_MODE_OFF; 217587d1a50cSMatti Aaltonen radio->tx_power = 118; 217687d1a50cSMatti Aaltonen radio->core->audio_mode = WL1273_AUDIO_ANALOG; 217787d1a50cSMatti Aaltonen radio->band = WL1273_BAND_OTHER; 217887d1a50cSMatti Aaltonen radio->core->i2s_mode = WL1273_I2S_DEF_MODE; 217987d1a50cSMatti Aaltonen radio->core->channel_number = 2; 218087d1a50cSMatti Aaltonen radio->core->volume = WL1273_DEFAULT_VOLUME; 218187d1a50cSMatti Aaltonen radio->rx_frequency = WL1273_BAND_OTHER_LOW; 218287d1a50cSMatti Aaltonen radio->tx_frequency = WL1273_BAND_OTHER_HIGH; 218387d1a50cSMatti Aaltonen radio->rangelow = WL1273_BAND_OTHER_LOW; 218487d1a50cSMatti Aaltonen radio->rangehigh = WL1273_BAND_OTHER_HIGH; 218587d1a50cSMatti Aaltonen radio->stereo = true; 218687d1a50cSMatti Aaltonen radio->bus_type = "I2C"; 218787d1a50cSMatti Aaltonen 218887d1a50cSMatti Aaltonen radio->core->write = wl1273_fm_write_cmd; 218987d1a50cSMatti Aaltonen radio->core->set_audio = wl1273_fm_set_audio; 219087d1a50cSMatti Aaltonen radio->core->set_volume = wl1273_fm_set_volume; 219187d1a50cSMatti Aaltonen 219287d1a50cSMatti Aaltonen if (radio->core->pdata->request_resources) { 219387d1a50cSMatti Aaltonen r = radio->core->pdata->request_resources(radio->core->client); 219487d1a50cSMatti Aaltonen if (r) { 219587d1a50cSMatti Aaltonen dev_err(radio->dev, WL1273_FM_DRIVER_NAME 219687d1a50cSMatti Aaltonen ": Cannot get platform data\n"); 219787d1a50cSMatti Aaltonen goto err_resources; 219887d1a50cSMatti Aaltonen } 219987d1a50cSMatti Aaltonen 220087d1a50cSMatti Aaltonen dev_dbg(radio->dev, "irq: %d\n", radio->core->client->irq); 220187d1a50cSMatti Aaltonen 220287d1a50cSMatti Aaltonen r = request_threaded_irq(radio->core->client->irq, NULL, 220387d1a50cSMatti Aaltonen wl1273_fm_irq_thread_handler, 220487d1a50cSMatti Aaltonen IRQF_ONESHOT | IRQF_TRIGGER_FALLING, 220587d1a50cSMatti Aaltonen "wl1273-fm", radio); 220687d1a50cSMatti Aaltonen if (r < 0) { 220787d1a50cSMatti Aaltonen dev_err(radio->dev, WL1273_FM_DRIVER_NAME 220887d1a50cSMatti Aaltonen ": Unable to register IRQ handler: %d\n", r); 220987d1a50cSMatti Aaltonen goto err_request_irq; 221087d1a50cSMatti Aaltonen } 221187d1a50cSMatti Aaltonen } else { 221287d1a50cSMatti Aaltonen dev_err(radio->dev, WL1273_FM_DRIVER_NAME ": Core WL1273 IRQ" 221387d1a50cSMatti Aaltonen " not configured"); 221487d1a50cSMatti Aaltonen r = -EINVAL; 221587d1a50cSMatti Aaltonen goto err_resources; 221687d1a50cSMatti Aaltonen } 221787d1a50cSMatti Aaltonen 221887d1a50cSMatti Aaltonen init_completion(&radio->busy); 221987d1a50cSMatti Aaltonen init_waitqueue_head(&radio->read_queue); 222087d1a50cSMatti Aaltonen 222187d1a50cSMatti Aaltonen radio->write_buf = kmalloc(256, GFP_KERNEL); 222287d1a50cSMatti Aaltonen if (!radio->write_buf) { 222387d1a50cSMatti Aaltonen r = -ENOMEM; 222487d1a50cSMatti Aaltonen goto write_buf_err; 222587d1a50cSMatti Aaltonen } 222687d1a50cSMatti Aaltonen 222787d1a50cSMatti Aaltonen radio->dev = &pdev->dev; 222887d1a50cSMatti Aaltonen radio->v4l2dev.ctrl_handler = &radio->ctrl_handler; 222987d1a50cSMatti Aaltonen radio->rds_users = 0; 223087d1a50cSMatti Aaltonen 223187d1a50cSMatti Aaltonen r = v4l2_device_register(&pdev->dev, &radio->v4l2dev); 223287d1a50cSMatti Aaltonen if (r) { 223387d1a50cSMatti Aaltonen dev_err(&pdev->dev, "Cannot register v4l2_device.\n"); 223487d1a50cSMatti Aaltonen goto device_register_err; 223587d1a50cSMatti Aaltonen } 223687d1a50cSMatti Aaltonen 223787d1a50cSMatti Aaltonen /* V4L2 configuration */ 223887d1a50cSMatti Aaltonen memcpy(&radio->videodev, &wl1273_viddev_template, 223987d1a50cSMatti Aaltonen sizeof(wl1273_viddev_template)); 224087d1a50cSMatti Aaltonen 224187d1a50cSMatti Aaltonen radio->videodev.v4l2_dev = &radio->v4l2dev; 224287d1a50cSMatti Aaltonen 224387d1a50cSMatti Aaltonen v4l2_ctrl_handler_init(&radio->ctrl_handler, 6); 224487d1a50cSMatti Aaltonen 224587d1a50cSMatti Aaltonen /* add in ascending ID order */ 224687d1a50cSMatti Aaltonen v4l2_ctrl_new_std(&radio->ctrl_handler, &wl1273_ctrl_ops, 224787d1a50cSMatti Aaltonen V4L2_CID_AUDIO_VOLUME, 0, WL1273_MAX_VOLUME, 1, 224887d1a50cSMatti Aaltonen WL1273_DEFAULT_VOLUME); 224987d1a50cSMatti Aaltonen 225087d1a50cSMatti Aaltonen v4l2_ctrl_new_std(&radio->ctrl_handler, &wl1273_ctrl_ops, 225187d1a50cSMatti Aaltonen V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); 225287d1a50cSMatti Aaltonen 225387d1a50cSMatti Aaltonen v4l2_ctrl_new_std_menu(&radio->ctrl_handler, &wl1273_ctrl_ops, 225487d1a50cSMatti Aaltonen V4L2_CID_TUNE_PREEMPHASIS, 225587d1a50cSMatti Aaltonen V4L2_PREEMPHASIS_75_uS, 0x03, 225687d1a50cSMatti Aaltonen V4L2_PREEMPHASIS_50_uS); 225787d1a50cSMatti Aaltonen 225887d1a50cSMatti Aaltonen v4l2_ctrl_new_std(&radio->ctrl_handler, &wl1273_ctrl_ops, 225987d1a50cSMatti Aaltonen V4L2_CID_TUNE_POWER_LEVEL, 91, 122, 1, 118); 226087d1a50cSMatti Aaltonen 226187d1a50cSMatti Aaltonen ctrl = v4l2_ctrl_new_std(&radio->ctrl_handler, &wl1273_ctrl_ops, 226287d1a50cSMatti Aaltonen V4L2_CID_TUNE_ANTENNA_CAPACITOR, 226387d1a50cSMatti Aaltonen 0, 255, 1, 255); 226487d1a50cSMatti Aaltonen if (ctrl) 226587d1a50cSMatti Aaltonen ctrl->is_volatile = 1; 226687d1a50cSMatti Aaltonen 226787d1a50cSMatti Aaltonen if (radio->ctrl_handler.error) { 226887d1a50cSMatti Aaltonen r = radio->ctrl_handler.error; 226987d1a50cSMatti Aaltonen dev_err(&pdev->dev, "Ctrl handler error: %d\n", r); 227087d1a50cSMatti Aaltonen goto handler_init_err; 227187d1a50cSMatti Aaltonen } 227287d1a50cSMatti Aaltonen 227387d1a50cSMatti Aaltonen video_set_drvdata(&radio->videodev, radio); 227487d1a50cSMatti Aaltonen platform_set_drvdata(pdev, radio); 227587d1a50cSMatti Aaltonen 227687d1a50cSMatti Aaltonen /* register video device */ 227787d1a50cSMatti Aaltonen r = video_register_device(&radio->videodev, VFL_TYPE_RADIO, radio_nr); 227887d1a50cSMatti Aaltonen if (r) { 227987d1a50cSMatti Aaltonen dev_err(&pdev->dev, WL1273_FM_DRIVER_NAME 228087d1a50cSMatti Aaltonen ": Could not register video device\n"); 228187d1a50cSMatti Aaltonen goto handler_init_err; 228287d1a50cSMatti Aaltonen } 228387d1a50cSMatti Aaltonen 228487d1a50cSMatti Aaltonen return 0; 228587d1a50cSMatti Aaltonen 228687d1a50cSMatti Aaltonen handler_init_err: 228787d1a50cSMatti Aaltonen v4l2_ctrl_handler_free(&radio->ctrl_handler); 228887d1a50cSMatti Aaltonen v4l2_device_unregister(&radio->v4l2dev); 228987d1a50cSMatti Aaltonen device_register_err: 229087d1a50cSMatti Aaltonen kfree(radio->write_buf); 229187d1a50cSMatti Aaltonen write_buf_err: 229287d1a50cSMatti Aaltonen free_irq(radio->core->client->irq, radio); 229387d1a50cSMatti Aaltonen err_request_irq: 229487d1a50cSMatti Aaltonen radio->core->pdata->free_resources(); 229587d1a50cSMatti Aaltonen err_resources: 229687d1a50cSMatti Aaltonen kfree(radio->buffer); 229787d1a50cSMatti Aaltonen err_kmalloc: 229887d1a50cSMatti Aaltonen kfree(radio); 229987d1a50cSMatti Aaltonen pdata_err: 230087d1a50cSMatti Aaltonen return r; 230187d1a50cSMatti Aaltonen } 230287d1a50cSMatti Aaltonen 230387d1a50cSMatti Aaltonen MODULE_ALIAS("platform:wl1273_fm_radio"); 230487d1a50cSMatti Aaltonen 230587d1a50cSMatti Aaltonen static struct platform_driver wl1273_fm_radio_driver = { 230687d1a50cSMatti Aaltonen .probe = wl1273_fm_radio_probe, 230787d1a50cSMatti Aaltonen .remove = __devexit_p(wl1273_fm_radio_remove), 230887d1a50cSMatti Aaltonen .driver = { 230987d1a50cSMatti Aaltonen .name = "wl1273_fm_radio", 231087d1a50cSMatti Aaltonen .owner = THIS_MODULE, 231187d1a50cSMatti Aaltonen }, 231287d1a50cSMatti Aaltonen }; 231387d1a50cSMatti Aaltonen 231487d1a50cSMatti Aaltonen static int __init wl1273_fm_module_init(void) 231587d1a50cSMatti Aaltonen { 231687d1a50cSMatti Aaltonen pr_info("%s\n", __func__); 231787d1a50cSMatti Aaltonen return platform_driver_register(&wl1273_fm_radio_driver); 231887d1a50cSMatti Aaltonen } 231987d1a50cSMatti Aaltonen module_init(wl1273_fm_module_init); 232087d1a50cSMatti Aaltonen 232187d1a50cSMatti Aaltonen static void __exit wl1273_fm_module_exit(void) 232287d1a50cSMatti Aaltonen { 232387d1a50cSMatti Aaltonen flush_scheduled_work(); 232487d1a50cSMatti Aaltonen platform_driver_unregister(&wl1273_fm_radio_driver); 232587d1a50cSMatti Aaltonen pr_info(DRIVER_DESC ", Exiting.\n"); 232687d1a50cSMatti Aaltonen } 232787d1a50cSMatti Aaltonen module_exit(wl1273_fm_module_exit); 232887d1a50cSMatti Aaltonen 232987d1a50cSMatti Aaltonen MODULE_AUTHOR("Matti Aaltonen <matti.j.aaltonen@nokia.com>"); 233087d1a50cSMatti Aaltonen MODULE_DESCRIPTION(DRIVER_DESC); 233187d1a50cSMatti Aaltonen MODULE_LICENSE("GPL"); 2332