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