Message ID | 1349488502-11293-4-git-send-email-andrey.smirnov@convergeddevices.net (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
On Sat October 6 2012 03:54:59 Andrey Smirnov wrote: > This patch adds all the functions used for exchanging commands with > the chip. > > Signed-off-by: Andrey Smirnov <andrey.smirnov@convergeddevices.net> > --- > drivers/mfd/si476x-cmd.c | 1493 ++++++++++++++++++++++++++++++++++++++++++++++ > 1 file changed, 1493 insertions(+) > create mode 100644 drivers/mfd/si476x-cmd.c > > diff --git a/drivers/mfd/si476x-cmd.c b/drivers/mfd/si476x-cmd.c > new file mode 100644 > index 0000000..f11cf58 > --- /dev/null > +++ b/drivers/mfd/si476x-cmd.c > @@ -0,0 +1,1493 @@ > +/* > + * include/media/si476x-cmd.c -- Subroutines implementing command > + * protocol of si476x series of chips > + * > + * Copyright (C) 2012 Innovative Converged Devices(ICD) > + * > + * Author: Andrey Smirnov <andrey.smirnov@convergeddevices.net> > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License as published by > + * the Free Software Foundation; version 2 of the License. > + * > + * This program is distributed in the hope that it will be useful, but > + * WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU > + * General Public License for more details. > + * > + */ > +#include <linux/module.h> > +#include <linux/completion.h> > +#include <linux/delay.h> > +#include <linux/atomic.h> > +#include <linux/i2c.h> > +#include <linux/device.h> > +#include <linux/gpio.h> > +#include <linux/videodev2.h> > + > +#include <media/si476x.h> > +#include <linux/mfd/si476x-core.h> > + > +#define msb(x) ((u8)((u16) x >> 8)) > +#define lsb(x) ((u8)((u16) x & 0x00FF)) > + > + > + > +#define CMD_POWER_UP 0x01 > +#define CMD_POWER_UP_A10_NRESP 1 > +#define CMD_POWER_UP_A10_NARGS 5 > + > +#define CMD_POWER_UP_A20_NRESP 1 > +#define CMD_POWER_UP_A20_NARGS 5 > + > +#define POWER_UP_DELAY_MS 110 > + > +#define CMD_POWER_DOWN 0x11 > +#define CMD_POWER_DOWN_A10_NRESP 1 > + > +#define CMD_POWER_DOWN_A20_NRESP 1 > +#define CMD_POWER_DOWN_A20_NARGS 1 > + > +#define CMD_FUNC_INFO 0x12 > +#define CMD_FUNC_INFO_NRESP 7 > + > +#define CMD_SET_PROPERTY 0x13 > +#define CMD_SET_PROPERTY_NARGS 5 > +#define CMD_SET_PROPERTY_NRESP 1 > + > +#define CMD_GET_PROPERTY 0x14 > +#define CMD_GET_PROPERTY_NARGS 3 > +#define CMD_GET_PROPERTY_NRESP 4 > + > +#define CMD_AGC_STATUS 0x17 > +#define CMD_AGC_STATUS_NRESP_A10 2 > +#define CMD_AGC_STATUS_NRESP_A20 6 > + > +#define PIN_CFG_BYTE(x) (0x7F & (x)) > +#define CMD_DIG_AUDIO_PIN_CFG 0x18 > +#define CMD_DIG_AUDIO_PIN_CFG_NARGS 4 > +#define CMD_DIG_AUDIO_PIN_CFG_NRESP 5 > + > +#define CMD_ZIF_PIN_CFG 0x19 > +#define CMD_ZIF_PIN_CFG_NARGS 4 > +#define CMD_ZIF_PIN_CFG_NRESP 5 > + > +#define CMD_IC_LINK_GPO_CTL_PIN_CFG 0x1A > +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS 4 > +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP 5 > + > +#define CMD_ANA_AUDIO_PIN_CFG 0x1B > +#define CMD_ANA_AUDIO_PIN_CFG_NARGS 1 > +#define CMD_ANA_AUDIO_PIN_CFG_NRESP 2 > + > +#define CMD_INTB_PIN_CFG 0x1C > +#define CMD_INTB_PIN_CFG_NARGS 2 > +#define CMD_INTB_PIN_CFG_A10_NRESP 6 > +#define CMD_INTB_PIN_CFG_A20_NRESP 3 > + > +#define CMD_FM_TUNE_FREQ 0x30 > +#define CMD_FM_TUNE_FREQ_A10_NARGS 5 > +#define CMD_FM_TUNE_FREQ_A20_NARGS 3 > +#define CMD_FM_TUNE_FREQ_NRESP 1 > + > +#define CMD_FM_RSQ_STATUS 0x32 > + > +#define CMD_FM_RSQ_STATUS_A10_NARGS 1 > +#define CMD_FM_RSQ_STATUS_A10_NRESP 17 > +#define CMD_FM_RSQ_STATUS_A30_NARGS 1 > +#define CMD_FM_RSQ_STATUS_A30_NRESP 23 > + > + > +#define CMD_FM_SEEK_START 0x31 > +#define CMD_FM_SEEK_START_NARGS 1 > +#define CMD_FM_SEEK_START_NRESP 1 > + > +#define CMD_FM_RDS_STATUS 0x36 > +#define CMD_FM_RDS_STATUS_NARGS 1 > +#define CMD_FM_RDS_STATUS_NRESP 16 > + > +#define CMD_FM_RDS_BLOCKCOUNT 0x37 > +#define CMD_FM_RDS_BLOCKCOUNT_NARGS 1 > +#define CMD_FM_RDS_BLOCKCOUNT_NRESP 8 > + > +#define CMD_FM_PHASE_DIVERSITY 0x38 > +#define CMD_FM_PHASE_DIVERSITY_NARGS 1 > +#define CMD_FM_PHASE_DIVERSITY_NRESP 1 > + > +#define CMD_FM_PHASE_DIV_STATUS 0x39 > +#define CMD_FM_PHASE_DIV_STATUS_NRESP 2 > + > +#define CMD_AM_TUNE_FREQ 0x40 > +#define CMD_AM_TUNE_FREQ_NARGS 3 > +#define CMD_AM_TUNE_FREQ_NRESP 1 > + > +#define CMD_AM_RSQ_STATUS 0x42 > +#define CMD_AM_RSQ_STATUS_NARGS 1 > +#define CMD_AM_RSQ_STATUS_NRESP 13 > + > +#define CMD_AM_SEEK_START 0x41 > +#define CMD_AM_SEEK_START_NARGS 1 > +#define CMD_AM_SEEK_START_NRESP 1 > + > + > +#define CMD_AM_ACF_STATUS 0x45 > +#define CMD_AM_ACF_STATUS_NRESP 6 > +#define CMD_AM_ACF_STATUS_NARGS 1 > + > +#define CMD_FM_ACF_STATUS 0x35 > +#define CMD_FM_ACF_STATUS_NRESP 8 > +#define CMD_FM_ACF_STATUS_NARGS 1 > + > +#define CMD_MAX_ARGS_COUNT (10) > + > + > +enum si476x_acf_status_report_bits { > + SI476X_ACF_BLEND_INT = (1 << 4), > + SI476X_ACF_HIBLEND_INT = (1 << 3), > + SI476X_ACF_HICUT_INT = (1 << 2), > + SI476X_ACF_CHBW_INT = (1 << 1), > + SI476X_ACF_SOFTMUTE_INT = (1 << 0), > + > + SI476X_ACF_SMUTE = (1 << 0), > + SI476X_ACF_SMATTN = 0b11111, > + SI476X_ACF_PILOT = (1 << 7), > + SI476X_ACF_STBLEND = ~SI476X_ACF_PILOT, > +}; > + > +enum si476x_agc_status_report_bits { > + SI476X_AGC_MXHI = (1 << 5), > + SI476X_AGC_MXLO = (1 << 4), > + SI476X_AGC_LNAHI = (1 << 3), > + SI476X_AGC_LNALO = (1 << 2), > +}; > + > +enum si476x_errors { > + SI476X_ERR_BAD_COMMAND = 0x10, > + SI476X_ERR_BAD_ARG1 = 0x11, > + SI476X_ERR_BAD_ARG2 = 0x12, > + SI476X_ERR_BAD_ARG3 = 0x13, > + SI476X_ERR_BAD_ARG4 = 0x14, > + SI476X_ERR_BUSY = 0x18, > + SI476X_ERR_BAD_INTERNAL_MEMORY = 0x20, > + SI476X_ERR_BAD_PATCH = 0x30, > + SI476X_ERR_BAD_BOOT_MODE = 0x31, > + SI476X_ERR_BAD_PROPERTY = 0x40, > +}; > + > + > +static int si476x_core_parse_and_nag_about_error(struct si476x_core *core) > +{ > + int err; > + char *cause; > + u8 buffer[2]; > + > + if (core->revision != SI476X_REVISION_A10) { > + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, > + buffer, sizeof(buffer)); > + if (err == sizeof(buffer)) { > + switch (buffer[1]) { > + case SI476X_ERR_BAD_COMMAND: > + cause = "Bad command"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_ARG1: > + cause = "Bad argument #1"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_ARG2: > + cause = "Bad argument #2"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_ARG3: > + cause = "Bad argument #3"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_ARG4: > + cause = "Bad argument #4"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BUSY: > + cause = "Chip is busy"; > + err = -EBUSY; > + break; > + case SI476X_ERR_BAD_INTERNAL_MEMORY: > + cause = "Bad internal memory"; > + err = -EIO; > + break; > + case SI476X_ERR_BAD_PATCH: > + cause = "Bad patch"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_BOOT_MODE: > + cause = "Bad boot mode"; > + err = -EINVAL; > + break; > + case SI476X_ERR_BAD_PROPERTY: > + cause = "Bad property"; > + err = -EINVAL; > + break; > + default: > + cause = "Unknown"; > + err = -EIO; > + } > + > + dev_err(&core->client->dev, > + "[Chip error status]: %s\n", cause); > + } else { > + dev_err(&core->client->dev, > + "Failed to fetch error code\n"); > + err = (err >= 0) ? -EIO : err; > + } > + } else { > + err = -EIO; > + } > + > + return err; > +} > + > +/** > + * __core_send_command() - sends a command to si476x and waits its > + * response > + * @core: si476x_device structure for the device we are > + * communicating with > + * @command: command id > + * @args: command arguments we are sending > + * @argn: actual size of @args > + * @response: buffer to place the expected response from the device > + * @respn: actual size of @response > + * @usecs: amount of time to wait before reading the response (in > + * usecs) > + * > + * Function returns 0 on succsess and negative error code on > + * failure > + */ > +static int __core_send_command(struct si476x_core *core, > + const u8 command, > + const u8 args[], > + const int argn, > + u8 resp[], > + const int respn, > + const int usecs) > +{ > + struct i2c_client *client = core->client; > + int err; > + u8 data[CMD_MAX_ARGS_COUNT + 1]; > + > + if (argn > CMD_MAX_ARGS_COUNT) { > + err = -ENOMEM; > + goto exit; > + } > + > + if (!client->adapter) { > + err = -ENODEV; > + goto exit; > + } > + > + /* First send the command and its arguments */ > + data[0] = command; > + memcpy(&data[1], args, argn); > + DBG_BUFFER(&client->dev, "Command:\n", data, argn + 1); > + > + err = si476x_i2c_xfer(core, SI476X_I2C_SEND, (char *) data, argn + 1); > + if (err != argn + 1) { > + dev_err(&core->client->dev, > + "Error while sending command 0x%02x\n", > + command); > + err = (err >= 0) ? -EIO : err; > + goto exit; > + } > + /* Set CTS to zero only after the command is send to avoid > + * possible racing conditions when working in polling mode */ > + atomic_set(&core->cts, 0); > + > + if (!wait_event_timeout(core->command, > + atomic_read(&core->cts), > + usecs_to_jiffies(usecs) + 1)) > + dev_warn(&core->client->dev, > + "(%s) [CMD 0x%02x] Device took too much time to answer.\n", > + __func__, command); > + > + /* > + When working in polling mode, for some reason the tuner will > + report CTS bit as being set in the first status byte read, > + but all the consequtive ones will return zros until the > + tuner is actually completed the POWER_UP command. To > + workaround that we wait for second CTS to be reported > + */ > + if (unlikely(!core->client->irq && command == CMD_POWER_UP)) { > + if (!wait_event_timeout(core->command, > + atomic_read(&core->cts), > + usecs_to_jiffies(usecs) + 1)) > + dev_warn(&core->client->dev, > + "(%s) Power up took too much time.\n", > + __func__); > + } > + > + /* Then get the response */ > + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, resp, respn); > + if (err != respn) { > + dev_err(&core->client->dev, > + "Error while reading response for command 0x%02x\n", > + command); > + err = (err >= 0) ? -EIO : err; > + goto exit; > + } > + DBG_BUFFER(&client->dev, "Response:\n", resp, respn); > + > + err = 0; > + > + if (resp[0] & SI476X_ERR) { > + dev_err(&core->client->dev, "[CMD 0x%02x] Chip set error flag\n", command); > + err = si476x_core_parse_and_nag_about_error(core); > + goto exit; > + } > + > + if (!(resp[0] & SI476X_CTS)) > + err = -EBUSY; > +exit: > + return err; > +} > + > +#define CORE_SEND_COMMAND(core, cmd, args, resp, timeout) \ > + __core_send_command(core, cmd, args, \ > + ARRAY_SIZE(args), \ > + resp, ARRAY_SIZE(resp), \ > + timeout) I'm not sure I like this macro. I do not believe it is worth it just to hide the two ARRAY_SIZE arguments. I would recommend that you remove it, I believe it will make the code more readable. > + > +static int si476x_cmd_clear_stc(struct si476x_core *core) > +{ > + int err; > + struct si476x_rsq_status_args args = { > + .primary = false, > + .rsqack = false, > + .attune = false, > + .cancel = false, > + .stcack = true, > + }; > + > + switch(core->power_up_parameters.func) { > + case SI476X_FUNC_FM_RECEIVER: > + err = si476x_core_cmd_fm_rsq_status(core, &args, NULL); > + break; > + case SI476X_FUNC_AM_RECEIVER: > + err = si476x_core_cmd_am_rsq_status(core, &args, NULL); > + break; > + default: > + err = -EINVAL; > + } > + > + return err; > +} > + > +static int si476x_cmd_tune_seek_freq(struct si476x_core *core, > + uint8_t cmd, > + const uint8_t args[], size_t argn, > + uint8_t *resp, size_t respn) > +{ > + int err; > + > + > + atomic_set(&core->stc, 0); > + err = __core_send_command(core, cmd, args, argn, > + resp, respn, > + atomic_read(&core->timeouts.command)); > + if (!err) { > + wait_event_killable(core->tuning, > + atomic_read(&core->stc)); > + si476x_cmd_clear_stc(core); > + } > + > + return err; > +} > + > +/** > + * si476x_cmd_func_info() - send 'FUNC_INFO' command to the device > + * @core: device to send the command to > + * @info: struct si476x_func_info to fill all the information > + * returned by the command > + * > + * The command requests the firmware and patch version for currently > + * loaded firmware (dependent on the function of the device FM/AM/WB) > + * > + * Function returns 0 on succsess and negative error code on > + * failure > + */ > +int si476x_core_cmd_func_info(struct si476x_core *core, > + struct si476x_func_info *info) > +{ > + int err; > + u8 resp[CMD_FUNC_INFO_NRESP]; > + > + err = __core_send_command(core, CMD_FUNC_INFO, > + NULL, 0, > + resp, ARRAY_SIZE(resp), > + atomic_read(&core->timeouts.command)); > + > + info->firmware.major = resp[1]; > + info->firmware.minor[0] = resp[2]; > + info->firmware.minor[1] = resp[3]; > + > + info->patch_id = ((u16) resp[4] << 8) | resp[5]; > + info->func = resp[6]; > + > + return err; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_func_info); > + > +/** > + * si476x_cmd_set_property() - send 'SET_PROPERTY' command to the device > + * @core: device to send the command to > + * @property: property address > + * @value: property value > + * > + * Function returns 0 on succsess and negative error code on > + * failure > + */ > +int si476x_core_cmd_set_property(struct si476x_core *core, > + u16 property, u16 value) > +{ > + u8 resp[CMD_SET_PROPERTY_NRESP]; > + const u8 args[CMD_SET_PROPERTY_NARGS] = { > + 0x00, > + msb(property), > + lsb(property), > + msb(value), > + lsb(value), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_SET_PROPERTY, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_set_property); > + > +/** > + * si476x_cmd_get_property() - send 'GET_PROPERTY' command to the device > + * @core: device to send the command to > + * @property: property address > + * > + * Function return the value of property as u16 on success or a > + * negative error on failure > + */ > +int si476x_core_cmd_get_property(struct si476x_core *core, u16 property) > +{ > + int err; > + u8 resp[CMD_GET_PROPERTY_NRESP]; > + const u8 args[CMD_GET_PROPERTY_NARGS] = { > + 0x00, > + msb(property), > + lsb(property), > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_GET_PROPERTY, > + args, resp, > + atomic_read(&core->timeouts.command)); > + if (err < 0) > + return err; > + else > + return be16_to_cpup((__be16 *)(resp + 2)); I would replace this with a ? : construction. > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_get_property); > + > +/** > + * si476x_cmd_dig_audio_pin_cfg() - send 'DIG_AUDIO_PIN_CFG' command to > + * the device > + * @core: device to send the command to > + * @dclk: DCLK pin function configuration: > + * #SI476X_DCLK_NOOP - do not modify the behaviour > + * #SI476X_DCLK_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * #SI476X_DCLK_DAUDIO - set the pin to be a part of digital > + * audio interface > + * @dfs: DFS pin function configuration: > + * #SI476X_DFS_NOOP - do not modify the behaviour > + * #SI476X_DFS_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_DFS_DAUDIO - set the pin to be a part of digital > + * audio interface > + * @dout - DOUT pin function configuration: > + * SI476X_DOUT_NOOP - do not modify the behaviour > + * SI476X_DOUT_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_DOUT_I2S_OUTPUT - set this pin to be digital out on I2S > + * port 1 > + * SI476X_DOUT_I2S_INPUT - set this pin to be digital in on I2S > + * port 1 > + * @xout - XOUT pin function configuration: > + * SI476X_XOUT_NOOP - do not modify the behaviour > + * SI476X_XOUT_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_XOUT_I2S_INPUT - set this pin to be digital in on I2S > + * port 1 > + * SI476X_XOUT_MODE_SELECT - set this pin to be the input that > + * selects the mode of the I2S audio > + * combiner (analog or HD) > + * [SI4761/63/65/67 Only] > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_dig_audio_pin_cfg(struct si476x_core *core, > + enum si476x_dclk_config dclk, > + enum si476x_dfs_config dfs, > + enum si476x_dout_config dout, > + enum si476x_xout_config xout) > +{ > + u8 resp[CMD_DIG_AUDIO_PIN_CFG_NRESP]; > + const u8 args[CMD_DIG_AUDIO_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(dclk), > + PIN_CFG_BYTE(dfs), > + PIN_CFG_BYTE(dout), > + PIN_CFG_BYTE(xout), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_DIG_AUDIO_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_dig_audio_pin_cfg); > + > +/** > + * si476x_cmd_zif_pin_cfg - send 'ZIF_PIN_CFG_COMMAND' > + * @core - device to send the command to > + * @iqclk - IQCL pin function configuration: > + * SI476X_IQCLK_NOOP - do not modify the behaviour > + * SI476X_IQCLK_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_IQCLK_IQ - set pin to be a part of I/Q interace > + * in master mode > + * @iqfs - IQFS pin function configuration: > + * SI476X_IQFS_NOOP - do not modify the behaviour > + * SI476X_IQFS_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_IQFS_IQ - set pin to be a part of I/Q interace > + * in master mode > + * @iout - IOUT pin function configuration: > + * SI476X_IOUT_NOOP - do not modify the behaviour > + * SI476X_IOUT_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_IOUT_OUTPUT - set pin to be I out > + * @qout - QOUT pin function configuration: > + * SI476X_QOUT_NOOP - do not modify the behaviour > + * SI476X_QOUT_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_QOUT_OUTPUT - set pin to be Q out > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_zif_pin_cfg(struct si476x_core *core, > + enum si476x_iqclk_config iqclk, > + enum si476x_iqfs_config iqfs, > + enum si476x_iout_config iout, > + enum si476x_qout_config qout) > +{ > + u8 resp[CMD_ZIF_PIN_CFG_NRESP]; > + const u8 args[CMD_ZIF_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(iqclk), > + PIN_CFG_BYTE(iqfs), > + PIN_CFG_BYTE(iout), > + PIN_CFG_BYTE(qout), > + }; Should this be static const? Or doesn't it matter? I'm not entirely sure if the compiler handles that differently. > + > + return CORE_SEND_COMMAND(core, CMD_ZIF_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_zif_pin_cfg); > + > +/** > + * si476x_cmd_ic_link_gpo_ctl_pin_cfg - send > + * 'IC_LINK_GPIO_CTL_PIN_CFG' comand to the device > + * @core - device to send the command to > + * @icin - ICIN pin function configuration: > + * SI476X_ICIN_NOOP - do not modify the behaviour > + * SI476X_ICIN_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_ICIN_GPO1_HIGH - set pin to be an output, drive it high > + * SI476X_ICIN_GPO1_LOW - set pin to be an output, drive it low > + * SI476X_ICIN_IC_LINK - set the pin to be a part of Inter-Chip link > + * @icip - ICIP pin function configuration: > + * SI476X_ICIP_NOOP - do not modify the behaviour > + * SI476X_ICIP_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_ICIP_GPO1_HIGH - set pin to be an output, drive it high > + * SI476X_ICIP_GPO1_LOW - set pin to be an output, drive it low > + * SI476X_ICIP_IC_LINK - set the pin to be a part of Inter-Chip link > + * @icon - ICON pin function configuration: > + * SI476X_ICON_NOOP - do not modify the behaviour > + * SI476X_ICON_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_ICON_I2S - set the pin to be a part of audio > + * interface in slave mode (DCLK) > + * SI476X_ICON_IC_LINK - set the pin to be a part of Inter-Chip link > + * @icop - ICOP pin function configuration: > + * SI476X_ICOP_NOOP - do not modify the behaviour > + * SI476X_ICOP_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_ICOP_I2S - set the pin to be a part of audio > + * interface in slave mode (DOUT) > + * [Si4761/63/65/67 Only] > + * SI476X_ICOP_IC_LINK - set the pin to be a part of Inter-Chip link > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_ic_link_gpo_ctl_pin_cfg(struct si476x_core *core, > + enum si476x_icin_config icin, > + enum si476x_icip_config icip, > + enum si476x_icon_config icon, > + enum si476x_icop_config icop) > +{ > + u8 resp[CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP]; > + const u8 args[CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(icin), > + PIN_CFG_BYTE(icip), > + PIN_CFG_BYTE(icon), > + PIN_CFG_BYTE(icop), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_IC_LINK_GPO_CTL_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_ic_link_gpo_ctl_pin_cfg); > + > +/** > + * si476x_cmd_ana_audio_pin_cfg - send 'ANA_AUDIO_PIN_CFG' to the > + * device > + * @core - device to send the command to > + * @lrout - LROUT pin function configuration: > + * SI476X_LROUT_NOOP - do not modify the behaviour > + * SI476X_LROUT_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_LROUT_AUDIO - set pin to be audio output > + * SI476X_LROUT_MPX - set pin to be MPX output > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_ana_audio_pin_cfg(struct si476x_core *core, > + enum si476x_lrout_config lrout) > +{ > + u8 resp[CMD_ANA_AUDIO_PIN_CFG_NRESP]; > + const u8 args[CMD_ANA_AUDIO_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(lrout), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_ANA_AUDIO_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_ana_audio_pin_cfg); > + > + > +/** > + * si476x_cmd_intb_pin_cfg - send 'INTB_PIN_CFG' command to the device > + * @core - device to send the command to > + * @intb - INTB pin function configuration: > + * SI476X_INTB_NOOP - do not modify the behaviour > + * SI476X_INTB_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_INTB_DAUDIO - set pin to be a part of digital > + * audio interface in slave mode > + * SI476X_INTB_IRQ - set pin to be an interrupt request line > + * @a1 - A1 pin function configuration: > + * SI476X_A1_NOOP - do not modify the behaviour > + * SI476X_A1_TRISTATE - put the pin in tristate condition, > + * enable 1MOhm pulldown > + * SI476X_A1_IRQ - set pin to be an interrupt request line > + * > + * Function returns 0 on success and negative error code on failure > + */ > +static int si476x_core_cmd_intb_pin_cfg_a10(struct si476x_core *core, > + enum si476x_intb_config intb, > + enum si476x_a1_config a1) > +{ > + u8 resp[CMD_INTB_PIN_CFG_A10_NRESP]; > + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(intb), > + PIN_CFG_BYTE(a1), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > + > +static int si476x_core_cmd_intb_pin_cfg_a20(struct si476x_core *core, > + enum si476x_intb_config intb, > + enum si476x_a1_config a1) > +{ > + u8 resp[CMD_INTB_PIN_CFG_A20_NRESP]; > + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { > + PIN_CFG_BYTE(intb), > + PIN_CFG_BYTE(a1), > + }; > + > + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > + > + > + > +/** > + * si476x_cmd_am_rsq_status - send 'FM_TUNE_FREQ' command to the > + * device > + * @core - device to send the command to > + * @rsqack - if set command clears RSQINT, SNRINT, SNRLINT, RSSIHINT, > + * RSSSILINT, BLENDINT, MULTHINT and MULTLINT > + * @attune - when set the values in the status report are the values > + * that were calculated at tune > + * @cancel - abort ongoing seek/tune opertation > + * @stcack - clear the STCINT bin in status register > + * @report - all signal quality information retured by the command > + * (if NULL then the output of the command is ignored) > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_am_rsq_status(struct si476x_core *core, > + struct si476x_rsq_status_args *rsqargs, > + struct si476x_rsq_status_report *report) > +{ > + int err; > + u8 resp[CMD_AM_RSQ_STATUS_NRESP]; > + const u8 args[CMD_AM_RSQ_STATUS_NARGS] = { > + rsqargs->rsqack << 3 | rsqargs->attune << 2 | > + rsqargs->cancel << 1 | rsqargs->stcack, > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_AM_RSQ_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (report) { Do you really need to test 'report'? Does it ever make sense if this is called with a NULL report pointer? > + report->snrhint = 0b00001000 & resp[1]; > + report->snrlint = 0b00000100 & resp[1]; > + report->rssihint = 0b00000010 & resp[1]; > + report->rssilint = 0b00000001 & resp[1]; > + > + report->bltf = 0b10000000 & resp[2]; > + report->snr_ready = 0b00100000 & resp[2]; > + report->rssiready = 0b00001000 & resp[2]; > + report->afcrl = 0b00000010 & resp[2]; > + report->valid = 0b00000001 & resp[2]; > + > + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); > + report->freqoff = resp[5]; > + report->rssi = resp[6]; > + report->snr = resp[7]; > + report->lassi = resp[9]; > + report->hassi = resp[10]; > + report->mult = resp[11]; > + report->dev = resp[12]; > + } > + > + return err; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_rsq_status); > + > +int si476x_core_cmd_fm_acf_status(struct si476x_core *core, > + struct si476x_acf_status_report *report) > +{ > + int err; > + u8 resp[CMD_FM_ACF_STATUS_NRESP]; > + const u8 args[CMD_FM_ACF_STATUS_NARGS] = { > + 0x0, > + }; > + > + if (!report) > + return -EINVAL; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_ACF_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (!err) { I recommend to simplify this: if (err) return err; > + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; > + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; > + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; > + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; > + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; > + report->smute = resp[2] & SI476X_ACF_SMUTE; > + report->smattn = resp[3] & SI476X_ACF_SMATTN; > + report->chbw = resp[4]; > + report->hicut = resp[5]; > + report->hiblend = resp[6]; > + report->pilot = resp[7] & SI476X_ACF_PILOT; > + report->stblend = resp[7] & SI476X_ACF_STBLEND; Then all the lines above can have one indent less, which makes it easier to read. Ditto elsewhere. > + } > + > + return err; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_acf_status); > + > +int si476x_core_cmd_am_acf_status(struct si476x_core *core, > + struct si476x_acf_status_report *report) > +{ > + int err; > + u8 resp[CMD_AM_ACF_STATUS_NRESP]; > + const u8 args[CMD_AM_ACF_STATUS_NARGS] = { > + 0x0, > + }; > + > + if (!report) > + return -EINVAL; > + > + err = CORE_SEND_COMMAND(core, CMD_AM_ACF_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (!err) { > + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; > + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; > + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; > + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; > + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; > + report->smute = resp[2] & SI476X_ACF_SMUTE; > + report->smattn = resp[3] & SI476X_ACF_SMATTN; > + report->chbw = resp[4]; > + report->hicut = resp[5]; > + } > + > + return err; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_acf_status); > + > + > +/** > + * si476x_cmd_fm_seek_start - send 'FM_SEEK_START' command to the > + * device > + * @core - device to send the command to > + * @seekup - if set the direction of the search is 'up' > + * @wrap - if set seek wraps when hitting band limit > + * > + * This function begins search for a valid station. The station is > + * considered valid when 'FM_VALID_SNR_THRESHOLD' and > + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria > + * are met. > +} * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_fm_seek_start(struct si476x_core *core, > + bool seekup, bool wrap) > +{ > + u8 resp[CMD_FM_SEEK_START_NRESP]; > + const u8 args[CMD_FM_SEEK_START_NARGS] = { > + seekup << 3 | wrap << 2, > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_FM_SEEK_START, > + args, sizeof(args), resp, sizeof(resp)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_seek_start); > + > +/** > + * si476x_cmd_fm_rds_status - send 'FM_RDS_STATUS' command to the > + * device > + * @core - device to send the command to > + * @status_only - if set the data is not removed from RDSFIFO, > + * RDSFIFOUSED is not decremented and data in all the > + * rest RDS data contains the last valid info received > + * @mtfifo if set the command clears RDS receive FIFO > + * @intack if set the command clards the RDSINT bit. > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_fm_rds_status(struct si476x_core *core, > + bool status_only, > + bool mtfifo, > + bool intack, > + struct si476x_rds_status_report *report) > +{ > + int err; > + u8 resp[CMD_FM_RDS_STATUS_NRESP]; > + const u8 args[CMD_FM_RDS_STATUS_NARGS] = { > + status_only << 2 | mtfifo << 1 | intack, > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (!err && report) { > + report->rdstpptyint = 0b00010000 & resp[1]; > + report->rdspiint = 0b00001000 & resp[1]; > + report->rdssyncint = 0b00000010 & resp[1]; > + report->rdsfifoint = 0b00000001 & resp[1]; > + > + report->tpptyvalid = 0b00010000 & resp[2]; > + report->pivalid = 0b00001000 & resp[2]; > + report->rdssync = 0b00000010 & resp[2]; > + report->rdsfifolost = 0b00000001 & resp[2]; > + > + report->tp = 0b00100000 & resp[3]; > + report->pty = 0b00011111 & resp[3]; > + > + report->pi = be16_to_cpup((__be16 *)(resp + 4)); > + report->rdsfifoused = resp[6]; > + > + report->ble[V4L2_RDS_BLOCK_A] = 0b11000000 & resp[7]; > + report->ble[V4L2_RDS_BLOCK_B] = 0b00110000 & resp[7]; > + report->ble[V4L2_RDS_BLOCK_C] = 0b00001100 & resp[7]; > + report->ble[V4L2_RDS_BLOCK_D] = 0b00000011 & resp[7]; > + > + report->rds[V4L2_RDS_BLOCK_A].block = V4L2_RDS_BLOCK_A; > + report->rds[V4L2_RDS_BLOCK_A].msb = resp[8]; > + report->rds[V4L2_RDS_BLOCK_A].lsb = resp[9]; > + > + report->rds[V4L2_RDS_BLOCK_B].block = V4L2_RDS_BLOCK_B; > + report->rds[V4L2_RDS_BLOCK_B].msb = resp[10]; > + report->rds[V4L2_RDS_BLOCK_B].lsb = resp[11]; > + > + report->rds[V4L2_RDS_BLOCK_C].block = V4L2_RDS_BLOCK_C; > + report->rds[V4L2_RDS_BLOCK_C].msb = resp[12]; > + report->rds[V4L2_RDS_BLOCK_C].lsb = resp[13]; > + > + report->rds[V4L2_RDS_BLOCK_D].block = V4L2_RDS_BLOCK_D; > + report->rds[V4L2_RDS_BLOCK_D].msb = resp[14]; > + report->rds[V4L2_RDS_BLOCK_D].lsb = resp[15]; > + } > + > + return err; > +} > + > +int si476x_core_cmd_fm_rds_blockcount(struct si476x_core *core, > + bool clear, > + struct si476x_rds_blockcount_report *report) > +{ > + int err; > + u8 resp[CMD_FM_RDS_BLOCKCOUNT_NRESP]; > + const u8 args[CMD_FM_RDS_BLOCKCOUNT_NARGS] = { > + clear, > + }; > + > + if (!report) > + return -EINVAL; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_BLOCKCOUNT, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (!err) { > + report->expected = be16_to_cpup((__be16 *)(resp + 2)); > + report->received = be16_to_cpup((__be16 *)(resp + 4)); > + report->uncorrectable = be16_to_cpup((__be16 *)(resp + 6)); > + } > + > + return err; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rds_blockcount); > + > +int si476x_core_cmd_fm_phase_diversity(struct si476x_core *core, > + enum si476x_phase_diversity_mode mode) > +{ > + u8 resp[CMD_FM_PHASE_DIVERSITY_NRESP]; > + const u8 args[CMD_FM_PHASE_DIVERSITY_NARGS] = { > + mode & 0b111, > + }; > + > + return CORE_SEND_COMMAND(core, CMD_FM_PHASE_DIVERSITY, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_diversity); > +/** > + * si476x_core_cmd_fm_phase_div_status() - get the phase diversity > + * status > + * > + * @core: si476x device > + * > + * NOTE caller must hold core lock > + * > + * Function returns the value of the status bit in case of success and > + * negative error code in case of failre. > + */ > +int si476x_core_cmd_fm_phase_div_status(struct si476x_core *core) > +{ > + int err; > + u8 resp[CMD_FM_PHASE_DIV_STATUS_NRESP]; > + > + err = __core_send_command(core, CMD_FM_PHASE_DIV_STATUS, > + NULL, 0, > + resp, ARRAY_SIZE(resp), > + atomic_read(&core->timeouts.command)); > + > + return (err < 0) ? err : resp[1]; > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_div_status); > + > + > +/** > + * si476x_cmd_am_seek_start - send 'FM_SEEK_START' command to the > + * device > + * @core - device to send the command to > + * @seekup - if set the direction of the search is 'up' > + * @wrap - if set seek wraps when hitting band limit > + * > + * This function begins search for a valid station. The station is > + * considered valid when 'FM_VALID_SNR_THRESHOLD' and > + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria > + * are met. > + * > + * Function returns 0 on success and negative error code on failure > + */ > +int si476x_core_cmd_am_seek_start(struct si476x_core *core, > + bool seekup, bool wrap) > +{ > + u8 resp[CMD_AM_SEEK_START_NRESP]; > + const u8 args[CMD_AM_SEEK_START_NARGS] = { > + seekup << 3 | wrap << 2, > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_AM_SEEK_START, > + args, sizeof(args), resp, sizeof(resp)); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_seek_start); > + > + > + > +static int si476x_core_cmd_power_up_a10(struct si476x_core *core, > + struct si476x_power_up_args *puargs) > +{ > + u8 resp[CMD_POWER_UP_A10_NRESP]; > + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); > + const bool ctsen = (core->client->irq != 0); > + const u8 args[CMD_POWER_UP_A10_NARGS] = { > + 0xF7, /* Reserved, always 0xF7 */ > + 0x3F & puargs->xcload, /* First two bits are reserved to be > + * zeros */ > + ctsen << 7 | intsel << 6 | 0x07, /* Last five bits > + * are reserved to > + * be written as 0x7 */ > + puargs->func << 4 | puargs->freq, > + 0x11, /* Reserved, always 0x11 */ > + }; > + > + return CORE_SEND_COMMAND(core, CMD_POWER_UP, > + args, resp, > + atomic_read(&core->timeouts.power_up)); > +} > + > +static int si476x_core_cmd_power_up_a20(struct si476x_core *core, > + struct si476x_power_up_args *puargs) > +{ > + u8 resp[CMD_POWER_UP_A20_NRESP]; > + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); > + const bool ctsen = (core->client->irq != 0); > + const u8 args[CMD_POWER_UP_A20_NARGS] = { > + puargs->ibias6x << 7 | puargs->xstart, > + 0x3F & puargs->xcload, /* First two bits are reserved to be > + * zeros */ > + ctsen << 7 | intsel << 6 | puargs->fastboot << 5 | > + puargs->xbiashc << 3 | puargs->xbias, > + puargs->func << 4 | puargs->freq, > + 0x10 | puargs->xmode, > + }; > + > + return CORE_SEND_COMMAND(core, CMD_POWER_UP, > + args, resp, > + atomic_read(&core->timeouts.power_up)); > +} > + > +static int si476x_core_cmd_power_down_a10(struct si476x_core *core, > + struct si476x_power_down_args *pdargs) > +{ > + u8 resp[CMD_POWER_DOWN_A10_NRESP]; > + > + return __core_send_command(core, CMD_POWER_DOWN, > + NULL, 0, > + resp, ARRAY_SIZE(resp), > + atomic_read(&core->timeouts.command)); > +} > + > +static int si476x_core_cmd_power_down_a20(struct si476x_core *core, > + struct si476x_power_down_args *pdargs) > +{ > + u8 resp[CMD_POWER_DOWN_A20_NRESP]; > + const u8 args[CMD_POWER_DOWN_A20_NARGS] = { > + pdargs->xosc, > + }; > + return CORE_SEND_COMMAND(core, CMD_POWER_DOWN, > + args, resp, > + atomic_read(&core->timeouts.command)); > +} > + > +static int si476x_core_cmd_am_tune_freq_a10(struct si476x_core *core, > + struct si476x_tune_freq_args *tuneargs) > +{ > + > + const int am_freq = tuneargs->freq; > + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; > + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { > + (tuneargs->hd << 6), > + msb(am_freq), > + lsb(am_freq), > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, > + sizeof(args), > + resp, sizeof(resp)); > +} > + > +static int si476x_core_cmd_am_tune_freq_a20(struct si476x_core *core, > + struct si476x_tune_freq_args *tuneargs) > +{ > + const int am_freq = tuneargs->freq; > + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; > + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { > + (tuneargs->zifsr << 6) | (tuneargs->injside & 0b11), > + msb(am_freq), > + lsb(am_freq), > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, sizeof(args), > + resp, sizeof(resp)); > +} > + > +static int si476x_core_cmd_fm_rsq_status_a10(struct si476x_core *core, > + struct si476x_rsq_status_args *rsqargs, > + struct si476x_rsq_status_report *report) > +{ > + int err; > + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; > + const u8 args[CMD_FM_RSQ_STATUS_A10_NARGS] = { > + rsqargs->rsqack << 3 | rsqargs->attune << 2 | > + rsqargs->cancel << 1 | rsqargs->stcack, > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (report && !err) { > + report->multhint = 0b10000000 & resp[1]; > + report->multlint = 0b01000000 & resp[1]; > + report->snrhint = 0b00001000 & resp[1]; > + report->snrlint = 0b00000100 & resp[1]; > + report->rssihint = 0b00000010 & resp[1]; > + report->rssilint = 0b00000001 & resp[1]; > + > + report->bltf = 0b10000000 & resp[2]; > + report->snr_ready = 0b00100000 & resp[2]; > + report->rssiready = 0b00001000 & resp[2]; > + report->afcrl = 0b00000010 & resp[2]; > + report->valid = 0b00000001 & resp[2]; > + > + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); > + report->freqoff = resp[5]; > + report->rssi = resp[6]; > + report->snr = resp[7]; > + report->lassi = resp[9]; > + report->hassi = resp[10]; > + report->mult = resp[11]; > + report->dev = resp[12]; > + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); > + report->assi = resp[15]; > + report->usn = resp[16]; > + } > + > + return err; > +} > + > +static int si476x_core_cmd_fm_rsq_status_a20(struct si476x_core *core, > + struct si476x_rsq_status_args *rsqargs, > + struct si476x_rsq_status_report *report) > +{ > + int err; > + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; > + > + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { > + rsqargs->primary << 4 | rsqargs->rsqack << 3 | > + rsqargs->attune << 2 | rsqargs->cancel << 1 | > + rsqargs->stcack, > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (report && !err) { > + report->multhint = 0b10000000 & resp[1]; > + report->multlint = 0b01000000 & resp[1]; > + report->snrhint = 0b00001000 & resp[1]; > + report->snrlint = 0b00000100 & resp[1]; > + report->rssihint = 0b00000010 & resp[1]; > + report->rssilint = 0b00000001 & resp[1]; > + > + report->bltf = 0b10000000 & resp[2]; > + report->snr_ready = 0b00100000 & resp[2]; > + report->rssiready = 0b00001000 & resp[2]; > + report->afcrl = 0b00000010 & resp[2]; > + report->valid = 0b00000001 & resp[2]; > + > + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); > + report->freqoff = resp[5]; > + report->rssi = resp[6]; > + report->snr = resp[7]; > + report->lassi = resp[9]; > + report->hassi = resp[10]; > + report->mult = resp[11]; > + report->dev = resp[12]; > + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); > + report->assi = resp[15]; > + report->usn = resp[16]; > + } > + > + return err; > +} > + > + > +static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core, > + struct si476x_rsq_status_args *rsqargs, > + struct si476x_rsq_status_report *report) > +{ > + int err; > + u8 resp[CMD_FM_RSQ_STATUS_A30_NRESP]; > + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { > + rsqargs->primary << 4 | rsqargs->rsqack << 3 | > + rsqargs->attune << 2 | rsqargs->cancel << 1 | > + rsqargs->stcack, > + }; > + > + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, > + args, resp, > + atomic_read(&core->timeouts.command)); > + > + if (report && !err) { > + report->multhint = 0b10000000 & resp[1]; > + report->multlint = 0b01000000 & resp[1]; > + report->snrhint = 0b00001000 & resp[1]; > + report->snrlint = 0b00000100 & resp[1]; > + report->rssihint = 0b00000010 & resp[1]; > + report->rssilint = 0b00000001 & resp[1]; > + > + report->bltf = 0b10000000 & resp[2]; > + report->snr_ready = 0b00100000 & resp[2]; > + report->rssiready = 0b00001000 & resp[2]; > + report->injside = 0b00000100 & resp[2]; > + report->afcrl = 0b00000010 & resp[2]; > + report->valid = 0b00000001 & resp[2]; > + > + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); > + report->freqoff = resp[5]; > + report->rssi = resp[6]; > + report->snr = resp[7]; > + report->issi = resp[8]; > + report->lassi = resp[9]; > + report->hassi = resp[10]; > + report->mult = resp[11]; > + report->dev = resp[12]; > + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); > + report->assi = resp[15]; > + report->usn = resp[16]; > + > + report->pilotdev = resp[17]; > + report->rdsdev = resp[18]; > + report->assidev = resp[19]; > + report->strongdev = resp[20]; > + report->rdspi = be16_to_cpup((__be16 *)(resp + 21)); > + } > + > + return err; > +} > + > +static int si476x_core_cmd_fm_tune_freq_a10(struct si476x_core *core, > + struct si476x_tune_freq_args *tuneargs) > +{ > + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; > + const u8 args[CMD_FM_TUNE_FREQ_A10_NARGS] = { > + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) > + | (tuneargs->smoothmetrics << 2), > + msb(tuneargs->freq), > + lsb(tuneargs->freq), > + msb(tuneargs->antcap), > + lsb(tuneargs->antcap) > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), > + resp, sizeof(resp)); > +} > + > +static int si476x_core_cmd_fm_tune_freq_a20(struct si476x_core *core, > + struct si476x_tune_freq_args *tuneargs) > +{ > + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; > + const u8 args[CMD_FM_TUNE_FREQ_A20_NARGS] = { > + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) > + | (tuneargs->smoothmetrics << 2) | (tuneargs->injside), > + msb(tuneargs->freq), > + lsb(tuneargs->freq), > + }; > + > + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), > + resp, sizeof(resp)); > +} > + > +static int si476x_core_cmd_agc_status_a20(struct si476x_core *core, > + struct si476x_agc_status_report *report) > +{ > + int err; > + u8 resp[CMD_AGC_STATUS_NRESP_A20]; > + > + if (!report) > + return -EINVAL; > + > + err = __core_send_command(core, CMD_AGC_STATUS, > + NULL, 0, > + resp, ARRAY_SIZE(resp), > + atomic_read(&core->timeouts.command)); > + if (!err) { > + report->mxhi = resp[1] & SI476X_AGC_MXHI; > + report->mxlo = resp[1] & SI476X_AGC_MXLO; > + report->lnahi = resp[1] & SI476X_AGC_LNAHI; > + report->lnalo = resp[1] & SI476X_AGC_LNALO; > + report->fmagc1 = resp[2]; > + report->fmagc2 = resp[3]; > + report->pgagain = resp[4]; > + report->fmwblang = resp[5]; > + } > + > + return err; > +} > + > +static int si476x_core_cmd_agc_status_a10(struct si476x_core *core, > + struct si476x_agc_status_report *report) > +{ > + int err; > + u8 resp[CMD_AGC_STATUS_NRESP_A10]; > + > + if (!report) > + return -EINVAL; > + > + err = __core_send_command(core, CMD_AGC_STATUS, > + NULL, 0, > + resp, ARRAY_SIZE(resp), > + atomic_read(&core->timeouts.command)); > + if (!err) { > + report->mxhi = resp[1] & SI476X_AGC_MXHI; > + report->mxlo = resp[1] & SI476X_AGC_MXLO; > + report->lnahi = resp[1] & SI476X_AGC_LNAHI; > + report->lnalo = resp[1] & SI476X_AGC_LNALO; > + } > + > + return err; > +} > + > +static struct { > + int (*power_up) (struct si476x_core *, > + struct si476x_power_up_args *); > + int (*power_down) (struct si476x_core *, > + struct si476x_power_down_args *); > + > + tune_freq_func_t fm_tune_freq; > + tune_freq_func_t am_tune_freq; > + > + int (*fm_rsq_status)(struct si476x_core *, > + struct si476x_rsq_status_args *, > + struct si476x_rsq_status_report *); > + > + int (*agc_status)(struct si476x_core *, > + struct si476x_agc_status_report *); > + int (*intb_pin_cfg)(struct si476x_core *core, > + enum si476x_intb_config intb, > + enum si476x_a1_config a1); > +} si476x_cmds_vtable[] = { > + [SI476X_REVISION_A10] = { > + .power_up = si476x_core_cmd_power_up_a10, > + .power_down = si476x_core_cmd_power_down_a10, > + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a10, > + .am_tune_freq = si476x_core_cmd_am_tune_freq_a10, > + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a10, > + .agc_status = si476x_core_cmd_agc_status_a10, > + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a10, > + }, > + [SI476X_REVISION_A20] = { > + .power_up = si476x_core_cmd_power_up_a20, > + .power_down = si476x_core_cmd_power_down_a20, > + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, > + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, > + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a20, > + .agc_status = si476x_core_cmd_agc_status_a20, > + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, > + }, > + [SI476X_REVISION_A30] = { > + .power_up = si476x_core_cmd_power_up_a20, > + .power_down = si476x_core_cmd_power_down_a20, > + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, > + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, > + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a30, > + .agc_status = si476x_core_cmd_agc_status_a20, > + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, > + }, > +}; > + > +int si476x_core_cmd_power_up(struct si476x_core *core, > + struct si476x_power_up_args *args) > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].power_up(core, args); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_up); > + > +int si476x_core_cmd_power_down(struct si476x_core *core, > + struct si476x_power_down_args *args) > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].power_down(core, args); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_down); > + > +int si476x_core_cmd_fm_tune_freq(struct si476x_core *core, > + struct si476x_tune_freq_args *args) > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].fm_tune_freq(core, args); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_tune_freq); > + > +int si476x_core_cmd_am_tune_freq(struct si476x_core *core, > + struct si476x_tune_freq_args *args) > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].am_tune_freq(core, args); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_tune_freq); > + > +int si476x_core_cmd_fm_rsq_status(struct si476x_core *core, > + struct si476x_rsq_status_args *args, > + struct si476x_rsq_status_report *report) > + > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].fm_rsq_status(core, args, > + report); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rsq_status); > + > +int si476x_core_cmd_agc_status(struct si476x_core *core, > + struct si476x_agc_status_report *report) > + > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + return si476x_cmds_vtable[core->revision].agc_status(core, report); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_agc_status); > + > +int si476x_core_cmd_intb_pin_cfg(struct si476x_core *core, > + enum si476x_intb_config intb, > + enum si476x_a1_config a1) > +{ > + BUG_ON(core->revision > SI476X_REVISION_A30 || > + core->revision == -1); > + > + return si476x_cmds_vtable[core->revision].intb_pin_cfg(core, intb, a1); > +} > +EXPORT_SYMBOL_GPL(si476x_core_cmd_intb_pin_cfg); > + > +MODULE_LICENSE("GPL"); > +MODULE_AUTHOR("Andrey Smirnov <andrey.smirnov@convergeddevices.net>"); > +MODULE_DESCRIPTION("API for command exchange for si476x"); > Regards, Hans -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
On 10/08/2012 01:56 AM, Hans Verkuil wrote: > On Sat October 6 2012 03:54:59 Andrey Smirnov wrote: >> This patch adds all the functions used for exchanging commands with >> the chip. >> >> Signed-off-by: Andrey Smirnov <andrey.smirnov@convergeddevices.net> >> --- >> drivers/mfd/si476x-cmd.c | 1493 ++++++++++++++++++++++++++++++++++++++++++++++ >> 1 file changed, 1493 insertions(+) >> create mode 100644 drivers/mfd/si476x-cmd.c >> >> diff --git a/drivers/mfd/si476x-cmd.c b/drivers/mfd/si476x-cmd.c >> new file mode 100644 >> index 0000000..f11cf58 >> --- /dev/null >> +++ b/drivers/mfd/si476x-cmd.c >> @@ -0,0 +1,1493 @@ >> +/* >> + * include/media/si476x-cmd.c -- Subroutines implementing command >> + * protocol of si476x series of chips >> + * >> + * Copyright (C) 2012 Innovative Converged Devices(ICD) >> + * >> + * Author: Andrey Smirnov <andrey.smirnov@convergeddevices.net> >> + * >> + * This program is free software; you can redistribute it and/or modify >> + * it under the terms of the GNU General Public License as published by >> + * the Free Software Foundation; version 2 of the License. >> + * >> + * This program is distributed in the hope that it will be useful, but >> + * WITHOUT ANY WARRANTY; without even the implied warranty of >> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU >> + * General Public License for more details. >> + * >> + */ >> +#include <linux/module.h> >> +#include <linux/completion.h> >> +#include <linux/delay.h> >> +#include <linux/atomic.h> >> +#include <linux/i2c.h> >> +#include <linux/device.h> >> +#include <linux/gpio.h> >> +#include <linux/videodev2.h> >> + >> +#include <media/si476x.h> >> +#include <linux/mfd/si476x-core.h> >> + >> +#define msb(x) ((u8)((u16) x >> 8)) >> +#define lsb(x) ((u8)((u16) x & 0x00FF)) >> + >> + >> + >> +#define CMD_POWER_UP 0x01 >> +#define CMD_POWER_UP_A10_NRESP 1 >> +#define CMD_POWER_UP_A10_NARGS 5 >> + >> +#define CMD_POWER_UP_A20_NRESP 1 >> +#define CMD_POWER_UP_A20_NARGS 5 >> + >> +#define POWER_UP_DELAY_MS 110 >> + >> +#define CMD_POWER_DOWN 0x11 >> +#define CMD_POWER_DOWN_A10_NRESP 1 >> + >> +#define CMD_POWER_DOWN_A20_NRESP 1 >> +#define CMD_POWER_DOWN_A20_NARGS 1 >> + >> +#define CMD_FUNC_INFO 0x12 >> +#define CMD_FUNC_INFO_NRESP 7 >> + >> +#define CMD_SET_PROPERTY 0x13 >> +#define CMD_SET_PROPERTY_NARGS 5 >> +#define CMD_SET_PROPERTY_NRESP 1 >> + >> +#define CMD_GET_PROPERTY 0x14 >> +#define CMD_GET_PROPERTY_NARGS 3 >> +#define CMD_GET_PROPERTY_NRESP 4 >> + >> +#define CMD_AGC_STATUS 0x17 >> +#define CMD_AGC_STATUS_NRESP_A10 2 >> +#define CMD_AGC_STATUS_NRESP_A20 6 >> + >> +#define PIN_CFG_BYTE(x) (0x7F & (x)) >> +#define CMD_DIG_AUDIO_PIN_CFG 0x18 >> +#define CMD_DIG_AUDIO_PIN_CFG_NARGS 4 >> +#define CMD_DIG_AUDIO_PIN_CFG_NRESP 5 >> + >> +#define CMD_ZIF_PIN_CFG 0x19 >> +#define CMD_ZIF_PIN_CFG_NARGS 4 >> +#define CMD_ZIF_PIN_CFG_NRESP 5 >> + >> +#define CMD_IC_LINK_GPO_CTL_PIN_CFG 0x1A >> +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS 4 >> +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP 5 >> + >> +#define CMD_ANA_AUDIO_PIN_CFG 0x1B >> +#define CMD_ANA_AUDIO_PIN_CFG_NARGS 1 >> +#define CMD_ANA_AUDIO_PIN_CFG_NRESP 2 >> + >> +#define CMD_INTB_PIN_CFG 0x1C >> +#define CMD_INTB_PIN_CFG_NARGS 2 >> +#define CMD_INTB_PIN_CFG_A10_NRESP 6 >> +#define CMD_INTB_PIN_CFG_A20_NRESP 3 >> + >> +#define CMD_FM_TUNE_FREQ 0x30 >> +#define CMD_FM_TUNE_FREQ_A10_NARGS 5 >> +#define CMD_FM_TUNE_FREQ_A20_NARGS 3 >> +#define CMD_FM_TUNE_FREQ_NRESP 1 >> + >> +#define CMD_FM_RSQ_STATUS 0x32 >> + >> +#define CMD_FM_RSQ_STATUS_A10_NARGS 1 >> +#define CMD_FM_RSQ_STATUS_A10_NRESP 17 >> +#define CMD_FM_RSQ_STATUS_A30_NARGS 1 >> +#define CMD_FM_RSQ_STATUS_A30_NRESP 23 >> + >> + >> +#define CMD_FM_SEEK_START 0x31 >> +#define CMD_FM_SEEK_START_NARGS 1 >> +#define CMD_FM_SEEK_START_NRESP 1 >> + >> +#define CMD_FM_RDS_STATUS 0x36 >> +#define CMD_FM_RDS_STATUS_NARGS 1 >> +#define CMD_FM_RDS_STATUS_NRESP 16 >> + >> +#define CMD_FM_RDS_BLOCKCOUNT 0x37 >> +#define CMD_FM_RDS_BLOCKCOUNT_NARGS 1 >> +#define CMD_FM_RDS_BLOCKCOUNT_NRESP 8 >> + >> +#define CMD_FM_PHASE_DIVERSITY 0x38 >> +#define CMD_FM_PHASE_DIVERSITY_NARGS 1 >> +#define CMD_FM_PHASE_DIVERSITY_NRESP 1 >> + >> +#define CMD_FM_PHASE_DIV_STATUS 0x39 >> +#define CMD_FM_PHASE_DIV_STATUS_NRESP 2 >> + >> +#define CMD_AM_TUNE_FREQ 0x40 >> +#define CMD_AM_TUNE_FREQ_NARGS 3 >> +#define CMD_AM_TUNE_FREQ_NRESP 1 >> + >> +#define CMD_AM_RSQ_STATUS 0x42 >> +#define CMD_AM_RSQ_STATUS_NARGS 1 >> +#define CMD_AM_RSQ_STATUS_NRESP 13 >> + >> +#define CMD_AM_SEEK_START 0x41 >> +#define CMD_AM_SEEK_START_NARGS 1 >> +#define CMD_AM_SEEK_START_NRESP 1 >> + >> + >> +#define CMD_AM_ACF_STATUS 0x45 >> +#define CMD_AM_ACF_STATUS_NRESP 6 >> +#define CMD_AM_ACF_STATUS_NARGS 1 >> + >> +#define CMD_FM_ACF_STATUS 0x35 >> +#define CMD_FM_ACF_STATUS_NRESP 8 >> +#define CMD_FM_ACF_STATUS_NARGS 1 >> + >> +#define CMD_MAX_ARGS_COUNT (10) >> + >> + >> +enum si476x_acf_status_report_bits { >> + SI476X_ACF_BLEND_INT = (1 << 4), >> + SI476X_ACF_HIBLEND_INT = (1 << 3), >> + SI476X_ACF_HICUT_INT = (1 << 2), >> + SI476X_ACF_CHBW_INT = (1 << 1), >> + SI476X_ACF_SOFTMUTE_INT = (1 << 0), >> + >> + SI476X_ACF_SMUTE = (1 << 0), >> + SI476X_ACF_SMATTN = 0b11111, >> + SI476X_ACF_PILOT = (1 << 7), >> + SI476X_ACF_STBLEND = ~SI476X_ACF_PILOT, >> +}; >> + >> +enum si476x_agc_status_report_bits { >> + SI476X_AGC_MXHI = (1 << 5), >> + SI476X_AGC_MXLO = (1 << 4), >> + SI476X_AGC_LNAHI = (1 << 3), >> + SI476X_AGC_LNALO = (1 << 2), >> +}; >> + >> +enum si476x_errors { >> + SI476X_ERR_BAD_COMMAND = 0x10, >> + SI476X_ERR_BAD_ARG1 = 0x11, >> + SI476X_ERR_BAD_ARG2 = 0x12, >> + SI476X_ERR_BAD_ARG3 = 0x13, >> + SI476X_ERR_BAD_ARG4 = 0x14, >> + SI476X_ERR_BUSY = 0x18, >> + SI476X_ERR_BAD_INTERNAL_MEMORY = 0x20, >> + SI476X_ERR_BAD_PATCH = 0x30, >> + SI476X_ERR_BAD_BOOT_MODE = 0x31, >> + SI476X_ERR_BAD_PROPERTY = 0x40, >> +}; >> + >> + >> +static int si476x_core_parse_and_nag_about_error(struct si476x_core *core) >> +{ >> + int err; >> + char *cause; >> + u8 buffer[2]; >> + >> + if (core->revision != SI476X_REVISION_A10) { >> + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, >> + buffer, sizeof(buffer)); >> + if (err == sizeof(buffer)) { >> + switch (buffer[1]) { >> + case SI476X_ERR_BAD_COMMAND: >> + cause = "Bad command"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_ARG1: >> + cause = "Bad argument #1"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_ARG2: >> + cause = "Bad argument #2"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_ARG3: >> + cause = "Bad argument #3"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_ARG4: >> + cause = "Bad argument #4"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BUSY: >> + cause = "Chip is busy"; >> + err = -EBUSY; >> + break; >> + case SI476X_ERR_BAD_INTERNAL_MEMORY: >> + cause = "Bad internal memory"; >> + err = -EIO; >> + break; >> + case SI476X_ERR_BAD_PATCH: >> + cause = "Bad patch"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_BOOT_MODE: >> + cause = "Bad boot mode"; >> + err = -EINVAL; >> + break; >> + case SI476X_ERR_BAD_PROPERTY: >> + cause = "Bad property"; >> + err = -EINVAL; >> + break; >> + default: >> + cause = "Unknown"; >> + err = -EIO; >> + } >> + >> + dev_err(&core->client->dev, >> + "[Chip error status]: %s\n", cause); >> + } else { >> + dev_err(&core->client->dev, >> + "Failed to fetch error code\n"); >> + err = (err >= 0) ? -EIO : err; >> + } >> + } else { >> + err = -EIO; >> + } >> + >> + return err; >> +} >> + >> +/** >> + * __core_send_command() - sends a command to si476x and waits its >> + * response >> + * @core: si476x_device structure for the device we are >> + * communicating with >> + * @command: command id >> + * @args: command arguments we are sending >> + * @argn: actual size of @args >> + * @response: buffer to place the expected response from the device >> + * @respn: actual size of @response >> + * @usecs: amount of time to wait before reading the response (in >> + * usecs) >> + * >> + * Function returns 0 on succsess and negative error code on >> + * failure >> + */ >> +static int __core_send_command(struct si476x_core *core, >> + const u8 command, >> + const u8 args[], >> + const int argn, >> + u8 resp[], >> + const int respn, >> + const int usecs) >> +{ >> + struct i2c_client *client = core->client; >> + int err; >> + u8 data[CMD_MAX_ARGS_COUNT + 1]; >> + >> + if (argn > CMD_MAX_ARGS_COUNT) { >> + err = -ENOMEM; >> + goto exit; >> + } >> + >> + if (!client->adapter) { >> + err = -ENODEV; >> + goto exit; >> + } >> + >> + /* First send the command and its arguments */ >> + data[0] = command; >> + memcpy(&data[1], args, argn); >> + DBG_BUFFER(&client->dev, "Command:\n", data, argn + 1); >> + >> + err = si476x_i2c_xfer(core, SI476X_I2C_SEND, (char *) data, argn + 1); >> + if (err != argn + 1) { >> + dev_err(&core->client->dev, >> + "Error while sending command 0x%02x\n", >> + command); >> + err = (err >= 0) ? -EIO : err; >> + goto exit; >> + } >> + /* Set CTS to zero only after the command is send to avoid >> + * possible racing conditions when working in polling mode */ >> + atomic_set(&core->cts, 0); >> + >> + if (!wait_event_timeout(core->command, >> + atomic_read(&core->cts), >> + usecs_to_jiffies(usecs) + 1)) >> + dev_warn(&core->client->dev, >> + "(%s) [CMD 0x%02x] Device took too much time to answer.\n", >> + __func__, command); >> + >> + /* >> + When working in polling mode, for some reason the tuner will >> + report CTS bit as being set in the first status byte read, >> + but all the consequtive ones will return zros until the >> + tuner is actually completed the POWER_UP command. To >> + workaround that we wait for second CTS to be reported >> + */ >> + if (unlikely(!core->client->irq && command == CMD_POWER_UP)) { >> + if (!wait_event_timeout(core->command, >> + atomic_read(&core->cts), >> + usecs_to_jiffies(usecs) + 1)) >> + dev_warn(&core->client->dev, >> + "(%s) Power up took too much time.\n", >> + __func__); >> + } >> + >> + /* Then get the response */ >> + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, resp, respn); >> + if (err != respn) { >> + dev_err(&core->client->dev, >> + "Error while reading response for command 0x%02x\n", >> + command); >> + err = (err >= 0) ? -EIO : err; >> + goto exit; >> + } >> + DBG_BUFFER(&client->dev, "Response:\n", resp, respn); >> + >> + err = 0; >> + >> + if (resp[0] & SI476X_ERR) { >> + dev_err(&core->client->dev, "[CMD 0x%02x] Chip set error flag\n", command); >> + err = si476x_core_parse_and_nag_about_error(core); >> + goto exit; >> + } >> + >> + if (!(resp[0] & SI476X_CTS)) >> + err = -EBUSY; >> +exit: >> + return err; >> +} >> + >> +#define CORE_SEND_COMMAND(core, cmd, args, resp, timeout) \ >> + __core_send_command(core, cmd, args, \ >> + ARRAY_SIZE(args), \ >> + resp, ARRAY_SIZE(resp), \ >> + timeout) > I'm not sure I like this macro. I do not believe it is worth it just to hide > the two ARRAY_SIZE arguments. I would recommend that you remove it, I believe > it will make the code more readable. > >> + >> +static int si476x_cmd_clear_stc(struct si476x_core *core) >> +{ >> + int err; >> + struct si476x_rsq_status_args args = { >> + .primary = false, >> + .rsqack = false, >> + .attune = false, >> + .cancel = false, >> + .stcack = true, >> + }; >> + >> + switch(core->power_up_parameters.func) { >> + case SI476X_FUNC_FM_RECEIVER: >> + err = si476x_core_cmd_fm_rsq_status(core, &args, NULL); >> + break; >> + case SI476X_FUNC_AM_RECEIVER: >> + err = si476x_core_cmd_am_rsq_status(core, &args, NULL); >> + break; >> + default: >> + err = -EINVAL; >> + } >> + >> + return err; >> +} >> + >> +static int si476x_cmd_tune_seek_freq(struct si476x_core *core, >> + uint8_t cmd, >> + const uint8_t args[], size_t argn, >> + uint8_t *resp, size_t respn) >> +{ >> + int err; >> + >> + >> + atomic_set(&core->stc, 0); >> + err = __core_send_command(core, cmd, args, argn, >> + resp, respn, >> + atomic_read(&core->timeouts.command)); >> + if (!err) { >> + wait_event_killable(core->tuning, >> + atomic_read(&core->stc)); >> + si476x_cmd_clear_stc(core); >> + } >> + >> + return err; >> +} >> + >> +/** >> + * si476x_cmd_func_info() - send 'FUNC_INFO' command to the device >> + * @core: device to send the command to >> + * @info: struct si476x_func_info to fill all the information >> + * returned by the command >> + * >> + * The command requests the firmware and patch version for currently >> + * loaded firmware (dependent on the function of the device FM/AM/WB) >> + * >> + * Function returns 0 on succsess and negative error code on >> + * failure >> + */ >> +int si476x_core_cmd_func_info(struct si476x_core *core, >> + struct si476x_func_info *info) >> +{ >> + int err; >> + u8 resp[CMD_FUNC_INFO_NRESP]; >> + >> + err = __core_send_command(core, CMD_FUNC_INFO, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + atomic_read(&core->timeouts.command)); >> + >> + info->firmware.major = resp[1]; >> + info->firmware.minor[0] = resp[2]; >> + info->firmware.minor[1] = resp[3]; >> + >> + info->patch_id = ((u16) resp[4] << 8) | resp[5]; >> + info->func = resp[6]; >> + >> + return err; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_func_info); >> + >> +/** >> + * si476x_cmd_set_property() - send 'SET_PROPERTY' command to the device >> + * @core: device to send the command to >> + * @property: property address >> + * @value: property value >> + * >> + * Function returns 0 on succsess and negative error code on >> + * failure >> + */ >> +int si476x_core_cmd_set_property(struct si476x_core *core, >> + u16 property, u16 value) >> +{ >> + u8 resp[CMD_SET_PROPERTY_NRESP]; >> + const u8 args[CMD_SET_PROPERTY_NARGS] = { >> + 0x00, >> + msb(property), >> + lsb(property), >> + msb(value), >> + lsb(value), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_SET_PROPERTY, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_set_property); >> + >> +/** >> + * si476x_cmd_get_property() - send 'GET_PROPERTY' command to the device >> + * @core: device to send the command to >> + * @property: property address >> + * >> + * Function return the value of property as u16 on success or a >> + * negative error on failure >> + */ >> +int si476x_core_cmd_get_property(struct si476x_core *core, u16 property) >> +{ >> + int err; >> + u8 resp[CMD_GET_PROPERTY_NRESP]; >> + const u8 args[CMD_GET_PROPERTY_NARGS] = { >> + 0x00, >> + msb(property), >> + lsb(property), >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_GET_PROPERTY, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + if (err < 0) >> + return err; >> + else >> + return be16_to_cpup((__be16 *)(resp + 2)); > I would replace this with a ? : construction. > >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_get_property); >> + >> +/** >> + * si476x_cmd_dig_audio_pin_cfg() - send 'DIG_AUDIO_PIN_CFG' command to >> + * the device >> + * @core: device to send the command to >> + * @dclk: DCLK pin function configuration: >> + * #SI476X_DCLK_NOOP - do not modify the behaviour >> + * #SI476X_DCLK_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * #SI476X_DCLK_DAUDIO - set the pin to be a part of digital >> + * audio interface >> + * @dfs: DFS pin function configuration: >> + * #SI476X_DFS_NOOP - do not modify the behaviour >> + * #SI476X_DFS_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_DFS_DAUDIO - set the pin to be a part of digital >> + * audio interface >> + * @dout - DOUT pin function configuration: >> + * SI476X_DOUT_NOOP - do not modify the behaviour >> + * SI476X_DOUT_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_DOUT_I2S_OUTPUT - set this pin to be digital out on I2S >> + * port 1 >> + * SI476X_DOUT_I2S_INPUT - set this pin to be digital in on I2S >> + * port 1 >> + * @xout - XOUT pin function configuration: >> + * SI476X_XOUT_NOOP - do not modify the behaviour >> + * SI476X_XOUT_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_XOUT_I2S_INPUT - set this pin to be digital in on I2S >> + * port 1 >> + * SI476X_XOUT_MODE_SELECT - set this pin to be the input that >> + * selects the mode of the I2S audio >> + * combiner (analog or HD) >> + * [SI4761/63/65/67 Only] >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_dig_audio_pin_cfg(struct si476x_core *core, >> + enum si476x_dclk_config dclk, >> + enum si476x_dfs_config dfs, >> + enum si476x_dout_config dout, >> + enum si476x_xout_config xout) >> +{ >> + u8 resp[CMD_DIG_AUDIO_PIN_CFG_NRESP]; >> + const u8 args[CMD_DIG_AUDIO_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(dclk), >> + PIN_CFG_BYTE(dfs), >> + PIN_CFG_BYTE(dout), >> + PIN_CFG_BYTE(xout), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_DIG_AUDIO_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_dig_audio_pin_cfg); >> + >> +/** >> + * si476x_cmd_zif_pin_cfg - send 'ZIF_PIN_CFG_COMMAND' >> + * @core - device to send the command to >> + * @iqclk - IQCL pin function configuration: >> + * SI476X_IQCLK_NOOP - do not modify the behaviour >> + * SI476X_IQCLK_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_IQCLK_IQ - set pin to be a part of I/Q interace >> + * in master mode >> + * @iqfs - IQFS pin function configuration: >> + * SI476X_IQFS_NOOP - do not modify the behaviour >> + * SI476X_IQFS_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_IQFS_IQ - set pin to be a part of I/Q interace >> + * in master mode >> + * @iout - IOUT pin function configuration: >> + * SI476X_IOUT_NOOP - do not modify the behaviour >> + * SI476X_IOUT_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_IOUT_OUTPUT - set pin to be I out >> + * @qout - QOUT pin function configuration: >> + * SI476X_QOUT_NOOP - do not modify the behaviour >> + * SI476X_QOUT_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_QOUT_OUTPUT - set pin to be Q out >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_zif_pin_cfg(struct si476x_core *core, >> + enum si476x_iqclk_config iqclk, >> + enum si476x_iqfs_config iqfs, >> + enum si476x_iout_config iout, >> + enum si476x_qout_config qout) >> +{ >> + u8 resp[CMD_ZIF_PIN_CFG_NRESP]; >> + const u8 args[CMD_ZIF_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(iqclk), >> + PIN_CFG_BYTE(iqfs), >> + PIN_CFG_BYTE(iout), >> + PIN_CFG_BYTE(qout), >> + }; > Should this be static const? Or doesn't it matter? I'm not entirely sure if > the compiler handles that differently. AFAIK, declaring it static const would make this variable shared among all the calls to si476x_core_cmd_zif_pin_cfg, which is certainly not the intent. To the best of my knowledge this will still allocate the variable on the stack. > >> + >> + return CORE_SEND_COMMAND(core, CMD_ZIF_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_zif_pin_cfg); >> + >> +/** >> + * si476x_cmd_ic_link_gpo_ctl_pin_cfg - send >> + * 'IC_LINK_GPIO_CTL_PIN_CFG' comand to the device >> + * @core - device to send the command to >> + * @icin - ICIN pin function configuration: >> + * SI476X_ICIN_NOOP - do not modify the behaviour >> + * SI476X_ICIN_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_ICIN_GPO1_HIGH - set pin to be an output, drive it high >> + * SI476X_ICIN_GPO1_LOW - set pin to be an output, drive it low >> + * SI476X_ICIN_IC_LINK - set the pin to be a part of Inter-Chip link >> + * @icip - ICIP pin function configuration: >> + * SI476X_ICIP_NOOP - do not modify the behaviour >> + * SI476X_ICIP_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_ICIP_GPO1_HIGH - set pin to be an output, drive it high >> + * SI476X_ICIP_GPO1_LOW - set pin to be an output, drive it low >> + * SI476X_ICIP_IC_LINK - set the pin to be a part of Inter-Chip link >> + * @icon - ICON pin function configuration: >> + * SI476X_ICON_NOOP - do not modify the behaviour >> + * SI476X_ICON_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_ICON_I2S - set the pin to be a part of audio >> + * interface in slave mode (DCLK) >> + * SI476X_ICON_IC_LINK - set the pin to be a part of Inter-Chip link >> + * @icop - ICOP pin function configuration: >> + * SI476X_ICOP_NOOP - do not modify the behaviour >> + * SI476X_ICOP_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_ICOP_I2S - set the pin to be a part of audio >> + * interface in slave mode (DOUT) >> + * [Si4761/63/65/67 Only] >> + * SI476X_ICOP_IC_LINK - set the pin to be a part of Inter-Chip link >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_ic_link_gpo_ctl_pin_cfg(struct si476x_core *core, >> + enum si476x_icin_config icin, >> + enum si476x_icip_config icip, >> + enum si476x_icon_config icon, >> + enum si476x_icop_config icop) >> +{ >> + u8 resp[CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP]; >> + const u8 args[CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(icin), >> + PIN_CFG_BYTE(icip), >> + PIN_CFG_BYTE(icon), >> + PIN_CFG_BYTE(icop), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_IC_LINK_GPO_CTL_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_ic_link_gpo_ctl_pin_cfg); >> + >> +/** >> + * si476x_cmd_ana_audio_pin_cfg - send 'ANA_AUDIO_PIN_CFG' to the >> + * device >> + * @core - device to send the command to >> + * @lrout - LROUT pin function configuration: >> + * SI476X_LROUT_NOOP - do not modify the behaviour >> + * SI476X_LROUT_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_LROUT_AUDIO - set pin to be audio output >> + * SI476X_LROUT_MPX - set pin to be MPX output >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_ana_audio_pin_cfg(struct si476x_core *core, >> + enum si476x_lrout_config lrout) >> +{ >> + u8 resp[CMD_ANA_AUDIO_PIN_CFG_NRESP]; >> + const u8 args[CMD_ANA_AUDIO_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(lrout), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_ANA_AUDIO_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_ana_audio_pin_cfg); >> + >> + >> +/** >> + * si476x_cmd_intb_pin_cfg - send 'INTB_PIN_CFG' command to the device >> + * @core - device to send the command to >> + * @intb - INTB pin function configuration: >> + * SI476X_INTB_NOOP - do not modify the behaviour >> + * SI476X_INTB_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_INTB_DAUDIO - set pin to be a part of digital >> + * audio interface in slave mode >> + * SI476X_INTB_IRQ - set pin to be an interrupt request line >> + * @a1 - A1 pin function configuration: >> + * SI476X_A1_NOOP - do not modify the behaviour >> + * SI476X_A1_TRISTATE - put the pin in tristate condition, >> + * enable 1MOhm pulldown >> + * SI476X_A1_IRQ - set pin to be an interrupt request line >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +static int si476x_core_cmd_intb_pin_cfg_a10(struct si476x_core *core, >> + enum si476x_intb_config intb, >> + enum si476x_a1_config a1) >> +{ >> + u8 resp[CMD_INTB_PIN_CFG_A10_NRESP]; >> + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(intb), >> + PIN_CFG_BYTE(a1), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> + >> +static int si476x_core_cmd_intb_pin_cfg_a20(struct si476x_core *core, >> + enum si476x_intb_config intb, >> + enum si476x_a1_config a1) >> +{ >> + u8 resp[CMD_INTB_PIN_CFG_A20_NRESP]; >> + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { >> + PIN_CFG_BYTE(intb), >> + PIN_CFG_BYTE(a1), >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> + >> + >> + >> +/** >> + * si476x_cmd_am_rsq_status - send 'FM_TUNE_FREQ' command to the >> + * device >> + * @core - device to send the command to >> + * @rsqack - if set command clears RSQINT, SNRINT, SNRLINT, RSSIHINT, >> + * RSSSILINT, BLENDINT, MULTHINT and MULTLINT >> + * @attune - when set the values in the status report are the values >> + * that were calculated at tune >> + * @cancel - abort ongoing seek/tune opertation >> + * @stcack - clear the STCINT bin in status register >> + * @report - all signal quality information retured by the command >> + * (if NULL then the output of the command is ignored) >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_am_rsq_status(struct si476x_core *core, >> + struct si476x_rsq_status_args *rsqargs, >> + struct si476x_rsq_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_AM_RSQ_STATUS_NRESP]; >> + const u8 args[CMD_AM_RSQ_STATUS_NARGS] = { >> + rsqargs->rsqack << 3 | rsqargs->attune << 2 | >> + rsqargs->cancel << 1 | rsqargs->stcack, >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_AM_RSQ_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (report) { > Do you really need to test 'report'? Does it ever make sense if this is > called with a NULL report pointer? Unfortunately yes. This command is also used to acknowledge and STC(seek-tune completed) interrupt. >> + report->snrhint = 0b00001000 & resp[1]; >> + report->snrlint = 0b00000100 & resp[1]; >> + report->rssihint = 0b00000010 & resp[1]; >> + report->rssilint = 0b00000001 & resp[1]; >> + >> + report->bltf = 0b10000000 & resp[2]; >> + report->snr_ready = 0b00100000 & resp[2]; >> + report->rssiready = 0b00001000 & resp[2]; >> + report->afcrl = 0b00000010 & resp[2]; >> + report->valid = 0b00000001 & resp[2]; >> + >> + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); >> + report->freqoff = resp[5]; >> + report->rssi = resp[6]; >> + report->snr = resp[7]; >> + report->lassi = resp[9]; >> + report->hassi = resp[10]; >> + report->mult = resp[11]; >> + report->dev = resp[12]; >> + } >> + >> + return err; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_rsq_status); >> + >> +int si476x_core_cmd_fm_acf_status(struct si476x_core *core, >> + struct si476x_acf_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_ACF_STATUS_NRESP]; >> + const u8 args[CMD_FM_ACF_STATUS_NARGS] = { >> + 0x0, >> + }; >> + >> + if (!report) >> + return -EINVAL; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_ACF_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (!err) { > I recommend to simplify this: > > if (err) > return err; > >> + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; >> + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; >> + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; >> + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; >> + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; >> + report->smute = resp[2] & SI476X_ACF_SMUTE; >> + report->smattn = resp[3] & SI476X_ACF_SMATTN; >> + report->chbw = resp[4]; >> + report->hicut = resp[5]; >> + report->hiblend = resp[6]; >> + report->pilot = resp[7] & SI476X_ACF_PILOT; >> + report->stblend = resp[7] & SI476X_ACF_STBLEND; > Then all the lines above can have one indent less, which makes it easier to read. > Ditto elsewhere. > >> + } >> + >> + return err; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_acf_status); >> + >> +int si476x_core_cmd_am_acf_status(struct si476x_core *core, >> + struct si476x_acf_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_AM_ACF_STATUS_NRESP]; >> + const u8 args[CMD_AM_ACF_STATUS_NARGS] = { >> + 0x0, >> + }; >> + >> + if (!report) >> + return -EINVAL; >> + >> + err = CORE_SEND_COMMAND(core, CMD_AM_ACF_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (!err) { >> + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; >> + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; >> + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; >> + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; >> + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; >> + report->smute = resp[2] & SI476X_ACF_SMUTE; >> + report->smattn = resp[3] & SI476X_ACF_SMATTN; >> + report->chbw = resp[4]; >> + report->hicut = resp[5]; >> + } >> + >> + return err; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_acf_status); >> + >> + >> +/** >> + * si476x_cmd_fm_seek_start - send 'FM_SEEK_START' command to the >> + * device >> + * @core - device to send the command to >> + * @seekup - if set the direction of the search is 'up' >> + * @wrap - if set seek wraps when hitting band limit >> + * >> + * This function begins search for a valid station. The station is >> + * considered valid when 'FM_VALID_SNR_THRESHOLD' and >> + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria >> + * are met. >> +} * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_fm_seek_start(struct si476x_core *core, >> + bool seekup, bool wrap) >> +{ >> + u8 resp[CMD_FM_SEEK_START_NRESP]; >> + const u8 args[CMD_FM_SEEK_START_NARGS] = { >> + seekup << 3 | wrap << 2, >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_FM_SEEK_START, >> + args, sizeof(args), resp, sizeof(resp)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_seek_start); >> + >> +/** >> + * si476x_cmd_fm_rds_status - send 'FM_RDS_STATUS' command to the >> + * device >> + * @core - device to send the command to >> + * @status_only - if set the data is not removed from RDSFIFO, >> + * RDSFIFOUSED is not decremented and data in all the >> + * rest RDS data contains the last valid info received >> + * @mtfifo if set the command clears RDS receive FIFO >> + * @intack if set the command clards the RDSINT bit. >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_fm_rds_status(struct si476x_core *core, >> + bool status_only, >> + bool mtfifo, >> + bool intack, >> + struct si476x_rds_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_RDS_STATUS_NRESP]; >> + const u8 args[CMD_FM_RDS_STATUS_NARGS] = { >> + status_only << 2 | mtfifo << 1 | intack, >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (!err && report) { >> + report->rdstpptyint = 0b00010000 & resp[1]; >> + report->rdspiint = 0b00001000 & resp[1]; >> + report->rdssyncint = 0b00000010 & resp[1]; >> + report->rdsfifoint = 0b00000001 & resp[1]; >> + >> + report->tpptyvalid = 0b00010000 & resp[2]; >> + report->pivalid = 0b00001000 & resp[2]; >> + report->rdssync = 0b00000010 & resp[2]; >> + report->rdsfifolost = 0b00000001 & resp[2]; >> + >> + report->tp = 0b00100000 & resp[3]; >> + report->pty = 0b00011111 & resp[3]; >> + >> + report->pi = be16_to_cpup((__be16 *)(resp + 4)); >> + report->rdsfifoused = resp[6]; >> + >> + report->ble[V4L2_RDS_BLOCK_A] = 0b11000000 & resp[7]; >> + report->ble[V4L2_RDS_BLOCK_B] = 0b00110000 & resp[7]; >> + report->ble[V4L2_RDS_BLOCK_C] = 0b00001100 & resp[7]; >> + report->ble[V4L2_RDS_BLOCK_D] = 0b00000011 & resp[7]; >> + >> + report->rds[V4L2_RDS_BLOCK_A].block = V4L2_RDS_BLOCK_A; >> + report->rds[V4L2_RDS_BLOCK_A].msb = resp[8]; >> + report->rds[V4L2_RDS_BLOCK_A].lsb = resp[9]; >> + >> + report->rds[V4L2_RDS_BLOCK_B].block = V4L2_RDS_BLOCK_B; >> + report->rds[V4L2_RDS_BLOCK_B].msb = resp[10]; >> + report->rds[V4L2_RDS_BLOCK_B].lsb = resp[11]; >> + >> + report->rds[V4L2_RDS_BLOCK_C].block = V4L2_RDS_BLOCK_C; >> + report->rds[V4L2_RDS_BLOCK_C].msb = resp[12]; >> + report->rds[V4L2_RDS_BLOCK_C].lsb = resp[13]; >> + >> + report->rds[V4L2_RDS_BLOCK_D].block = V4L2_RDS_BLOCK_D; >> + report->rds[V4L2_RDS_BLOCK_D].msb = resp[14]; >> + report->rds[V4L2_RDS_BLOCK_D].lsb = resp[15]; >> + } >> + >> + return err; >> +} >> + >> +int si476x_core_cmd_fm_rds_blockcount(struct si476x_core *core, >> + bool clear, >> + struct si476x_rds_blockcount_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_RDS_BLOCKCOUNT_NRESP]; >> + const u8 args[CMD_FM_RDS_BLOCKCOUNT_NARGS] = { >> + clear, >> + }; >> + >> + if (!report) >> + return -EINVAL; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_BLOCKCOUNT, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (!err) { >> + report->expected = be16_to_cpup((__be16 *)(resp + 2)); >> + report->received = be16_to_cpup((__be16 *)(resp + 4)); >> + report->uncorrectable = be16_to_cpup((__be16 *)(resp + 6)); >> + } >> + >> + return err; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rds_blockcount); >> + >> +int si476x_core_cmd_fm_phase_diversity(struct si476x_core *core, >> + enum si476x_phase_diversity_mode mode) >> +{ >> + u8 resp[CMD_FM_PHASE_DIVERSITY_NRESP]; >> + const u8 args[CMD_FM_PHASE_DIVERSITY_NARGS] = { >> + mode & 0b111, >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_FM_PHASE_DIVERSITY, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_diversity); >> +/** >> + * si476x_core_cmd_fm_phase_div_status() - get the phase diversity >> + * status >> + * >> + * @core: si476x device >> + * >> + * NOTE caller must hold core lock >> + * >> + * Function returns the value of the status bit in case of success and >> + * negative error code in case of failre. >> + */ >> +int si476x_core_cmd_fm_phase_div_status(struct si476x_core *core) >> +{ >> + int err; >> + u8 resp[CMD_FM_PHASE_DIV_STATUS_NRESP]; >> + >> + err = __core_send_command(core, CMD_FM_PHASE_DIV_STATUS, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + atomic_read(&core->timeouts.command)); >> + >> + return (err < 0) ? err : resp[1]; >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_div_status); >> + >> + >> +/** >> + * si476x_cmd_am_seek_start - send 'FM_SEEK_START' command to the >> + * device >> + * @core - device to send the command to >> + * @seekup - if set the direction of the search is 'up' >> + * @wrap - if set seek wraps when hitting band limit >> + * >> + * This function begins search for a valid station. The station is >> + * considered valid when 'FM_VALID_SNR_THRESHOLD' and >> + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria >> + * are met. >> + * >> + * Function returns 0 on success and negative error code on failure >> + */ >> +int si476x_core_cmd_am_seek_start(struct si476x_core *core, >> + bool seekup, bool wrap) >> +{ >> + u8 resp[CMD_AM_SEEK_START_NRESP]; >> + const u8 args[CMD_AM_SEEK_START_NARGS] = { >> + seekup << 3 | wrap << 2, >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_AM_SEEK_START, >> + args, sizeof(args), resp, sizeof(resp)); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_seek_start); >> + >> + >> + >> +static int si476x_core_cmd_power_up_a10(struct si476x_core *core, >> + struct si476x_power_up_args *puargs) >> +{ >> + u8 resp[CMD_POWER_UP_A10_NRESP]; >> + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); >> + const bool ctsen = (core->client->irq != 0); >> + const u8 args[CMD_POWER_UP_A10_NARGS] = { >> + 0xF7, /* Reserved, always 0xF7 */ >> + 0x3F & puargs->xcload, /* First two bits are reserved to be >> + * zeros */ >> + ctsen << 7 | intsel << 6 | 0x07, /* Last five bits >> + * are reserved to >> + * be written as 0x7 */ >> + puargs->func << 4 | puargs->freq, >> + 0x11, /* Reserved, always 0x11 */ >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_POWER_UP, >> + args, resp, >> + atomic_read(&core->timeouts.power_up)); >> +} >> + >> +static int si476x_core_cmd_power_up_a20(struct si476x_core *core, >> + struct si476x_power_up_args *puargs) >> +{ >> + u8 resp[CMD_POWER_UP_A20_NRESP]; >> + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); >> + const bool ctsen = (core->client->irq != 0); >> + const u8 args[CMD_POWER_UP_A20_NARGS] = { >> + puargs->ibias6x << 7 | puargs->xstart, >> + 0x3F & puargs->xcload, /* First two bits are reserved to be >> + * zeros */ >> + ctsen << 7 | intsel << 6 | puargs->fastboot << 5 | >> + puargs->xbiashc << 3 | puargs->xbias, >> + puargs->func << 4 | puargs->freq, >> + 0x10 | puargs->xmode, >> + }; >> + >> + return CORE_SEND_COMMAND(core, CMD_POWER_UP, >> + args, resp, >> + atomic_read(&core->timeouts.power_up)); >> +} >> + >> +static int si476x_core_cmd_power_down_a10(struct si476x_core *core, >> + struct si476x_power_down_args *pdargs) >> +{ >> + u8 resp[CMD_POWER_DOWN_A10_NRESP]; >> + >> + return __core_send_command(core, CMD_POWER_DOWN, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + atomic_read(&core->timeouts.command)); >> +} >> + >> +static int si476x_core_cmd_power_down_a20(struct si476x_core *core, >> + struct si476x_power_down_args *pdargs) >> +{ >> + u8 resp[CMD_POWER_DOWN_A20_NRESP]; >> + const u8 args[CMD_POWER_DOWN_A20_NARGS] = { >> + pdargs->xosc, >> + }; >> + return CORE_SEND_COMMAND(core, CMD_POWER_DOWN, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> +} >> + >> +static int si476x_core_cmd_am_tune_freq_a10(struct si476x_core *core, >> + struct si476x_tune_freq_args *tuneargs) >> +{ >> + >> + const int am_freq = tuneargs->freq; >> + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; >> + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { >> + (tuneargs->hd << 6), >> + msb(am_freq), >> + lsb(am_freq), >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, >> + sizeof(args), >> + resp, sizeof(resp)); >> +} >> + >> +static int si476x_core_cmd_am_tune_freq_a20(struct si476x_core *core, >> + struct si476x_tune_freq_args *tuneargs) >> +{ >> + const int am_freq = tuneargs->freq; >> + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; >> + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { >> + (tuneargs->zifsr << 6) | (tuneargs->injside & 0b11), >> + msb(am_freq), >> + lsb(am_freq), >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, sizeof(args), >> + resp, sizeof(resp)); >> +} >> + >> +static int si476x_core_cmd_fm_rsq_status_a10(struct si476x_core *core, >> + struct si476x_rsq_status_args *rsqargs, >> + struct si476x_rsq_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; >> + const u8 args[CMD_FM_RSQ_STATUS_A10_NARGS] = { >> + rsqargs->rsqack << 3 | rsqargs->attune << 2 | >> + rsqargs->cancel << 1 | rsqargs->stcack, >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (report && !err) { >> + report->multhint = 0b10000000 & resp[1]; >> + report->multlint = 0b01000000 & resp[1]; >> + report->snrhint = 0b00001000 & resp[1]; >> + report->snrlint = 0b00000100 & resp[1]; >> + report->rssihint = 0b00000010 & resp[1]; >> + report->rssilint = 0b00000001 & resp[1]; >> + >> + report->bltf = 0b10000000 & resp[2]; >> + report->snr_ready = 0b00100000 & resp[2]; >> + report->rssiready = 0b00001000 & resp[2]; >> + report->afcrl = 0b00000010 & resp[2]; >> + report->valid = 0b00000001 & resp[2]; >> + >> + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); >> + report->freqoff = resp[5]; >> + report->rssi = resp[6]; >> + report->snr = resp[7]; >> + report->lassi = resp[9]; >> + report->hassi = resp[10]; >> + report->mult = resp[11]; >> + report->dev = resp[12]; >> + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); >> + report->assi = resp[15]; >> + report->usn = resp[16]; >> + } >> + >> + return err; >> +} >> + >> +static int si476x_core_cmd_fm_rsq_status_a20(struct si476x_core *core, >> + struct si476x_rsq_status_args *rsqargs, >> + struct si476x_rsq_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; >> + >> + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { >> + rsqargs->primary << 4 | rsqargs->rsqack << 3 | >> + rsqargs->attune << 2 | rsqargs->cancel << 1 | >> + rsqargs->stcack, >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (report && !err) { >> + report->multhint = 0b10000000 & resp[1]; >> + report->multlint = 0b01000000 & resp[1]; >> + report->snrhint = 0b00001000 & resp[1]; >> + report->snrlint = 0b00000100 & resp[1]; >> + report->rssihint = 0b00000010 & resp[1]; >> + report->rssilint = 0b00000001 & resp[1]; >> + >> + report->bltf = 0b10000000 & resp[2]; >> + report->snr_ready = 0b00100000 & resp[2]; >> + report->rssiready = 0b00001000 & resp[2]; >> + report->afcrl = 0b00000010 & resp[2]; >> + report->valid = 0b00000001 & resp[2]; >> + >> + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); >> + report->freqoff = resp[5]; >> + report->rssi = resp[6]; >> + report->snr = resp[7]; >> + report->lassi = resp[9]; >> + report->hassi = resp[10]; >> + report->mult = resp[11]; >> + report->dev = resp[12]; >> + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); >> + report->assi = resp[15]; >> + report->usn = resp[16]; >> + } >> + >> + return err; >> +} >> + >> + >> +static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core, >> + struct si476x_rsq_status_args *rsqargs, >> + struct si476x_rsq_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_FM_RSQ_STATUS_A30_NRESP]; >> + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { >> + rsqargs->primary << 4 | rsqargs->rsqack << 3 | >> + rsqargs->attune << 2 | rsqargs->cancel << 1 | >> + rsqargs->stcack, >> + }; >> + >> + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, >> + args, resp, >> + atomic_read(&core->timeouts.command)); >> + >> + if (report && !err) { >> + report->multhint = 0b10000000 & resp[1]; >> + report->multlint = 0b01000000 & resp[1]; >> + report->snrhint = 0b00001000 & resp[1]; >> + report->snrlint = 0b00000100 & resp[1]; >> + report->rssihint = 0b00000010 & resp[1]; >> + report->rssilint = 0b00000001 & resp[1]; >> + >> + report->bltf = 0b10000000 & resp[2]; >> + report->snr_ready = 0b00100000 & resp[2]; >> + report->rssiready = 0b00001000 & resp[2]; >> + report->injside = 0b00000100 & resp[2]; >> + report->afcrl = 0b00000010 & resp[2]; >> + report->valid = 0b00000001 & resp[2]; >> + >> + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); >> + report->freqoff = resp[5]; >> + report->rssi = resp[6]; >> + report->snr = resp[7]; >> + report->issi = resp[8]; >> + report->lassi = resp[9]; >> + report->hassi = resp[10]; >> + report->mult = resp[11]; >> + report->dev = resp[12]; >> + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); >> + report->assi = resp[15]; >> + report->usn = resp[16]; >> + >> + report->pilotdev = resp[17]; >> + report->rdsdev = resp[18]; >> + report->assidev = resp[19]; >> + report->strongdev = resp[20]; >> + report->rdspi = be16_to_cpup((__be16 *)(resp + 21)); >> + } >> + >> + return err; >> +} >> + >> +static int si476x_core_cmd_fm_tune_freq_a10(struct si476x_core *core, >> + struct si476x_tune_freq_args *tuneargs) >> +{ >> + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; >> + const u8 args[CMD_FM_TUNE_FREQ_A10_NARGS] = { >> + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) >> + | (tuneargs->smoothmetrics << 2), >> + msb(tuneargs->freq), >> + lsb(tuneargs->freq), >> + msb(tuneargs->antcap), >> + lsb(tuneargs->antcap) >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), >> + resp, sizeof(resp)); >> +} >> + >> +static int si476x_core_cmd_fm_tune_freq_a20(struct si476x_core *core, >> + struct si476x_tune_freq_args *tuneargs) >> +{ >> + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; >> + const u8 args[CMD_FM_TUNE_FREQ_A20_NARGS] = { >> + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) >> + | (tuneargs->smoothmetrics << 2) | (tuneargs->injside), >> + msb(tuneargs->freq), >> + lsb(tuneargs->freq), >> + }; >> + >> + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), >> + resp, sizeof(resp)); >> +} >> + >> +static int si476x_core_cmd_agc_status_a20(struct si476x_core *core, >> + struct si476x_agc_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_AGC_STATUS_NRESP_A20]; >> + >> + if (!report) >> + return -EINVAL; >> + >> + err = __core_send_command(core, CMD_AGC_STATUS, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + atomic_read(&core->timeouts.command)); >> + if (!err) { >> + report->mxhi = resp[1] & SI476X_AGC_MXHI; >> + report->mxlo = resp[1] & SI476X_AGC_MXLO; >> + report->lnahi = resp[1] & SI476X_AGC_LNAHI; >> + report->lnalo = resp[1] & SI476X_AGC_LNALO; >> + report->fmagc1 = resp[2]; >> + report->fmagc2 = resp[3]; >> + report->pgagain = resp[4]; >> + report->fmwblang = resp[5]; >> + } >> + >> + return err; >> +} >> + >> +static int si476x_core_cmd_agc_status_a10(struct si476x_core *core, >> + struct si476x_agc_status_report *report) >> +{ >> + int err; >> + u8 resp[CMD_AGC_STATUS_NRESP_A10]; >> + >> + if (!report) >> + return -EINVAL; >> + >> + err = __core_send_command(core, CMD_AGC_STATUS, >> + NULL, 0, >> + resp, ARRAY_SIZE(resp), >> + atomic_read(&core->timeouts.command)); >> + if (!err) { >> + report->mxhi = resp[1] & SI476X_AGC_MXHI; >> + report->mxlo = resp[1] & SI476X_AGC_MXLO; >> + report->lnahi = resp[1] & SI476X_AGC_LNAHI; >> + report->lnalo = resp[1] & SI476X_AGC_LNALO; >> + } >> + >> + return err; >> +} >> + >> +static struct { >> + int (*power_up) (struct si476x_core *, >> + struct si476x_power_up_args *); >> + int (*power_down) (struct si476x_core *, >> + struct si476x_power_down_args *); >> + >> + tune_freq_func_t fm_tune_freq; >> + tune_freq_func_t am_tune_freq; >> + >> + int (*fm_rsq_status)(struct si476x_core *, >> + struct si476x_rsq_status_args *, >> + struct si476x_rsq_status_report *); >> + >> + int (*agc_status)(struct si476x_core *, >> + struct si476x_agc_status_report *); >> + int (*intb_pin_cfg)(struct si476x_core *core, >> + enum si476x_intb_config intb, >> + enum si476x_a1_config a1); >> +} si476x_cmds_vtable[] = { >> + [SI476X_REVISION_A10] = { >> + .power_up = si476x_core_cmd_power_up_a10, >> + .power_down = si476x_core_cmd_power_down_a10, >> + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a10, >> + .am_tune_freq = si476x_core_cmd_am_tune_freq_a10, >> + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a10, >> + .agc_status = si476x_core_cmd_agc_status_a10, >> + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a10, >> + }, >> + [SI476X_REVISION_A20] = { >> + .power_up = si476x_core_cmd_power_up_a20, >> + .power_down = si476x_core_cmd_power_down_a20, >> + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, >> + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, >> + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a20, >> + .agc_status = si476x_core_cmd_agc_status_a20, >> + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, >> + }, >> + [SI476X_REVISION_A30] = { >> + .power_up = si476x_core_cmd_power_up_a20, >> + .power_down = si476x_core_cmd_power_down_a20, >> + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, >> + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, >> + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a30, >> + .agc_status = si476x_core_cmd_agc_status_a20, >> + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, >> + }, >> +}; >> + >> +int si476x_core_cmd_power_up(struct si476x_core *core, >> + struct si476x_power_up_args *args) >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].power_up(core, args); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_up); >> + >> +int si476x_core_cmd_power_down(struct si476x_core *core, >> + struct si476x_power_down_args *args) >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].power_down(core, args); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_down); >> + >> +int si476x_core_cmd_fm_tune_freq(struct si476x_core *core, >> + struct si476x_tune_freq_args *args) >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].fm_tune_freq(core, args); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_tune_freq); >> + >> +int si476x_core_cmd_am_tune_freq(struct si476x_core *core, >> + struct si476x_tune_freq_args *args) >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].am_tune_freq(core, args); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_tune_freq); >> + >> +int si476x_core_cmd_fm_rsq_status(struct si476x_core *core, >> + struct si476x_rsq_status_args *args, >> + struct si476x_rsq_status_report *report) >> + >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].fm_rsq_status(core, args, >> + report); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rsq_status); >> + >> +int si476x_core_cmd_agc_status(struct si476x_core *core, >> + struct si476x_agc_status_report *report) >> + >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + return si476x_cmds_vtable[core->revision].agc_status(core, report); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_agc_status); >> + >> +int si476x_core_cmd_intb_pin_cfg(struct si476x_core *core, >> + enum si476x_intb_config intb, >> + enum si476x_a1_config a1) >> +{ >> + BUG_ON(core->revision > SI476X_REVISION_A30 || >> + core->revision == -1); >> + >> + return si476x_cmds_vtable[core->revision].intb_pin_cfg(core, intb, a1); >> +} >> +EXPORT_SYMBOL_GPL(si476x_core_cmd_intb_pin_cfg); >> + >> +MODULE_LICENSE("GPL"); >> +MODULE_AUTHOR("Andrey Smirnov <andrey.smirnov@convergeddevices.net>"); >> +MODULE_DESCRIPTION("API for command exchange for si476x"); >> > Regards, > > Hans > -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
On Mon 8 October 2012 22:06:29 Andrey Smirnov wrote: > On 10/08/2012 01:56 AM, Hans Verkuil wrote: > > On Sat October 6 2012 03:54:59 Andrey Smirnov wrote: > >> This patch adds all the functions used for exchanging commands with > >> the chip. > >> > >> Signed-off-by: Andrey Smirnov <andrey.smirnov@convergeddevices.net> > >> --- > >> drivers/mfd/si476x-cmd.c | 1493 ++++++++++++++++++++++++++++++++++++++++++++++ > >> 1 file changed, 1493 insertions(+) > >> create mode 100644 drivers/mfd/si476x-cmd.c > >> > >> diff --git a/drivers/mfd/si476x-cmd.c b/drivers/mfd/si476x-cmd.c > >> new file mode 100644 > >> index 0000000..f11cf58 > >> --- /dev/null > >> +++ b/drivers/mfd/si476x-cmd.c <snip> > >> +/** > >> + * si476x_cmd_am_rsq_status - send 'FM_TUNE_FREQ' command to the > >> + * device > >> + * @core - device to send the command to > >> + * @rsqack - if set command clears RSQINT, SNRINT, SNRLINT, RSSIHINT, > >> + * RSSSILINT, BLENDINT, MULTHINT and MULTLINT > >> + * @attune - when set the values in the status report are the values > >> + * that were calculated at tune > >> + * @cancel - abort ongoing seek/tune opertation > >> + * @stcack - clear the STCINT bin in status register > >> + * @report - all signal quality information retured by the command > >> + * (if NULL then the output of the command is ignored) I've just noticed that this comment block does not correspond at all to the code. It's a good idea to check the other comment blocks for similar copy/paste errors. > >> + * > >> + * Function returns 0 on success and negative error code on failure > >> + */ > >> +int si476x_core_cmd_am_rsq_status(struct si476x_core *core, > >> + struct si476x_rsq_status_args *rsqargs, > >> + struct si476x_rsq_status_report *report) > >> +{ > >> + int err; > >> + u8 resp[CMD_AM_RSQ_STATUS_NRESP]; > >> + const u8 args[CMD_AM_RSQ_STATUS_NARGS] = { > >> + rsqargs->rsqack << 3 | rsqargs->attune << 2 | > >> + rsqargs->cancel << 1 | rsqargs->stcack, > >> + }; > >> + > >> + err = CORE_SEND_COMMAND(core, CMD_AM_RSQ_STATUS, > >> + args, resp, > >> + atomic_read(&core->timeouts.command)); > >> + > >> + if (report) { > > Do you really need to test 'report'? Does it ever make sense if this is > > called with a NULL report pointer? > > Unfortunately yes. This command is also used to acknowledge and > STC(seek-tune completed) > interrupt. A comment would be welcome here, and in similar cases. It's not obvious. Regards, Hans -- To unsubscribe from this list: send the line "unsubscribe linux-media" in the body of a message to majordomo@vger.kernel.org More majordomo info at http://vger.kernel.org/majordomo-info.html
diff --git a/drivers/mfd/si476x-cmd.c b/drivers/mfd/si476x-cmd.c new file mode 100644 index 0000000..f11cf58 --- /dev/null +++ b/drivers/mfd/si476x-cmd.c @@ -0,0 +1,1493 @@ +/* + * include/media/si476x-cmd.c -- Subroutines implementing command + * protocol of si476x series of chips + * + * Copyright (C) 2012 Innovative Converged Devices(ICD) + * + * Author: Andrey Smirnov <andrey.smirnov@convergeddevices.net> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; version 2 of the License. + * + * This program is distributed in the hope that it will be useful, but + * WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * General Public License for more details. + * + */ +#include <linux/module.h> +#include <linux/completion.h> +#include <linux/delay.h> +#include <linux/atomic.h> +#include <linux/i2c.h> +#include <linux/device.h> +#include <linux/gpio.h> +#include <linux/videodev2.h> + +#include <media/si476x.h> +#include <linux/mfd/si476x-core.h> + +#define msb(x) ((u8)((u16) x >> 8)) +#define lsb(x) ((u8)((u16) x & 0x00FF)) + + + +#define CMD_POWER_UP 0x01 +#define CMD_POWER_UP_A10_NRESP 1 +#define CMD_POWER_UP_A10_NARGS 5 + +#define CMD_POWER_UP_A20_NRESP 1 +#define CMD_POWER_UP_A20_NARGS 5 + +#define POWER_UP_DELAY_MS 110 + +#define CMD_POWER_DOWN 0x11 +#define CMD_POWER_DOWN_A10_NRESP 1 + +#define CMD_POWER_DOWN_A20_NRESP 1 +#define CMD_POWER_DOWN_A20_NARGS 1 + +#define CMD_FUNC_INFO 0x12 +#define CMD_FUNC_INFO_NRESP 7 + +#define CMD_SET_PROPERTY 0x13 +#define CMD_SET_PROPERTY_NARGS 5 +#define CMD_SET_PROPERTY_NRESP 1 + +#define CMD_GET_PROPERTY 0x14 +#define CMD_GET_PROPERTY_NARGS 3 +#define CMD_GET_PROPERTY_NRESP 4 + +#define CMD_AGC_STATUS 0x17 +#define CMD_AGC_STATUS_NRESP_A10 2 +#define CMD_AGC_STATUS_NRESP_A20 6 + +#define PIN_CFG_BYTE(x) (0x7F & (x)) +#define CMD_DIG_AUDIO_PIN_CFG 0x18 +#define CMD_DIG_AUDIO_PIN_CFG_NARGS 4 +#define CMD_DIG_AUDIO_PIN_CFG_NRESP 5 + +#define CMD_ZIF_PIN_CFG 0x19 +#define CMD_ZIF_PIN_CFG_NARGS 4 +#define CMD_ZIF_PIN_CFG_NRESP 5 + +#define CMD_IC_LINK_GPO_CTL_PIN_CFG 0x1A +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS 4 +#define CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP 5 + +#define CMD_ANA_AUDIO_PIN_CFG 0x1B +#define CMD_ANA_AUDIO_PIN_CFG_NARGS 1 +#define CMD_ANA_AUDIO_PIN_CFG_NRESP 2 + +#define CMD_INTB_PIN_CFG 0x1C +#define CMD_INTB_PIN_CFG_NARGS 2 +#define CMD_INTB_PIN_CFG_A10_NRESP 6 +#define CMD_INTB_PIN_CFG_A20_NRESP 3 + +#define CMD_FM_TUNE_FREQ 0x30 +#define CMD_FM_TUNE_FREQ_A10_NARGS 5 +#define CMD_FM_TUNE_FREQ_A20_NARGS 3 +#define CMD_FM_TUNE_FREQ_NRESP 1 + +#define CMD_FM_RSQ_STATUS 0x32 + +#define CMD_FM_RSQ_STATUS_A10_NARGS 1 +#define CMD_FM_RSQ_STATUS_A10_NRESP 17 +#define CMD_FM_RSQ_STATUS_A30_NARGS 1 +#define CMD_FM_RSQ_STATUS_A30_NRESP 23 + + +#define CMD_FM_SEEK_START 0x31 +#define CMD_FM_SEEK_START_NARGS 1 +#define CMD_FM_SEEK_START_NRESP 1 + +#define CMD_FM_RDS_STATUS 0x36 +#define CMD_FM_RDS_STATUS_NARGS 1 +#define CMD_FM_RDS_STATUS_NRESP 16 + +#define CMD_FM_RDS_BLOCKCOUNT 0x37 +#define CMD_FM_RDS_BLOCKCOUNT_NARGS 1 +#define CMD_FM_RDS_BLOCKCOUNT_NRESP 8 + +#define CMD_FM_PHASE_DIVERSITY 0x38 +#define CMD_FM_PHASE_DIVERSITY_NARGS 1 +#define CMD_FM_PHASE_DIVERSITY_NRESP 1 + +#define CMD_FM_PHASE_DIV_STATUS 0x39 +#define CMD_FM_PHASE_DIV_STATUS_NRESP 2 + +#define CMD_AM_TUNE_FREQ 0x40 +#define CMD_AM_TUNE_FREQ_NARGS 3 +#define CMD_AM_TUNE_FREQ_NRESP 1 + +#define CMD_AM_RSQ_STATUS 0x42 +#define CMD_AM_RSQ_STATUS_NARGS 1 +#define CMD_AM_RSQ_STATUS_NRESP 13 + +#define CMD_AM_SEEK_START 0x41 +#define CMD_AM_SEEK_START_NARGS 1 +#define CMD_AM_SEEK_START_NRESP 1 + + +#define CMD_AM_ACF_STATUS 0x45 +#define CMD_AM_ACF_STATUS_NRESP 6 +#define CMD_AM_ACF_STATUS_NARGS 1 + +#define CMD_FM_ACF_STATUS 0x35 +#define CMD_FM_ACF_STATUS_NRESP 8 +#define CMD_FM_ACF_STATUS_NARGS 1 + +#define CMD_MAX_ARGS_COUNT (10) + + +enum si476x_acf_status_report_bits { + SI476X_ACF_BLEND_INT = (1 << 4), + SI476X_ACF_HIBLEND_INT = (1 << 3), + SI476X_ACF_HICUT_INT = (1 << 2), + SI476X_ACF_CHBW_INT = (1 << 1), + SI476X_ACF_SOFTMUTE_INT = (1 << 0), + + SI476X_ACF_SMUTE = (1 << 0), + SI476X_ACF_SMATTN = 0b11111, + SI476X_ACF_PILOT = (1 << 7), + SI476X_ACF_STBLEND = ~SI476X_ACF_PILOT, +}; + +enum si476x_agc_status_report_bits { + SI476X_AGC_MXHI = (1 << 5), + SI476X_AGC_MXLO = (1 << 4), + SI476X_AGC_LNAHI = (1 << 3), + SI476X_AGC_LNALO = (1 << 2), +}; + +enum si476x_errors { + SI476X_ERR_BAD_COMMAND = 0x10, + SI476X_ERR_BAD_ARG1 = 0x11, + SI476X_ERR_BAD_ARG2 = 0x12, + SI476X_ERR_BAD_ARG3 = 0x13, + SI476X_ERR_BAD_ARG4 = 0x14, + SI476X_ERR_BUSY = 0x18, + SI476X_ERR_BAD_INTERNAL_MEMORY = 0x20, + SI476X_ERR_BAD_PATCH = 0x30, + SI476X_ERR_BAD_BOOT_MODE = 0x31, + SI476X_ERR_BAD_PROPERTY = 0x40, +}; + + +static int si476x_core_parse_and_nag_about_error(struct si476x_core *core) +{ + int err; + char *cause; + u8 buffer[2]; + + if (core->revision != SI476X_REVISION_A10) { + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, + buffer, sizeof(buffer)); + if (err == sizeof(buffer)) { + switch (buffer[1]) { + case SI476X_ERR_BAD_COMMAND: + cause = "Bad command"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_ARG1: + cause = "Bad argument #1"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_ARG2: + cause = "Bad argument #2"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_ARG3: + cause = "Bad argument #3"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_ARG4: + cause = "Bad argument #4"; + err = -EINVAL; + break; + case SI476X_ERR_BUSY: + cause = "Chip is busy"; + err = -EBUSY; + break; + case SI476X_ERR_BAD_INTERNAL_MEMORY: + cause = "Bad internal memory"; + err = -EIO; + break; + case SI476X_ERR_BAD_PATCH: + cause = "Bad patch"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_BOOT_MODE: + cause = "Bad boot mode"; + err = -EINVAL; + break; + case SI476X_ERR_BAD_PROPERTY: + cause = "Bad property"; + err = -EINVAL; + break; + default: + cause = "Unknown"; + err = -EIO; + } + + dev_err(&core->client->dev, + "[Chip error status]: %s\n", cause); + } else { + dev_err(&core->client->dev, + "Failed to fetch error code\n"); + err = (err >= 0) ? -EIO : err; + } + } else { + err = -EIO; + } + + return err; +} + +/** + * __core_send_command() - sends a command to si476x and waits its + * response + * @core: si476x_device structure for the device we are + * communicating with + * @command: command id + * @args: command arguments we are sending + * @argn: actual size of @args + * @response: buffer to place the expected response from the device + * @respn: actual size of @response + * @usecs: amount of time to wait before reading the response (in + * usecs) + * + * Function returns 0 on succsess and negative error code on + * failure + */ +static int __core_send_command(struct si476x_core *core, + const u8 command, + const u8 args[], + const int argn, + u8 resp[], + const int respn, + const int usecs) +{ + struct i2c_client *client = core->client; + int err; + u8 data[CMD_MAX_ARGS_COUNT + 1]; + + if (argn > CMD_MAX_ARGS_COUNT) { + err = -ENOMEM; + goto exit; + } + + if (!client->adapter) { + err = -ENODEV; + goto exit; + } + + /* First send the command and its arguments */ + data[0] = command; + memcpy(&data[1], args, argn); + DBG_BUFFER(&client->dev, "Command:\n", data, argn + 1); + + err = si476x_i2c_xfer(core, SI476X_I2C_SEND, (char *) data, argn + 1); + if (err != argn + 1) { + dev_err(&core->client->dev, + "Error while sending command 0x%02x\n", + command); + err = (err >= 0) ? -EIO : err; + goto exit; + } + /* Set CTS to zero only after the command is send to avoid + * possible racing conditions when working in polling mode */ + atomic_set(&core->cts, 0); + + if (!wait_event_timeout(core->command, + atomic_read(&core->cts), + usecs_to_jiffies(usecs) + 1)) + dev_warn(&core->client->dev, + "(%s) [CMD 0x%02x] Device took too much time to answer.\n", + __func__, command); + + /* + When working in polling mode, for some reason the tuner will + report CTS bit as being set in the first status byte read, + but all the consequtive ones will return zros until the + tuner is actually completed the POWER_UP command. To + workaround that we wait for second CTS to be reported + */ + if (unlikely(!core->client->irq && command == CMD_POWER_UP)) { + if (!wait_event_timeout(core->command, + atomic_read(&core->cts), + usecs_to_jiffies(usecs) + 1)) + dev_warn(&core->client->dev, + "(%s) Power up took too much time.\n", + __func__); + } + + /* Then get the response */ + err = si476x_i2c_xfer(core, SI476X_I2C_RECV, resp, respn); + if (err != respn) { + dev_err(&core->client->dev, + "Error while reading response for command 0x%02x\n", + command); + err = (err >= 0) ? -EIO : err; + goto exit; + } + DBG_BUFFER(&client->dev, "Response:\n", resp, respn); + + err = 0; + + if (resp[0] & SI476X_ERR) { + dev_err(&core->client->dev, "[CMD 0x%02x] Chip set error flag\n", command); + err = si476x_core_parse_and_nag_about_error(core); + goto exit; + } + + if (!(resp[0] & SI476X_CTS)) + err = -EBUSY; +exit: + return err; +} + +#define CORE_SEND_COMMAND(core, cmd, args, resp, timeout) \ + __core_send_command(core, cmd, args, \ + ARRAY_SIZE(args), \ + resp, ARRAY_SIZE(resp), \ + timeout) + +static int si476x_cmd_clear_stc(struct si476x_core *core) +{ + int err; + struct si476x_rsq_status_args args = { + .primary = false, + .rsqack = false, + .attune = false, + .cancel = false, + .stcack = true, + }; + + switch(core->power_up_parameters.func) { + case SI476X_FUNC_FM_RECEIVER: + err = si476x_core_cmd_fm_rsq_status(core, &args, NULL); + break; + case SI476X_FUNC_AM_RECEIVER: + err = si476x_core_cmd_am_rsq_status(core, &args, NULL); + break; + default: + err = -EINVAL; + } + + return err; +} + +static int si476x_cmd_tune_seek_freq(struct si476x_core *core, + uint8_t cmd, + const uint8_t args[], size_t argn, + uint8_t *resp, size_t respn) +{ + int err; + + + atomic_set(&core->stc, 0); + err = __core_send_command(core, cmd, args, argn, + resp, respn, + atomic_read(&core->timeouts.command)); + if (!err) { + wait_event_killable(core->tuning, + atomic_read(&core->stc)); + si476x_cmd_clear_stc(core); + } + + return err; +} + +/** + * si476x_cmd_func_info() - send 'FUNC_INFO' command to the device + * @core: device to send the command to + * @info: struct si476x_func_info to fill all the information + * returned by the command + * + * The command requests the firmware and patch version for currently + * loaded firmware (dependent on the function of the device FM/AM/WB) + * + * Function returns 0 on succsess and negative error code on + * failure + */ +int si476x_core_cmd_func_info(struct si476x_core *core, + struct si476x_func_info *info) +{ + int err; + u8 resp[CMD_FUNC_INFO_NRESP]; + + err = __core_send_command(core, CMD_FUNC_INFO, + NULL, 0, + resp, ARRAY_SIZE(resp), + atomic_read(&core->timeouts.command)); + + info->firmware.major = resp[1]; + info->firmware.minor[0] = resp[2]; + info->firmware.minor[1] = resp[3]; + + info->patch_id = ((u16) resp[4] << 8) | resp[5]; + info->func = resp[6]; + + return err; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_func_info); + +/** + * si476x_cmd_set_property() - send 'SET_PROPERTY' command to the device + * @core: device to send the command to + * @property: property address + * @value: property value + * + * Function returns 0 on succsess and negative error code on + * failure + */ +int si476x_core_cmd_set_property(struct si476x_core *core, + u16 property, u16 value) +{ + u8 resp[CMD_SET_PROPERTY_NRESP]; + const u8 args[CMD_SET_PROPERTY_NARGS] = { + 0x00, + msb(property), + lsb(property), + msb(value), + lsb(value), + }; + + return CORE_SEND_COMMAND(core, CMD_SET_PROPERTY, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_set_property); + +/** + * si476x_cmd_get_property() - send 'GET_PROPERTY' command to the device + * @core: device to send the command to + * @property: property address + * + * Function return the value of property as u16 on success or a + * negative error on failure + */ +int si476x_core_cmd_get_property(struct si476x_core *core, u16 property) +{ + int err; + u8 resp[CMD_GET_PROPERTY_NRESP]; + const u8 args[CMD_GET_PROPERTY_NARGS] = { + 0x00, + msb(property), + lsb(property), + }; + + err = CORE_SEND_COMMAND(core, CMD_GET_PROPERTY, + args, resp, + atomic_read(&core->timeouts.command)); + if (err < 0) + return err; + else + return be16_to_cpup((__be16 *)(resp + 2)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_get_property); + +/** + * si476x_cmd_dig_audio_pin_cfg() - send 'DIG_AUDIO_PIN_CFG' command to + * the device + * @core: device to send the command to + * @dclk: DCLK pin function configuration: + * #SI476X_DCLK_NOOP - do not modify the behaviour + * #SI476X_DCLK_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * #SI476X_DCLK_DAUDIO - set the pin to be a part of digital + * audio interface + * @dfs: DFS pin function configuration: + * #SI476X_DFS_NOOP - do not modify the behaviour + * #SI476X_DFS_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_DFS_DAUDIO - set the pin to be a part of digital + * audio interface + * @dout - DOUT pin function configuration: + * SI476X_DOUT_NOOP - do not modify the behaviour + * SI476X_DOUT_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_DOUT_I2S_OUTPUT - set this pin to be digital out on I2S + * port 1 + * SI476X_DOUT_I2S_INPUT - set this pin to be digital in on I2S + * port 1 + * @xout - XOUT pin function configuration: + * SI476X_XOUT_NOOP - do not modify the behaviour + * SI476X_XOUT_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_XOUT_I2S_INPUT - set this pin to be digital in on I2S + * port 1 + * SI476X_XOUT_MODE_SELECT - set this pin to be the input that + * selects the mode of the I2S audio + * combiner (analog or HD) + * [SI4761/63/65/67 Only] + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_dig_audio_pin_cfg(struct si476x_core *core, + enum si476x_dclk_config dclk, + enum si476x_dfs_config dfs, + enum si476x_dout_config dout, + enum si476x_xout_config xout) +{ + u8 resp[CMD_DIG_AUDIO_PIN_CFG_NRESP]; + const u8 args[CMD_DIG_AUDIO_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(dclk), + PIN_CFG_BYTE(dfs), + PIN_CFG_BYTE(dout), + PIN_CFG_BYTE(xout), + }; + + return CORE_SEND_COMMAND(core, CMD_DIG_AUDIO_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_dig_audio_pin_cfg); + +/** + * si476x_cmd_zif_pin_cfg - send 'ZIF_PIN_CFG_COMMAND' + * @core - device to send the command to + * @iqclk - IQCL pin function configuration: + * SI476X_IQCLK_NOOP - do not modify the behaviour + * SI476X_IQCLK_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_IQCLK_IQ - set pin to be a part of I/Q interace + * in master mode + * @iqfs - IQFS pin function configuration: + * SI476X_IQFS_NOOP - do not modify the behaviour + * SI476X_IQFS_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_IQFS_IQ - set pin to be a part of I/Q interace + * in master mode + * @iout - IOUT pin function configuration: + * SI476X_IOUT_NOOP - do not modify the behaviour + * SI476X_IOUT_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_IOUT_OUTPUT - set pin to be I out + * @qout - QOUT pin function configuration: + * SI476X_QOUT_NOOP - do not modify the behaviour + * SI476X_QOUT_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_QOUT_OUTPUT - set pin to be Q out + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_zif_pin_cfg(struct si476x_core *core, + enum si476x_iqclk_config iqclk, + enum si476x_iqfs_config iqfs, + enum si476x_iout_config iout, + enum si476x_qout_config qout) +{ + u8 resp[CMD_ZIF_PIN_CFG_NRESP]; + const u8 args[CMD_ZIF_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(iqclk), + PIN_CFG_BYTE(iqfs), + PIN_CFG_BYTE(iout), + PIN_CFG_BYTE(qout), + }; + + return CORE_SEND_COMMAND(core, CMD_ZIF_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_zif_pin_cfg); + +/** + * si476x_cmd_ic_link_gpo_ctl_pin_cfg - send + * 'IC_LINK_GPIO_CTL_PIN_CFG' comand to the device + * @core - device to send the command to + * @icin - ICIN pin function configuration: + * SI476X_ICIN_NOOP - do not modify the behaviour + * SI476X_ICIN_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_ICIN_GPO1_HIGH - set pin to be an output, drive it high + * SI476X_ICIN_GPO1_LOW - set pin to be an output, drive it low + * SI476X_ICIN_IC_LINK - set the pin to be a part of Inter-Chip link + * @icip - ICIP pin function configuration: + * SI476X_ICIP_NOOP - do not modify the behaviour + * SI476X_ICIP_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_ICIP_GPO1_HIGH - set pin to be an output, drive it high + * SI476X_ICIP_GPO1_LOW - set pin to be an output, drive it low + * SI476X_ICIP_IC_LINK - set the pin to be a part of Inter-Chip link + * @icon - ICON pin function configuration: + * SI476X_ICON_NOOP - do not modify the behaviour + * SI476X_ICON_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_ICON_I2S - set the pin to be a part of audio + * interface in slave mode (DCLK) + * SI476X_ICON_IC_LINK - set the pin to be a part of Inter-Chip link + * @icop - ICOP pin function configuration: + * SI476X_ICOP_NOOP - do not modify the behaviour + * SI476X_ICOP_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_ICOP_I2S - set the pin to be a part of audio + * interface in slave mode (DOUT) + * [Si4761/63/65/67 Only] + * SI476X_ICOP_IC_LINK - set the pin to be a part of Inter-Chip link + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_ic_link_gpo_ctl_pin_cfg(struct si476x_core *core, + enum si476x_icin_config icin, + enum si476x_icip_config icip, + enum si476x_icon_config icon, + enum si476x_icop_config icop) +{ + u8 resp[CMD_IC_LINK_GPO_CTL_PIN_CFG_NRESP]; + const u8 args[CMD_IC_LINK_GPO_CTL_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(icin), + PIN_CFG_BYTE(icip), + PIN_CFG_BYTE(icon), + PIN_CFG_BYTE(icop), + }; + + return CORE_SEND_COMMAND(core, CMD_IC_LINK_GPO_CTL_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_ic_link_gpo_ctl_pin_cfg); + +/** + * si476x_cmd_ana_audio_pin_cfg - send 'ANA_AUDIO_PIN_CFG' to the + * device + * @core - device to send the command to + * @lrout - LROUT pin function configuration: + * SI476X_LROUT_NOOP - do not modify the behaviour + * SI476X_LROUT_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_LROUT_AUDIO - set pin to be audio output + * SI476X_LROUT_MPX - set pin to be MPX output + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_ana_audio_pin_cfg(struct si476x_core *core, + enum si476x_lrout_config lrout) +{ + u8 resp[CMD_ANA_AUDIO_PIN_CFG_NRESP]; + const u8 args[CMD_ANA_AUDIO_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(lrout), + }; + + return CORE_SEND_COMMAND(core, CMD_ANA_AUDIO_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_ana_audio_pin_cfg); + + +/** + * si476x_cmd_intb_pin_cfg - send 'INTB_PIN_CFG' command to the device + * @core - device to send the command to + * @intb - INTB pin function configuration: + * SI476X_INTB_NOOP - do not modify the behaviour + * SI476X_INTB_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_INTB_DAUDIO - set pin to be a part of digital + * audio interface in slave mode + * SI476X_INTB_IRQ - set pin to be an interrupt request line + * @a1 - A1 pin function configuration: + * SI476X_A1_NOOP - do not modify the behaviour + * SI476X_A1_TRISTATE - put the pin in tristate condition, + * enable 1MOhm pulldown + * SI476X_A1_IRQ - set pin to be an interrupt request line + * + * Function returns 0 on success and negative error code on failure + */ +static int si476x_core_cmd_intb_pin_cfg_a10(struct si476x_core *core, + enum si476x_intb_config intb, + enum si476x_a1_config a1) +{ + u8 resp[CMD_INTB_PIN_CFG_A10_NRESP]; + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(intb), + PIN_CFG_BYTE(a1), + }; + + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} + +static int si476x_core_cmd_intb_pin_cfg_a20(struct si476x_core *core, + enum si476x_intb_config intb, + enum si476x_a1_config a1) +{ + u8 resp[CMD_INTB_PIN_CFG_A20_NRESP]; + const u8 args[CMD_INTB_PIN_CFG_NARGS] = { + PIN_CFG_BYTE(intb), + PIN_CFG_BYTE(a1), + }; + + return CORE_SEND_COMMAND(core, CMD_INTB_PIN_CFG, + args, resp, + atomic_read(&core->timeouts.command)); +} + + + +/** + * si476x_cmd_am_rsq_status - send 'FM_TUNE_FREQ' command to the + * device + * @core - device to send the command to + * @rsqack - if set command clears RSQINT, SNRINT, SNRLINT, RSSIHINT, + * RSSSILINT, BLENDINT, MULTHINT and MULTLINT + * @attune - when set the values in the status report are the values + * that were calculated at tune + * @cancel - abort ongoing seek/tune opertation + * @stcack - clear the STCINT bin in status register + * @report - all signal quality information retured by the command + * (if NULL then the output of the command is ignored) + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_am_rsq_status(struct si476x_core *core, + struct si476x_rsq_status_args *rsqargs, + struct si476x_rsq_status_report *report) +{ + int err; + u8 resp[CMD_AM_RSQ_STATUS_NRESP]; + const u8 args[CMD_AM_RSQ_STATUS_NARGS] = { + rsqargs->rsqack << 3 | rsqargs->attune << 2 | + rsqargs->cancel << 1 | rsqargs->stcack, + }; + + err = CORE_SEND_COMMAND(core, CMD_AM_RSQ_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (report) { + report->snrhint = 0b00001000 & resp[1]; + report->snrlint = 0b00000100 & resp[1]; + report->rssihint = 0b00000010 & resp[1]; + report->rssilint = 0b00000001 & resp[1]; + + report->bltf = 0b10000000 & resp[2]; + report->snr_ready = 0b00100000 & resp[2]; + report->rssiready = 0b00001000 & resp[2]; + report->afcrl = 0b00000010 & resp[2]; + report->valid = 0b00000001 & resp[2]; + + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); + report->freqoff = resp[5]; + report->rssi = resp[6]; + report->snr = resp[7]; + report->lassi = resp[9]; + report->hassi = resp[10]; + report->mult = resp[11]; + report->dev = resp[12]; + } + + return err; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_rsq_status); + +int si476x_core_cmd_fm_acf_status(struct si476x_core *core, + struct si476x_acf_status_report *report) +{ + int err; + u8 resp[CMD_FM_ACF_STATUS_NRESP]; + const u8 args[CMD_FM_ACF_STATUS_NARGS] = { + 0x0, + }; + + if (!report) + return -EINVAL; + + err = CORE_SEND_COMMAND(core, CMD_FM_ACF_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (!err) { + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; + report->smute = resp[2] & SI476X_ACF_SMUTE; + report->smattn = resp[3] & SI476X_ACF_SMATTN; + report->chbw = resp[4]; + report->hicut = resp[5]; + report->hiblend = resp[6]; + report->pilot = resp[7] & SI476X_ACF_PILOT; + report->stblend = resp[7] & SI476X_ACF_STBLEND; + } + + return err; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_acf_status); + +int si476x_core_cmd_am_acf_status(struct si476x_core *core, + struct si476x_acf_status_report *report) +{ + int err; + u8 resp[CMD_AM_ACF_STATUS_NRESP]; + const u8 args[CMD_AM_ACF_STATUS_NARGS] = { + 0x0, + }; + + if (!report) + return -EINVAL; + + err = CORE_SEND_COMMAND(core, CMD_AM_ACF_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (!err) { + report->blend_int = resp[1] & SI476X_ACF_BLEND_INT; + report->hblend_int = resp[1] & SI476X_ACF_HIBLEND_INT; + report->hicut_int = resp[1] & SI476X_ACF_HICUT_INT; + report->chbw_int = resp[1] & SI476X_ACF_CHBW_INT; + report->softmute_int = resp[1] & SI476X_ACF_SOFTMUTE_INT; + report->smute = resp[2] & SI476X_ACF_SMUTE; + report->smattn = resp[3] & SI476X_ACF_SMATTN; + report->chbw = resp[4]; + report->hicut = resp[5]; + } + + return err; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_acf_status); + + +/** + * si476x_cmd_fm_seek_start - send 'FM_SEEK_START' command to the + * device + * @core - device to send the command to + * @seekup - if set the direction of the search is 'up' + * @wrap - if set seek wraps when hitting band limit + * + * This function begins search for a valid station. The station is + * considered valid when 'FM_VALID_SNR_THRESHOLD' and + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria + * are met. +} * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_fm_seek_start(struct si476x_core *core, + bool seekup, bool wrap) +{ + u8 resp[CMD_FM_SEEK_START_NRESP]; + const u8 args[CMD_FM_SEEK_START_NARGS] = { + seekup << 3 | wrap << 2, + }; + + return si476x_cmd_tune_seek_freq(core, CMD_FM_SEEK_START, + args, sizeof(args), resp, sizeof(resp)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_seek_start); + +/** + * si476x_cmd_fm_rds_status - send 'FM_RDS_STATUS' command to the + * device + * @core - device to send the command to + * @status_only - if set the data is not removed from RDSFIFO, + * RDSFIFOUSED is not decremented and data in all the + * rest RDS data contains the last valid info received + * @mtfifo if set the command clears RDS receive FIFO + * @intack if set the command clards the RDSINT bit. + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_fm_rds_status(struct si476x_core *core, + bool status_only, + bool mtfifo, + bool intack, + struct si476x_rds_status_report *report) +{ + int err; + u8 resp[CMD_FM_RDS_STATUS_NRESP]; + const u8 args[CMD_FM_RDS_STATUS_NARGS] = { + status_only << 2 | mtfifo << 1 | intack, + }; + + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (!err && report) { + report->rdstpptyint = 0b00010000 & resp[1]; + report->rdspiint = 0b00001000 & resp[1]; + report->rdssyncint = 0b00000010 & resp[1]; + report->rdsfifoint = 0b00000001 & resp[1]; + + report->tpptyvalid = 0b00010000 & resp[2]; + report->pivalid = 0b00001000 & resp[2]; + report->rdssync = 0b00000010 & resp[2]; + report->rdsfifolost = 0b00000001 & resp[2]; + + report->tp = 0b00100000 & resp[3]; + report->pty = 0b00011111 & resp[3]; + + report->pi = be16_to_cpup((__be16 *)(resp + 4)); + report->rdsfifoused = resp[6]; + + report->ble[V4L2_RDS_BLOCK_A] = 0b11000000 & resp[7]; + report->ble[V4L2_RDS_BLOCK_B] = 0b00110000 & resp[7]; + report->ble[V4L2_RDS_BLOCK_C] = 0b00001100 & resp[7]; + report->ble[V4L2_RDS_BLOCK_D] = 0b00000011 & resp[7]; + + report->rds[V4L2_RDS_BLOCK_A].block = V4L2_RDS_BLOCK_A; + report->rds[V4L2_RDS_BLOCK_A].msb = resp[8]; + report->rds[V4L2_RDS_BLOCK_A].lsb = resp[9]; + + report->rds[V4L2_RDS_BLOCK_B].block = V4L2_RDS_BLOCK_B; + report->rds[V4L2_RDS_BLOCK_B].msb = resp[10]; + report->rds[V4L2_RDS_BLOCK_B].lsb = resp[11]; + + report->rds[V4L2_RDS_BLOCK_C].block = V4L2_RDS_BLOCK_C; + report->rds[V4L2_RDS_BLOCK_C].msb = resp[12]; + report->rds[V4L2_RDS_BLOCK_C].lsb = resp[13]; + + report->rds[V4L2_RDS_BLOCK_D].block = V4L2_RDS_BLOCK_D; + report->rds[V4L2_RDS_BLOCK_D].msb = resp[14]; + report->rds[V4L2_RDS_BLOCK_D].lsb = resp[15]; + } + + return err; +} + +int si476x_core_cmd_fm_rds_blockcount(struct si476x_core *core, + bool clear, + struct si476x_rds_blockcount_report *report) +{ + int err; + u8 resp[CMD_FM_RDS_BLOCKCOUNT_NRESP]; + const u8 args[CMD_FM_RDS_BLOCKCOUNT_NARGS] = { + clear, + }; + + if (!report) + return -EINVAL; + + err = CORE_SEND_COMMAND(core, CMD_FM_RDS_BLOCKCOUNT, + args, resp, + atomic_read(&core->timeouts.command)); + + if (!err) { + report->expected = be16_to_cpup((__be16 *)(resp + 2)); + report->received = be16_to_cpup((__be16 *)(resp + 4)); + report->uncorrectable = be16_to_cpup((__be16 *)(resp + 6)); + } + + return err; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rds_blockcount); + +int si476x_core_cmd_fm_phase_diversity(struct si476x_core *core, + enum si476x_phase_diversity_mode mode) +{ + u8 resp[CMD_FM_PHASE_DIVERSITY_NRESP]; + const u8 args[CMD_FM_PHASE_DIVERSITY_NARGS] = { + mode & 0b111, + }; + + return CORE_SEND_COMMAND(core, CMD_FM_PHASE_DIVERSITY, + args, resp, + atomic_read(&core->timeouts.command)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_diversity); +/** + * si476x_core_cmd_fm_phase_div_status() - get the phase diversity + * status + * + * @core: si476x device + * + * NOTE caller must hold core lock + * + * Function returns the value of the status bit in case of success and + * negative error code in case of failre. + */ +int si476x_core_cmd_fm_phase_div_status(struct si476x_core *core) +{ + int err; + u8 resp[CMD_FM_PHASE_DIV_STATUS_NRESP]; + + err = __core_send_command(core, CMD_FM_PHASE_DIV_STATUS, + NULL, 0, + resp, ARRAY_SIZE(resp), + atomic_read(&core->timeouts.command)); + + return (err < 0) ? err : resp[1]; +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_phase_div_status); + + +/** + * si476x_cmd_am_seek_start - send 'FM_SEEK_START' command to the + * device + * @core - device to send the command to + * @seekup - if set the direction of the search is 'up' + * @wrap - if set seek wraps when hitting band limit + * + * This function begins search for a valid station. The station is + * considered valid when 'FM_VALID_SNR_THRESHOLD' and + * 'FM_VALID_RSSI_THRESHOLD' and 'FM_VALID_MAX_TUNE_ERROR' criteria + * are met. + * + * Function returns 0 on success and negative error code on failure + */ +int si476x_core_cmd_am_seek_start(struct si476x_core *core, + bool seekup, bool wrap) +{ + u8 resp[CMD_AM_SEEK_START_NRESP]; + const u8 args[CMD_AM_SEEK_START_NARGS] = { + seekup << 3 | wrap << 2, + }; + + return si476x_cmd_tune_seek_freq(core, CMD_AM_SEEK_START, + args, sizeof(args), resp, sizeof(resp)); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_seek_start); + + + +static int si476x_core_cmd_power_up_a10(struct si476x_core *core, + struct si476x_power_up_args *puargs) +{ + u8 resp[CMD_POWER_UP_A10_NRESP]; + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); + const bool ctsen = (core->client->irq != 0); + const u8 args[CMD_POWER_UP_A10_NARGS] = { + 0xF7, /* Reserved, always 0xF7 */ + 0x3F & puargs->xcload, /* First two bits are reserved to be + * zeros */ + ctsen << 7 | intsel << 6 | 0x07, /* Last five bits + * are reserved to + * be written as 0x7 */ + puargs->func << 4 | puargs->freq, + 0x11, /* Reserved, always 0x11 */ + }; + + return CORE_SEND_COMMAND(core, CMD_POWER_UP, + args, resp, + atomic_read(&core->timeouts.power_up)); +} + +static int si476x_core_cmd_power_up_a20(struct si476x_core *core, + struct si476x_power_up_args *puargs) +{ + u8 resp[CMD_POWER_UP_A20_NRESP]; + const bool intsel = (core->pinmux.a1 == SI476X_A1_IRQ); + const bool ctsen = (core->client->irq != 0); + const u8 args[CMD_POWER_UP_A20_NARGS] = { + puargs->ibias6x << 7 | puargs->xstart, + 0x3F & puargs->xcload, /* First two bits are reserved to be + * zeros */ + ctsen << 7 | intsel << 6 | puargs->fastboot << 5 | + puargs->xbiashc << 3 | puargs->xbias, + puargs->func << 4 | puargs->freq, + 0x10 | puargs->xmode, + }; + + return CORE_SEND_COMMAND(core, CMD_POWER_UP, + args, resp, + atomic_read(&core->timeouts.power_up)); +} + +static int si476x_core_cmd_power_down_a10(struct si476x_core *core, + struct si476x_power_down_args *pdargs) +{ + u8 resp[CMD_POWER_DOWN_A10_NRESP]; + + return __core_send_command(core, CMD_POWER_DOWN, + NULL, 0, + resp, ARRAY_SIZE(resp), + atomic_read(&core->timeouts.command)); +} + +static int si476x_core_cmd_power_down_a20(struct si476x_core *core, + struct si476x_power_down_args *pdargs) +{ + u8 resp[CMD_POWER_DOWN_A20_NRESP]; + const u8 args[CMD_POWER_DOWN_A20_NARGS] = { + pdargs->xosc, + }; + return CORE_SEND_COMMAND(core, CMD_POWER_DOWN, + args, resp, + atomic_read(&core->timeouts.command)); +} + +static int si476x_core_cmd_am_tune_freq_a10(struct si476x_core *core, + struct si476x_tune_freq_args *tuneargs) +{ + + const int am_freq = tuneargs->freq; + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { + (tuneargs->hd << 6), + msb(am_freq), + lsb(am_freq), + }; + + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, + sizeof(args), + resp, sizeof(resp)); +} + +static int si476x_core_cmd_am_tune_freq_a20(struct si476x_core *core, + struct si476x_tune_freq_args *tuneargs) +{ + const int am_freq = tuneargs->freq; + u8 resp[CMD_AM_TUNE_FREQ_NRESP]; + const u8 args[CMD_AM_TUNE_FREQ_NARGS] = { + (tuneargs->zifsr << 6) | (tuneargs->injside & 0b11), + msb(am_freq), + lsb(am_freq), + }; + + return si476x_cmd_tune_seek_freq(core, CMD_AM_TUNE_FREQ, args, sizeof(args), + resp, sizeof(resp)); +} + +static int si476x_core_cmd_fm_rsq_status_a10(struct si476x_core *core, + struct si476x_rsq_status_args *rsqargs, + struct si476x_rsq_status_report *report) +{ + int err; + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; + const u8 args[CMD_FM_RSQ_STATUS_A10_NARGS] = { + rsqargs->rsqack << 3 | rsqargs->attune << 2 | + rsqargs->cancel << 1 | rsqargs->stcack, + }; + + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (report && !err) { + report->multhint = 0b10000000 & resp[1]; + report->multlint = 0b01000000 & resp[1]; + report->snrhint = 0b00001000 & resp[1]; + report->snrlint = 0b00000100 & resp[1]; + report->rssihint = 0b00000010 & resp[1]; + report->rssilint = 0b00000001 & resp[1]; + + report->bltf = 0b10000000 & resp[2]; + report->snr_ready = 0b00100000 & resp[2]; + report->rssiready = 0b00001000 & resp[2]; + report->afcrl = 0b00000010 & resp[2]; + report->valid = 0b00000001 & resp[2]; + + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); + report->freqoff = resp[5]; + report->rssi = resp[6]; + report->snr = resp[7]; + report->lassi = resp[9]; + report->hassi = resp[10]; + report->mult = resp[11]; + report->dev = resp[12]; + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); + report->assi = resp[15]; + report->usn = resp[16]; + } + + return err; +} + +static int si476x_core_cmd_fm_rsq_status_a20(struct si476x_core *core, + struct si476x_rsq_status_args *rsqargs, + struct si476x_rsq_status_report *report) +{ + int err; + u8 resp[CMD_FM_RSQ_STATUS_A10_NRESP]; + + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { + rsqargs->primary << 4 | rsqargs->rsqack << 3 | + rsqargs->attune << 2 | rsqargs->cancel << 1 | + rsqargs->stcack, + }; + + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (report && !err) { + report->multhint = 0b10000000 & resp[1]; + report->multlint = 0b01000000 & resp[1]; + report->snrhint = 0b00001000 & resp[1]; + report->snrlint = 0b00000100 & resp[1]; + report->rssihint = 0b00000010 & resp[1]; + report->rssilint = 0b00000001 & resp[1]; + + report->bltf = 0b10000000 & resp[2]; + report->snr_ready = 0b00100000 & resp[2]; + report->rssiready = 0b00001000 & resp[2]; + report->afcrl = 0b00000010 & resp[2]; + report->valid = 0b00000001 & resp[2]; + + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); + report->freqoff = resp[5]; + report->rssi = resp[6]; + report->snr = resp[7]; + report->lassi = resp[9]; + report->hassi = resp[10]; + report->mult = resp[11]; + report->dev = resp[12]; + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); + report->assi = resp[15]; + report->usn = resp[16]; + } + + return err; +} + + +static int si476x_core_cmd_fm_rsq_status_a30(struct si476x_core *core, + struct si476x_rsq_status_args *rsqargs, + struct si476x_rsq_status_report *report) +{ + int err; + u8 resp[CMD_FM_RSQ_STATUS_A30_NRESP]; + const u8 args[CMD_FM_RSQ_STATUS_A30_NARGS] = { + rsqargs->primary << 4 | rsqargs->rsqack << 3 | + rsqargs->attune << 2 | rsqargs->cancel << 1 | + rsqargs->stcack, + }; + + err = CORE_SEND_COMMAND(core, CMD_FM_RSQ_STATUS, + args, resp, + atomic_read(&core->timeouts.command)); + + if (report && !err) { + report->multhint = 0b10000000 & resp[1]; + report->multlint = 0b01000000 & resp[1]; + report->snrhint = 0b00001000 & resp[1]; + report->snrlint = 0b00000100 & resp[1]; + report->rssihint = 0b00000010 & resp[1]; + report->rssilint = 0b00000001 & resp[1]; + + report->bltf = 0b10000000 & resp[2]; + report->snr_ready = 0b00100000 & resp[2]; + report->rssiready = 0b00001000 & resp[2]; + report->injside = 0b00000100 & resp[2]; + report->afcrl = 0b00000010 & resp[2]; + report->valid = 0b00000001 & resp[2]; + + report->readfreq = be16_to_cpup((__be16 *)(resp + 3)); + report->freqoff = resp[5]; + report->rssi = resp[6]; + report->snr = resp[7]; + report->issi = resp[8]; + report->lassi = resp[9]; + report->hassi = resp[10]; + report->mult = resp[11]; + report->dev = resp[12]; + report->readantcap = be16_to_cpup((__be16 *)(resp + 13)); + report->assi = resp[15]; + report->usn = resp[16]; + + report->pilotdev = resp[17]; + report->rdsdev = resp[18]; + report->assidev = resp[19]; + report->strongdev = resp[20]; + report->rdspi = be16_to_cpup((__be16 *)(resp + 21)); + } + + return err; +} + +static int si476x_core_cmd_fm_tune_freq_a10(struct si476x_core *core, + struct si476x_tune_freq_args *tuneargs) +{ + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; + const u8 args[CMD_FM_TUNE_FREQ_A10_NARGS] = { + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) + | (tuneargs->smoothmetrics << 2), + msb(tuneargs->freq), + lsb(tuneargs->freq), + msb(tuneargs->antcap), + lsb(tuneargs->antcap) + }; + + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), + resp, sizeof(resp)); +} + +static int si476x_core_cmd_fm_tune_freq_a20(struct si476x_core *core, + struct si476x_tune_freq_args *tuneargs) +{ + u8 resp[CMD_FM_TUNE_FREQ_NRESP]; + const u8 args[CMD_FM_TUNE_FREQ_A20_NARGS] = { + (tuneargs->hd << 6) | (tuneargs->tunemode << 4) + | (tuneargs->smoothmetrics << 2) | (tuneargs->injside), + msb(tuneargs->freq), + lsb(tuneargs->freq), + }; + + return si476x_cmd_tune_seek_freq(core, CMD_FM_TUNE_FREQ, args, sizeof(args), + resp, sizeof(resp)); +} + +static int si476x_core_cmd_agc_status_a20(struct si476x_core *core, + struct si476x_agc_status_report *report) +{ + int err; + u8 resp[CMD_AGC_STATUS_NRESP_A20]; + + if (!report) + return -EINVAL; + + err = __core_send_command(core, CMD_AGC_STATUS, + NULL, 0, + resp, ARRAY_SIZE(resp), + atomic_read(&core->timeouts.command)); + if (!err) { + report->mxhi = resp[1] & SI476X_AGC_MXHI; + report->mxlo = resp[1] & SI476X_AGC_MXLO; + report->lnahi = resp[1] & SI476X_AGC_LNAHI; + report->lnalo = resp[1] & SI476X_AGC_LNALO; + report->fmagc1 = resp[2]; + report->fmagc2 = resp[3]; + report->pgagain = resp[4]; + report->fmwblang = resp[5]; + } + + return err; +} + +static int si476x_core_cmd_agc_status_a10(struct si476x_core *core, + struct si476x_agc_status_report *report) +{ + int err; + u8 resp[CMD_AGC_STATUS_NRESP_A10]; + + if (!report) + return -EINVAL; + + err = __core_send_command(core, CMD_AGC_STATUS, + NULL, 0, + resp, ARRAY_SIZE(resp), + atomic_read(&core->timeouts.command)); + if (!err) { + report->mxhi = resp[1] & SI476X_AGC_MXHI; + report->mxlo = resp[1] & SI476X_AGC_MXLO; + report->lnahi = resp[1] & SI476X_AGC_LNAHI; + report->lnalo = resp[1] & SI476X_AGC_LNALO; + } + + return err; +} + +static struct { + int (*power_up) (struct si476x_core *, + struct si476x_power_up_args *); + int (*power_down) (struct si476x_core *, + struct si476x_power_down_args *); + + tune_freq_func_t fm_tune_freq; + tune_freq_func_t am_tune_freq; + + int (*fm_rsq_status)(struct si476x_core *, + struct si476x_rsq_status_args *, + struct si476x_rsq_status_report *); + + int (*agc_status)(struct si476x_core *, + struct si476x_agc_status_report *); + int (*intb_pin_cfg)(struct si476x_core *core, + enum si476x_intb_config intb, + enum si476x_a1_config a1); +} si476x_cmds_vtable[] = { + [SI476X_REVISION_A10] = { + .power_up = si476x_core_cmd_power_up_a10, + .power_down = si476x_core_cmd_power_down_a10, + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a10, + .am_tune_freq = si476x_core_cmd_am_tune_freq_a10, + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a10, + .agc_status = si476x_core_cmd_agc_status_a10, + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a10, + }, + [SI476X_REVISION_A20] = { + .power_up = si476x_core_cmd_power_up_a20, + .power_down = si476x_core_cmd_power_down_a20, + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a20, + .agc_status = si476x_core_cmd_agc_status_a20, + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, + }, + [SI476X_REVISION_A30] = { + .power_up = si476x_core_cmd_power_up_a20, + .power_down = si476x_core_cmd_power_down_a20, + .fm_tune_freq = si476x_core_cmd_fm_tune_freq_a20, + .am_tune_freq = si476x_core_cmd_am_tune_freq_a20, + .fm_rsq_status = si476x_core_cmd_fm_rsq_status_a30, + .agc_status = si476x_core_cmd_agc_status_a20, + .intb_pin_cfg = si476x_core_cmd_intb_pin_cfg_a20, + }, +}; + +int si476x_core_cmd_power_up(struct si476x_core *core, + struct si476x_power_up_args *args) +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].power_up(core, args); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_up); + +int si476x_core_cmd_power_down(struct si476x_core *core, + struct si476x_power_down_args *args) +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].power_down(core, args); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_power_down); + +int si476x_core_cmd_fm_tune_freq(struct si476x_core *core, + struct si476x_tune_freq_args *args) +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].fm_tune_freq(core, args); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_tune_freq); + +int si476x_core_cmd_am_tune_freq(struct si476x_core *core, + struct si476x_tune_freq_args *args) +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].am_tune_freq(core, args); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_am_tune_freq); + +int si476x_core_cmd_fm_rsq_status(struct si476x_core *core, + struct si476x_rsq_status_args *args, + struct si476x_rsq_status_report *report) + +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].fm_rsq_status(core, args, + report); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_fm_rsq_status); + +int si476x_core_cmd_agc_status(struct si476x_core *core, + struct si476x_agc_status_report *report) + +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + return si476x_cmds_vtable[core->revision].agc_status(core, report); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_agc_status); + +int si476x_core_cmd_intb_pin_cfg(struct si476x_core *core, + enum si476x_intb_config intb, + enum si476x_a1_config a1) +{ + BUG_ON(core->revision > SI476X_REVISION_A30 || + core->revision == -1); + + return si476x_cmds_vtable[core->revision].intb_pin_cfg(core, intb, a1); +} +EXPORT_SYMBOL_GPL(si476x_core_cmd_intb_pin_cfg); + +MODULE_LICENSE("GPL"); +MODULE_AUTHOR("Andrey Smirnov <andrey.smirnov@convergeddevices.net>"); +MODULE_DESCRIPTION("API for command exchange for si476x");
This patch adds all the functions used for exchanging commands with the chip. Signed-off-by: Andrey Smirnov <andrey.smirnov@convergeddevices.net> --- drivers/mfd/si476x-cmd.c | 1493 ++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 1493 insertions(+) create mode 100644 drivers/mfd/si476x-cmd.c