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