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