mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-15 06:55:13 +08:00
ed5c2f5fd1
The value returned by an i2c driver's remove function is mostly ignored. (Only an error message is printed if the value is non-zero that the error is ignored.) So change the prototype of the remove function to return no value. This way driver authors are not tempted to assume that passing an error to the upper layer is a good idea. All drivers are adapted accordingly. There is no intended change of behaviour, all callbacks were prepared to return 0 before. Reviewed-by: Peter Senna Tschudin <peter.senna@gmail.com> Reviewed-by: Jeremy Kerr <jk@codeconstruct.com.au> Reviewed-by: Benjamin Mugnier <benjamin.mugnier@foss.st.com> Reviewed-by: Javier Martinez Canillas <javierm@redhat.com> Reviewed-by: Crt Mori <cmo@melexis.com> Reviewed-by: Heikki Krogerus <heikki.krogerus@linux.intel.com> Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Acked-by: Marek Behún <kabel@kernel.org> # for leds-turris-omnia Acked-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Reviewed-by: Petr Machata <petrm@nvidia.com> # for mlxsw Reviewed-by: Maximilian Luz <luzmaximilian@gmail.com> # for surface3_power Acked-by: Srinivas Pandruvada <srinivas.pandruvada@linux.intel.com> # for bmc150-accel-i2c + kxcjk-1013 Reviewed-by: Hans Verkuil <hverkuil-cisco@xs4all.nl> # for media/* + staging/media/* Acked-by: Miguel Ojeda <ojeda@kernel.org> # for auxdisplay/ht16k33 + auxdisplay/lcd2s Reviewed-by: Luca Ceresoli <luca.ceresoli@bootlin.com> # for versaclock5 Reviewed-by: Ajay Gupta <ajayg@nvidia.com> # for ucsi_ccg Acked-by: Jonathan Cameron <Jonathan.Cameron@huawei.com> # for iio Acked-by: Peter Rosin <peda@axentia.se> # for i2c-mux-*, max9860 Acked-by: Adrien Grassein <adrien.grassein@gmail.com> # for lontium-lt8912b Reviewed-by: Jean Delvare <jdelvare@suse.de> # for hwmon, i2c-core and i2c/muxes Acked-by: Corey Minyard <cminyard@mvista.com> # for IPMI Reviewed-by: Vladimir Oltean <olteanv@gmail.com> Acked-by: Dmitry Torokhov <dmitry.torokhov@gmail.com> Acked-by: Sebastian Reichel <sebastian.reichel@collabora.com> # for drivers/power Acked-by: Krzysztof Hałasa <khalasa@piap.pl> Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Signed-off-by: Wolfram Sang <wsa@kernel.org>
1442 lines
38 KiB
C
1442 lines
38 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Maxim Integrated MAX2175 RF to Bits tuner driver
|
|
*
|
|
* This driver & most of the hard coded values are based on the reference
|
|
* application delivered by Maxim for this device.
|
|
*
|
|
* Copyright (C) 2016 Maxim Integrated Products
|
|
* Copyright (C) 2017 Renesas Electronics Corporation
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/math64.h>
|
|
#include <linux/max2175.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/slab.h>
|
|
#include <media/v4l2-ctrls.h>
|
|
#include <media/v4l2-device.h>
|
|
|
|
#include "max2175.h"
|
|
|
|
#define DRIVER_NAME "max2175"
|
|
|
|
#define mxm_dbg(ctx, fmt, arg...) dev_dbg(&ctx->client->dev, fmt, ## arg)
|
|
#define mxm_err(ctx, fmt, arg...) dev_err(&ctx->client->dev, fmt, ## arg)
|
|
|
|
/* Rx mode */
|
|
struct max2175_rxmode {
|
|
enum max2175_band band; /* Associated band */
|
|
u32 freq; /* Default freq in Hz */
|
|
u8 i2s_word_size; /* Bit value */
|
|
};
|
|
|
|
/* Register map to define preset values */
|
|
struct max2175_reg_map {
|
|
u8 idx; /* Register index */
|
|
u8 val; /* Register value */
|
|
};
|
|
|
|
static const struct max2175_rxmode eu_rx_modes[] = {
|
|
/* EU modes */
|
|
[MAX2175_EU_FM_1_2] = { MAX2175_BAND_FM, 98256000, 1 },
|
|
[MAX2175_DAB_1_2] = { MAX2175_BAND_VHF, 182640000, 0 },
|
|
};
|
|
|
|
static const struct max2175_rxmode na_rx_modes[] = {
|
|
/* NA modes */
|
|
[MAX2175_NA_FM_1_0] = { MAX2175_BAND_FM, 98255520, 1 },
|
|
[MAX2175_NA_FM_2_0] = { MAX2175_BAND_FM, 98255520, 6 },
|
|
};
|
|
|
|
/*
|
|
* Preset values:
|
|
* Based on Maxim MAX2175 Register Table revision: 130p10
|
|
*/
|
|
static const u8 full_fm_eu_1p0[] = {
|
|
0x15, 0x04, 0xb8, 0xe3, 0x35, 0x18, 0x7c, 0x00,
|
|
0x00, 0x7d, 0x40, 0x08, 0x70, 0x7a, 0x88, 0x91,
|
|
0x61, 0x61, 0x61, 0x61, 0x5a, 0x0f, 0x34, 0x1c,
|
|
0x14, 0x88, 0x33, 0x02, 0x00, 0x09, 0x00, 0x65,
|
|
0x9f, 0x2b, 0x80, 0x00, 0x95, 0x05, 0x2c, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40,
|
|
0x4a, 0x08, 0xa8, 0x0e, 0x0e, 0x2f, 0x7e, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0xab, 0x5e, 0xa9,
|
|
0xae, 0xbb, 0x57, 0x18, 0x3b, 0x03, 0x3b, 0x64,
|
|
0x40, 0x60, 0x00, 0x2a, 0xbf, 0x3f, 0xff, 0x9f,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a, 0x00,
|
|
0xff, 0xfc, 0xef, 0x1c, 0x40, 0x00, 0x00, 0x02,
|
|
0x00, 0x00, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0xac, 0x40, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x75, 0x00, 0x00,
|
|
0x00, 0x47, 0x00, 0x00, 0x11, 0x3f, 0x22, 0x00,
|
|
0xf1, 0x00, 0x41, 0x03, 0xb0, 0x00, 0x00, 0x00,
|
|
0x1b,
|
|
};
|
|
|
|
static const u8 full_fm_na_1p0[] = {
|
|
0x13, 0x08, 0x8d, 0xc0, 0x35, 0x18, 0x7d, 0x3f,
|
|
0x7d, 0x75, 0x40, 0x08, 0x70, 0x7a, 0x88, 0x91,
|
|
0x61, 0x61, 0x61, 0x61, 0x5c, 0x0f, 0x34, 0x1c,
|
|
0x14, 0x88, 0x33, 0x02, 0x00, 0x01, 0x00, 0x65,
|
|
0x9f, 0x2b, 0x80, 0x00, 0x95, 0x05, 0x2c, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40,
|
|
0x4a, 0x08, 0xa8, 0x0e, 0x0e, 0xaf, 0x7e, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0xab, 0x5e, 0xa9,
|
|
0xae, 0xbb, 0x57, 0x18, 0x3b, 0x03, 0x3b, 0x64,
|
|
0x40, 0x60, 0x00, 0x2a, 0xbf, 0x3f, 0xff, 0x9f,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0a, 0x00,
|
|
0xff, 0xfc, 0xef, 0x1c, 0x40, 0x00, 0x00, 0x02,
|
|
0x00, 0x00, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0xa6, 0x40, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x75, 0x00, 0x00,
|
|
0x00, 0x35, 0x00, 0x00, 0x11, 0x3f, 0x22, 0x00,
|
|
0xf1, 0x00, 0x41, 0x03, 0xb0, 0x00, 0x00, 0x00,
|
|
0x1b,
|
|
};
|
|
|
|
/* DAB1.2 settings */
|
|
static const struct max2175_reg_map dab12_map[] = {
|
|
{ 0x01, 0x13 }, { 0x02, 0x0d }, { 0x03, 0x15 }, { 0x04, 0x55 },
|
|
{ 0x05, 0x0a }, { 0x06, 0xa0 }, { 0x07, 0x40 }, { 0x08, 0x00 },
|
|
{ 0x09, 0x00 }, { 0x0a, 0x7d }, { 0x0b, 0x4a }, { 0x0c, 0x28 },
|
|
{ 0x0e, 0x43 }, { 0x0f, 0xb5 }, { 0x10, 0x31 }, { 0x11, 0x9e },
|
|
{ 0x12, 0x68 }, { 0x13, 0x9e }, { 0x14, 0x68 }, { 0x15, 0x58 },
|
|
{ 0x16, 0x2f }, { 0x17, 0x3f }, { 0x18, 0x40 }, { 0x1a, 0x88 },
|
|
{ 0x1b, 0xaa }, { 0x1c, 0x9a }, { 0x1d, 0x00 }, { 0x1e, 0x00 },
|
|
{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x00 }, { 0x26, 0x00 },
|
|
{ 0x27, 0x00 }, { 0x32, 0x08 }, { 0x33, 0xf8 }, { 0x36, 0x2d },
|
|
{ 0x37, 0x7e }, { 0x55, 0xaf }, { 0x56, 0x3f }, { 0x57, 0xf8 },
|
|
{ 0x58, 0x99 }, { 0x76, 0x00 }, { 0x77, 0x00 }, { 0x78, 0x02 },
|
|
{ 0x79, 0x40 }, { 0x82, 0x00 }, { 0x83, 0x00 }, { 0x85, 0x00 },
|
|
{ 0x86, 0x20 },
|
|
};
|
|
|
|
/* EU FM 1.2 settings */
|
|
static const struct max2175_reg_map fmeu1p2_map[] = {
|
|
{ 0x01, 0x15 }, { 0x02, 0x04 }, { 0x03, 0xb8 }, { 0x04, 0xe3 },
|
|
{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7c }, { 0x08, 0x00 },
|
|
{ 0x09, 0x00 }, { 0x0a, 0x73 }, { 0x0b, 0x40 }, { 0x0c, 0x08 },
|
|
{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
|
|
{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5a },
|
|
{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
|
|
{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
|
|
{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
|
|
{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0x2f },
|
|
{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
|
|
{ 0x58, 0x9f }, { 0x76, 0xac }, { 0x77, 0x40 }, { 0x78, 0x00 },
|
|
{ 0x79, 0x00 }, { 0x82, 0x47 }, { 0x83, 0x00 }, { 0x85, 0x11 },
|
|
{ 0x86, 0x3f },
|
|
};
|
|
|
|
/* FM NA 1.0 settings */
|
|
static const struct max2175_reg_map fmna1p0_map[] = {
|
|
{ 0x01, 0x13 }, { 0x02, 0x08 }, { 0x03, 0x8d }, { 0x04, 0xc0 },
|
|
{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7d }, { 0x08, 0x3f },
|
|
{ 0x09, 0x7d }, { 0x0a, 0x75 }, { 0x0b, 0x40 }, { 0x0c, 0x08 },
|
|
{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
|
|
{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5c },
|
|
{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
|
|
{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
|
|
{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
|
|
{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0xaf },
|
|
{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
|
|
{ 0x58, 0x9f }, { 0x76, 0xa6 }, { 0x77, 0x40 }, { 0x78, 0x00 },
|
|
{ 0x79, 0x00 }, { 0x82, 0x35 }, { 0x83, 0x00 }, { 0x85, 0x11 },
|
|
{ 0x86, 0x3f },
|
|
};
|
|
|
|
/* FM NA 2.0 settings */
|
|
static const struct max2175_reg_map fmna2p0_map[] = {
|
|
{ 0x01, 0x13 }, { 0x02, 0x08 }, { 0x03, 0x8d }, { 0x04, 0xc0 },
|
|
{ 0x05, 0x35 }, { 0x06, 0x18 }, { 0x07, 0x7c }, { 0x08, 0x54 },
|
|
{ 0x09, 0xa7 }, { 0x0a, 0x55 }, { 0x0b, 0x42 }, { 0x0c, 0x48 },
|
|
{ 0x0e, 0x7a }, { 0x0f, 0x88 }, { 0x10, 0x91 }, { 0x11, 0x61 },
|
|
{ 0x12, 0x61 }, { 0x13, 0x61 }, { 0x14, 0x61 }, { 0x15, 0x5c },
|
|
{ 0x16, 0x0f }, { 0x17, 0x34 }, { 0x18, 0x1c }, { 0x1a, 0x88 },
|
|
{ 0x1b, 0x33 }, { 0x1c, 0x02 }, { 0x1d, 0x00 }, { 0x1e, 0x01 },
|
|
{ 0x23, 0x80 }, { 0x24, 0x00 }, { 0x25, 0x95 }, { 0x26, 0x05 },
|
|
{ 0x27, 0x2c }, { 0x32, 0x08 }, { 0x33, 0xa8 }, { 0x36, 0xaf },
|
|
{ 0x37, 0x7e }, { 0x55, 0xbf }, { 0x56, 0x3f }, { 0x57, 0xff },
|
|
{ 0x58, 0x9f }, { 0x76, 0xac }, { 0x77, 0xc0 }, { 0x78, 0x00 },
|
|
{ 0x79, 0x00 }, { 0x82, 0x6b }, { 0x83, 0x00 }, { 0x85, 0x11 },
|
|
{ 0x86, 0x3f },
|
|
};
|
|
|
|
static const u16 ch_coeff_dab1[] = {
|
|
0x001c, 0x0007, 0xffcd, 0x0056, 0xffa4, 0x0033, 0x0027, 0xff61,
|
|
0x010e, 0xfec0, 0x0106, 0xffb8, 0xff1c, 0x023c, 0xfcb2, 0x039b,
|
|
0xfd4e, 0x0055, 0x036a, 0xf7de, 0x0d21, 0xee72, 0x1499, 0x6a51,
|
|
};
|
|
|
|
static const u16 ch_coeff_fmeu[] = {
|
|
0x0000, 0xffff, 0x0001, 0x0002, 0xfffa, 0xffff, 0x0015, 0xffec,
|
|
0xffde, 0x0054, 0xfff9, 0xff52, 0x00b8, 0x00a2, 0xfe0a, 0x00af,
|
|
0x02e3, 0xfc14, 0xfe89, 0x089d, 0xfa2e, 0xf30f, 0x25be, 0x4eb6,
|
|
};
|
|
|
|
static const u16 eq_coeff_fmeu1_ra02_m6db[] = {
|
|
0x0040, 0xffc6, 0xfffa, 0x002c, 0x000d, 0xff90, 0x0037, 0x006e,
|
|
0xffc0, 0xff5b, 0x006a, 0x00f0, 0xff57, 0xfe94, 0x0112, 0x0252,
|
|
0xfe0c, 0xfc6a, 0x0385, 0x0553, 0xfa49, 0xf789, 0x0b91, 0x1a10,
|
|
};
|
|
|
|
static const u16 ch_coeff_fmna[] = {
|
|
0x0001, 0x0003, 0xfffe, 0xfff4, 0x0000, 0x001f, 0x000c, 0xffbc,
|
|
0xffd3, 0x007d, 0x0075, 0xff33, 0xff01, 0x0131, 0x01ef, 0xfe60,
|
|
0xfc7a, 0x020e, 0x0656, 0xfd94, 0xf395, 0x02ab, 0x2857, 0x3d3f,
|
|
};
|
|
|
|
static const u16 eq_coeff_fmna1_ra02_m6db[] = {
|
|
0xfff1, 0xffe1, 0xffef, 0x000e, 0x0030, 0x002f, 0xfff6, 0xffa7,
|
|
0xff9d, 0x000a, 0x00a2, 0x00b5, 0xffea, 0xfed9, 0xfec5, 0x003d,
|
|
0x0217, 0x021b, 0xff5a, 0xfc2b, 0xfcbd, 0x02c4, 0x0ac3, 0x0e85,
|
|
};
|
|
|
|
static const u8 adc_presets[2][23] = {
|
|
{
|
|
0x83, 0x00, 0xcf, 0xb4, 0x0f, 0x2c, 0x0c, 0x49,
|
|
0x00, 0x00, 0x00, 0x8c, 0x02, 0x02, 0x00, 0x04,
|
|
0xec, 0x82, 0x4b, 0xcc, 0x01, 0x88, 0x0c,
|
|
},
|
|
{
|
|
0x83, 0x00, 0xcf, 0xb4, 0x0f, 0x2c, 0x0c, 0x49,
|
|
0x00, 0x00, 0x00, 0x8c, 0x02, 0x20, 0x33, 0x8c,
|
|
0x57, 0xd7, 0x59, 0xb7, 0x65, 0x0e, 0x0c,
|
|
},
|
|
};
|
|
|
|
/* Tuner bands */
|
|
static const struct v4l2_frequency_band eu_bands_rf = {
|
|
.tuner = 0,
|
|
.type = V4L2_TUNER_RF,
|
|
.index = 0,
|
|
.capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS,
|
|
.rangelow = 65000000,
|
|
.rangehigh = 240000000,
|
|
};
|
|
|
|
static const struct v4l2_frequency_band na_bands_rf = {
|
|
.tuner = 0,
|
|
.type = V4L2_TUNER_RF,
|
|
.index = 0,
|
|
.capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS,
|
|
.rangelow = 65000000,
|
|
.rangehigh = 108000000,
|
|
};
|
|
|
|
/* Regmap settings */
|
|
static const struct regmap_range max2175_regmap_volatile_range[] = {
|
|
regmap_reg_range(0x30, 0x35),
|
|
regmap_reg_range(0x3a, 0x45),
|
|
regmap_reg_range(0x59, 0x5e),
|
|
regmap_reg_range(0x73, 0x75),
|
|
};
|
|
|
|
static const struct regmap_access_table max2175_volatile_regs = {
|
|
.yes_ranges = max2175_regmap_volatile_range,
|
|
.n_yes_ranges = ARRAY_SIZE(max2175_regmap_volatile_range),
|
|
};
|
|
|
|
static const struct reg_default max2175_reg_defaults[] = {
|
|
{ 0x00, 0x07},
|
|
};
|
|
|
|
static const struct regmap_config max2175_regmap_config = {
|
|
.reg_bits = 8,
|
|
.val_bits = 8,
|
|
.max_register = 0xff,
|
|
.reg_defaults = max2175_reg_defaults,
|
|
.num_reg_defaults = ARRAY_SIZE(max2175_reg_defaults),
|
|
.volatile_table = &max2175_volatile_regs,
|
|
.cache_type = REGCACHE_RBTREE,
|
|
};
|
|
|
|
struct max2175 {
|
|
struct v4l2_subdev sd; /* Sub-device */
|
|
struct i2c_client *client; /* I2C client */
|
|
|
|
/* Controls */
|
|
struct v4l2_ctrl_handler ctrl_hdl;
|
|
struct v4l2_ctrl *lna_gain; /* LNA gain value */
|
|
struct v4l2_ctrl *if_gain; /* I/F gain value */
|
|
struct v4l2_ctrl *pll_lock; /* PLL lock */
|
|
struct v4l2_ctrl *i2s_en; /* I2S output enable */
|
|
struct v4l2_ctrl *hsls; /* High-side/Low-side polarity */
|
|
struct v4l2_ctrl *rx_mode; /* Receive mode */
|
|
|
|
/* Regmap */
|
|
struct regmap *regmap;
|
|
|
|
/* Cached configuration */
|
|
u32 freq; /* Tuned freq In Hz */
|
|
const struct max2175_rxmode *rx_modes; /* EU or NA modes */
|
|
const struct v4l2_frequency_band *bands_rf; /* EU or NA bands */
|
|
|
|
/* Device settings */
|
|
unsigned long xtal_freq; /* Ref Oscillator freq in Hz */
|
|
u32 decim_ratio;
|
|
bool master; /* Master/Slave */
|
|
bool am_hiz; /* AM Hi-Z filter */
|
|
|
|
/* ROM values */
|
|
u8 rom_bbf_bw_am;
|
|
u8 rom_bbf_bw_fm;
|
|
u8 rom_bbf_bw_dab;
|
|
|
|
/* Driver private variables */
|
|
bool mode_resolved; /* Flag to sanity check settings */
|
|
};
|
|
|
|
static inline struct max2175 *max2175_from_sd(struct v4l2_subdev *sd)
|
|
{
|
|
return container_of(sd, struct max2175, sd);
|
|
}
|
|
|
|
static inline struct max2175 *max2175_from_ctrl_hdl(struct v4l2_ctrl_handler *h)
|
|
{
|
|
return container_of(h, struct max2175, ctrl_hdl);
|
|
}
|
|
|
|
/* Get bitval of a given val */
|
|
static inline u8 max2175_get_bitval(u8 val, u8 msb, u8 lsb)
|
|
{
|
|
return (val & GENMASK(msb, lsb)) >> lsb;
|
|
}
|
|
|
|
/* Read/Write bit(s) on top of regmap */
|
|
static int max2175_read(struct max2175 *ctx, u8 idx, u8 *val)
|
|
{
|
|
u32 regval;
|
|
int ret;
|
|
|
|
ret = regmap_read(ctx->regmap, idx, ®val);
|
|
if (ret)
|
|
mxm_err(ctx, "read ret(%d): idx 0x%02x\n", ret, idx);
|
|
else
|
|
*val = regval;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_write(struct max2175 *ctx, u8 idx, u8 val)
|
|
{
|
|
int ret;
|
|
|
|
ret = regmap_write(ctx->regmap, idx, val);
|
|
if (ret)
|
|
mxm_err(ctx, "write ret(%d): idx 0x%02x val 0x%02x\n",
|
|
ret, idx, val);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static u8 max2175_read_bits(struct max2175 *ctx, u8 idx, u8 msb, u8 lsb)
|
|
{
|
|
u8 val;
|
|
|
|
if (max2175_read(ctx, idx, &val))
|
|
return 0;
|
|
|
|
return max2175_get_bitval(val, msb, lsb);
|
|
}
|
|
|
|
static int max2175_write_bits(struct max2175 *ctx, u8 idx,
|
|
u8 msb, u8 lsb, u8 newval)
|
|
{
|
|
int ret = regmap_update_bits(ctx->regmap, idx, GENMASK(msb, lsb),
|
|
newval << lsb);
|
|
|
|
if (ret)
|
|
mxm_err(ctx, "wbits ret(%d): idx 0x%02x\n", ret, idx);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_write_bit(struct max2175 *ctx, u8 idx, u8 bit, u8 newval)
|
|
{
|
|
return max2175_write_bits(ctx, idx, bit, bit, newval);
|
|
}
|
|
|
|
/* Checks expected pattern every msec until timeout */
|
|
static int max2175_poll_timeout(struct max2175 *ctx, u8 idx, u8 msb, u8 lsb,
|
|
u8 exp_bitval, u32 timeout_us)
|
|
{
|
|
unsigned int val;
|
|
|
|
return regmap_read_poll_timeout(ctx->regmap, idx, val,
|
|
(max2175_get_bitval(val, msb, lsb) == exp_bitval),
|
|
1000, timeout_us);
|
|
}
|
|
|
|
static int max2175_poll_csm_ready(struct max2175 *ctx)
|
|
{
|
|
int ret;
|
|
|
|
ret = max2175_poll_timeout(ctx, 69, 1, 1, 0, 50000);
|
|
if (ret)
|
|
mxm_err(ctx, "csm not ready\n");
|
|
|
|
return ret;
|
|
}
|
|
|
|
#define MAX2175_IS_BAND_AM(ctx) \
|
|
(max2175_read_bits(ctx, 5, 1, 0) == MAX2175_BAND_AM)
|
|
|
|
#define MAX2175_IS_BAND_VHF(ctx) \
|
|
(max2175_read_bits(ctx, 5, 1, 0) == MAX2175_BAND_VHF)
|
|
|
|
#define MAX2175_IS_FM_MODE(ctx) \
|
|
(max2175_read_bits(ctx, 12, 5, 4) == 0)
|
|
|
|
#define MAX2175_IS_FMHD_MODE(ctx) \
|
|
(max2175_read_bits(ctx, 12, 5, 4) == 1)
|
|
|
|
#define MAX2175_IS_DAB_MODE(ctx) \
|
|
(max2175_read_bits(ctx, 12, 5, 4) == 2)
|
|
|
|
static int max2175_band_from_freq(u32 freq)
|
|
{
|
|
if (freq >= 144000 && freq <= 26100000)
|
|
return MAX2175_BAND_AM;
|
|
else if (freq >= 65000000 && freq <= 108000000)
|
|
return MAX2175_BAND_FM;
|
|
|
|
return MAX2175_BAND_VHF;
|
|
}
|
|
|
|
static void max2175_i2s_enable(struct max2175 *ctx, bool enable)
|
|
{
|
|
if (enable)
|
|
/* Stuff bits are zeroed */
|
|
max2175_write_bits(ctx, 104, 3, 0, 2);
|
|
else
|
|
/* Keep SCK alive */
|
|
max2175_write_bits(ctx, 104, 3, 0, 9);
|
|
mxm_dbg(ctx, "i2s %sabled\n", enable ? "en" : "dis");
|
|
}
|
|
|
|
static void max2175_set_filter_coeffs(struct max2175 *ctx, u8 m_sel,
|
|
u8 bank, const u16 *coeffs)
|
|
{
|
|
unsigned int i;
|
|
u8 coeff_addr, upper_address = 24;
|
|
|
|
mxm_dbg(ctx, "set_filter_coeffs: m_sel %d bank %d\n", m_sel, bank);
|
|
max2175_write_bits(ctx, 114, 5, 4, m_sel);
|
|
|
|
if (m_sel == 2)
|
|
upper_address = 12;
|
|
|
|
for (i = 0; i < upper_address; i++) {
|
|
coeff_addr = i + bank * 24;
|
|
max2175_write(ctx, 115, coeffs[i] >> 8);
|
|
max2175_write(ctx, 116, coeffs[i]);
|
|
max2175_write(ctx, 117, coeff_addr | 1 << 7);
|
|
}
|
|
max2175_write_bit(ctx, 117, 7, 0);
|
|
}
|
|
|
|
static void max2175_load_fmeu_1p2(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fmeu1p2_map); i++)
|
|
max2175_write(ctx, fmeu1p2_map[i].idx, fmeu1p2_map[i].val);
|
|
|
|
ctx->decim_ratio = 36;
|
|
|
|
/* Load the Channel Filter Coefficients into channel filter bank #2 */
|
|
max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0, ch_coeff_fmeu);
|
|
max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
|
|
eq_coeff_fmeu1_ra02_m6db);
|
|
}
|
|
|
|
static void max2175_load_dab_1p2(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dab12_map); i++)
|
|
max2175_write(ctx, dab12_map[i].idx, dab12_map[i].val);
|
|
|
|
ctx->decim_ratio = 1;
|
|
|
|
/* Load the Channel Filter Coefficients into channel filter bank #2 */
|
|
max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 2, ch_coeff_dab1);
|
|
}
|
|
|
|
static void max2175_load_fmna_1p0(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fmna1p0_map); i++)
|
|
max2175_write(ctx, fmna1p0_map[i].idx, fmna1p0_map[i].val);
|
|
}
|
|
|
|
static void max2175_load_fmna_2p0(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fmna2p0_map); i++)
|
|
max2175_write(ctx, fmna2p0_map[i].idx, fmna2p0_map[i].val);
|
|
}
|
|
|
|
static void max2175_set_bbfilter(struct max2175 *ctx)
|
|
{
|
|
if (MAX2175_IS_BAND_AM(ctx)) {
|
|
max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_am);
|
|
mxm_dbg(ctx, "set_bbfilter AM: rom %d\n", ctx->rom_bbf_bw_am);
|
|
} else if (MAX2175_IS_DAB_MODE(ctx)) {
|
|
max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_dab);
|
|
mxm_dbg(ctx, "set_bbfilter DAB: rom %d\n", ctx->rom_bbf_bw_dab);
|
|
} else {
|
|
max2175_write_bits(ctx, 12, 3, 0, ctx->rom_bbf_bw_fm);
|
|
mxm_dbg(ctx, "set_bbfilter FM: rom %d\n", ctx->rom_bbf_bw_fm);
|
|
}
|
|
}
|
|
|
|
static int max2175_set_csm_mode(struct max2175 *ctx,
|
|
enum max2175_csm_mode new_mode)
|
|
{
|
|
int ret = max2175_poll_csm_ready(ctx);
|
|
|
|
if (ret)
|
|
return ret;
|
|
|
|
max2175_write_bits(ctx, 0, 2, 0, new_mode);
|
|
mxm_dbg(ctx, "set csm new mode %d\n", new_mode);
|
|
|
|
/* Wait for a fixed settle down time depending on new mode */
|
|
switch (new_mode) {
|
|
case MAX2175_PRESET_TUNE:
|
|
usleep_range(51100, 51500); /* 51.1ms */
|
|
break;
|
|
/*
|
|
* Other mode switches need different sleep values depending on band &
|
|
* mode
|
|
*/
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return max2175_poll_csm_ready(ctx);
|
|
}
|
|
|
|
static int max2175_csm_action(struct max2175 *ctx,
|
|
enum max2175_csm_mode action)
|
|
{
|
|
int ret;
|
|
|
|
mxm_dbg(ctx, "csm_action: %d\n", action);
|
|
|
|
/* Other actions can be added in future when needed */
|
|
ret = max2175_set_csm_mode(ctx, MAX2175_LOAD_TO_BUFFER);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return max2175_set_csm_mode(ctx, MAX2175_PRESET_TUNE);
|
|
}
|
|
|
|
static int max2175_set_lo_freq(struct max2175 *ctx, u32 lo_freq)
|
|
{
|
|
u8 lo_mult, loband_bits = 0, vcodiv_bits = 0;
|
|
u32 int_desired, frac_desired;
|
|
enum max2175_band band;
|
|
int ret;
|
|
|
|
band = max2175_read_bits(ctx, 5, 1, 0);
|
|
switch (band) {
|
|
case MAX2175_BAND_AM:
|
|
lo_mult = 16;
|
|
break;
|
|
case MAX2175_BAND_FM:
|
|
if (lo_freq <= 74700000) {
|
|
lo_mult = 16;
|
|
} else if (lo_freq > 74700000 && lo_freq <= 110000000) {
|
|
loband_bits = 1;
|
|
lo_mult = 8;
|
|
} else {
|
|
loband_bits = 1;
|
|
vcodiv_bits = 3;
|
|
lo_mult = 8;
|
|
}
|
|
break;
|
|
case MAX2175_BAND_VHF:
|
|
if (lo_freq <= 210000000)
|
|
vcodiv_bits = 2;
|
|
else
|
|
vcodiv_bits = 1;
|
|
|
|
loband_bits = 2;
|
|
lo_mult = 4;
|
|
break;
|
|
default:
|
|
loband_bits = 3;
|
|
vcodiv_bits = 2;
|
|
lo_mult = 2;
|
|
break;
|
|
}
|
|
|
|
if (band == MAX2175_BAND_L)
|
|
lo_freq /= lo_mult;
|
|
else
|
|
lo_freq *= lo_mult;
|
|
|
|
int_desired = lo_freq / ctx->xtal_freq;
|
|
frac_desired = div64_ul((u64)(lo_freq % ctx->xtal_freq) << 20,
|
|
ctx->xtal_freq);
|
|
|
|
/* Check CSM is not busy */
|
|
ret = max2175_poll_csm_ready(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mxm_dbg(ctx, "lo_mult %u int %u frac %u\n",
|
|
lo_mult, int_desired, frac_desired);
|
|
|
|
/* Write the calculated values to the appropriate registers */
|
|
max2175_write(ctx, 1, int_desired);
|
|
max2175_write_bits(ctx, 2, 3, 0, (frac_desired >> 16) & 0xf);
|
|
max2175_write(ctx, 3, frac_desired >> 8);
|
|
max2175_write(ctx, 4, frac_desired);
|
|
max2175_write_bits(ctx, 5, 3, 2, loband_bits);
|
|
max2175_write_bits(ctx, 6, 7, 6, vcodiv_bits);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Helper similar to DIV_ROUND_CLOSEST but an inline function that accepts s64
|
|
* dividend and s32 divisor
|
|
*/
|
|
static inline s64 max2175_round_closest(s64 dividend, s32 divisor)
|
|
{
|
|
if ((dividend > 0 && divisor > 0) || (dividend < 0 && divisor < 0))
|
|
return div_s64(dividend + divisor / 2, divisor);
|
|
|
|
return div_s64(dividend - divisor / 2, divisor);
|
|
}
|
|
|
|
static int max2175_set_nco_freq(struct max2175 *ctx, s32 nco_freq)
|
|
{
|
|
s32 clock_rate = ctx->xtal_freq / ctx->decim_ratio;
|
|
u32 nco_reg, abs_nco_freq = abs(nco_freq);
|
|
s64 nco_val_desired;
|
|
int ret;
|
|
|
|
if (abs_nco_freq < clock_rate / 2) {
|
|
nco_val_desired = 2 * nco_freq;
|
|
} else {
|
|
nco_val_desired = 2LL * (clock_rate - abs_nco_freq);
|
|
if (nco_freq < 0)
|
|
nco_val_desired = -nco_val_desired;
|
|
}
|
|
|
|
nco_reg = max2175_round_closest(nco_val_desired << 20, clock_rate);
|
|
|
|
if (nco_freq < 0)
|
|
nco_reg += 0x200000;
|
|
|
|
/* Check CSM is not busy */
|
|
ret = max2175_poll_csm_ready(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mxm_dbg(ctx, "freq %d desired %lld reg %u\n",
|
|
nco_freq, nco_val_desired, nco_reg);
|
|
|
|
/* Write the calculated values to the appropriate registers */
|
|
max2175_write_bits(ctx, 7, 4, 0, (nco_reg >> 16) & 0x1f);
|
|
max2175_write(ctx, 8, nco_reg >> 8);
|
|
max2175_write(ctx, 9, nco_reg);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_set_rf_freq_non_am_bands(struct max2175 *ctx, u64 freq,
|
|
u32 lo_pos)
|
|
{
|
|
s64 adj_freq, low_if_freq;
|
|
int ret;
|
|
|
|
mxm_dbg(ctx, "rf_freq: non AM bands\n");
|
|
|
|
if (MAX2175_IS_FM_MODE(ctx))
|
|
low_if_freq = 128000;
|
|
else if (MAX2175_IS_FMHD_MODE(ctx))
|
|
low_if_freq = 228000;
|
|
else
|
|
return max2175_set_lo_freq(ctx, freq);
|
|
|
|
if (MAX2175_IS_BAND_VHF(ctx) == (lo_pos == MAX2175_LO_ABOVE_DESIRED))
|
|
adj_freq = freq + low_if_freq;
|
|
else
|
|
adj_freq = freq - low_if_freq;
|
|
|
|
ret = max2175_set_lo_freq(ctx, adj_freq);
|
|
if (ret)
|
|
return ret;
|
|
|
|
return max2175_set_nco_freq(ctx, -low_if_freq);
|
|
}
|
|
|
|
static int max2175_set_rf_freq(struct max2175 *ctx, u64 freq, u32 lo_pos)
|
|
{
|
|
int ret;
|
|
|
|
if (MAX2175_IS_BAND_AM(ctx))
|
|
ret = max2175_set_nco_freq(ctx, freq);
|
|
else
|
|
ret = max2175_set_rf_freq_non_am_bands(ctx, freq, lo_pos);
|
|
|
|
mxm_dbg(ctx, "set_rf_freq: ret %d freq %llu\n", ret, freq);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_tune_rf_freq(struct max2175 *ctx, u64 freq, u32 hsls)
|
|
{
|
|
int ret;
|
|
|
|
ret = max2175_set_rf_freq(ctx, freq, hsls);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = max2175_csm_action(ctx, MAX2175_BUFFER_PLUS_PRESET_TUNE);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mxm_dbg(ctx, "tune_rf_freq: old %u new %llu\n", ctx->freq, freq);
|
|
ctx->freq = freq;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void max2175_set_hsls(struct max2175 *ctx, u32 lo_pos)
|
|
{
|
|
mxm_dbg(ctx, "set_hsls: lo_pos %u\n", lo_pos);
|
|
|
|
if ((lo_pos == MAX2175_LO_BELOW_DESIRED) == MAX2175_IS_BAND_VHF(ctx))
|
|
max2175_write_bit(ctx, 5, 4, 1);
|
|
else
|
|
max2175_write_bit(ctx, 5, 4, 0);
|
|
}
|
|
|
|
static void max2175_set_eu_rx_mode(struct max2175 *ctx, u32 rx_mode)
|
|
{
|
|
switch (rx_mode) {
|
|
case MAX2175_EU_FM_1_2:
|
|
max2175_load_fmeu_1p2(ctx);
|
|
break;
|
|
|
|
case MAX2175_DAB_1_2:
|
|
max2175_load_dab_1p2(ctx);
|
|
break;
|
|
}
|
|
/* Master is the default setting */
|
|
if (!ctx->master)
|
|
max2175_write_bit(ctx, 30, 7, 1);
|
|
}
|
|
|
|
static void max2175_set_na_rx_mode(struct max2175 *ctx, u32 rx_mode)
|
|
{
|
|
switch (rx_mode) {
|
|
case MAX2175_NA_FM_1_0:
|
|
max2175_load_fmna_1p0(ctx);
|
|
break;
|
|
case MAX2175_NA_FM_2_0:
|
|
max2175_load_fmna_2p0(ctx);
|
|
break;
|
|
}
|
|
/* Master is the default setting */
|
|
if (!ctx->master)
|
|
max2175_write_bit(ctx, 30, 7, 1);
|
|
|
|
ctx->decim_ratio = 27;
|
|
|
|
/* Load the Channel Filter Coefficients into channel filter bank #2 */
|
|
max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0, ch_coeff_fmna);
|
|
max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
|
|
eq_coeff_fmna1_ra02_m6db);
|
|
}
|
|
|
|
static int max2175_set_rx_mode(struct max2175 *ctx, u32 rx_mode)
|
|
{
|
|
mxm_dbg(ctx, "set_rx_mode: %u am_hiz %u\n", rx_mode, ctx->am_hiz);
|
|
if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ)
|
|
max2175_set_eu_rx_mode(ctx, rx_mode);
|
|
else
|
|
max2175_set_na_rx_mode(ctx, rx_mode);
|
|
|
|
if (ctx->am_hiz) {
|
|
mxm_dbg(ctx, "setting AM HiZ related config\n");
|
|
max2175_write_bit(ctx, 50, 5, 1);
|
|
max2175_write_bit(ctx, 90, 7, 1);
|
|
max2175_write_bits(ctx, 73, 1, 0, 2);
|
|
max2175_write_bits(ctx, 80, 5, 0, 33);
|
|
}
|
|
|
|
/* Load BB filter trim values saved in ROM */
|
|
max2175_set_bbfilter(ctx);
|
|
|
|
/* Set HSLS */
|
|
max2175_set_hsls(ctx, ctx->hsls->cur.val);
|
|
|
|
/* Use i2s enable settings */
|
|
max2175_i2s_enable(ctx, ctx->i2s_en->cur.val);
|
|
|
|
ctx->mode_resolved = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max2175_rx_mode_from_freq(struct max2175 *ctx, u32 freq, u32 *mode)
|
|
{
|
|
unsigned int i;
|
|
int band = max2175_band_from_freq(freq);
|
|
|
|
/* Pick the first match always */
|
|
for (i = 0; i <= ctx->rx_mode->maximum; i++) {
|
|
if (ctx->rx_modes[i].band == band) {
|
|
*mode = i;
|
|
mxm_dbg(ctx, "rx_mode_from_freq: freq %u mode %d\n",
|
|
freq, *mode);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
static bool max2175_freq_rx_mode_valid(struct max2175 *ctx,
|
|
u32 mode, u32 freq)
|
|
{
|
|
int band = max2175_band_from_freq(freq);
|
|
|
|
return (ctx->rx_modes[mode].band == band);
|
|
}
|
|
|
|
static void max2175_load_adc_presets(struct max2175 *ctx)
|
|
{
|
|
unsigned int i, j;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(adc_presets); i++)
|
|
for (j = 0; j < ARRAY_SIZE(adc_presets[0]); j++)
|
|
max2175_write(ctx, 146 + j + i * 55, adc_presets[i][j]);
|
|
}
|
|
|
|
static int max2175_init_power_manager(struct max2175 *ctx)
|
|
{
|
|
int ret;
|
|
|
|
/* Execute on-chip power-up/calibration */
|
|
max2175_write_bit(ctx, 99, 2, 0);
|
|
usleep_range(1000, 1500);
|
|
max2175_write_bit(ctx, 99, 2, 1);
|
|
|
|
/* Wait for the power manager to finish. */
|
|
ret = max2175_poll_timeout(ctx, 69, 7, 7, 1, 50000);
|
|
if (ret)
|
|
mxm_err(ctx, "init pm failed\n");
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_recalibrate_adc(struct max2175 *ctx)
|
|
{
|
|
int ret;
|
|
|
|
/* ADC Re-calibration */
|
|
max2175_write(ctx, 150, 0xff);
|
|
max2175_write(ctx, 205, 0xff);
|
|
max2175_write(ctx, 147, 0x20);
|
|
max2175_write(ctx, 147, 0x00);
|
|
max2175_write(ctx, 202, 0x20);
|
|
max2175_write(ctx, 202, 0x00);
|
|
|
|
ret = max2175_poll_timeout(ctx, 69, 4, 3, 3, 50000);
|
|
if (ret)
|
|
mxm_err(ctx, "adc recalibration failed\n");
|
|
|
|
return ret;
|
|
}
|
|
|
|
static u8 max2175_read_rom(struct max2175 *ctx, u8 row)
|
|
{
|
|
u8 data = 0;
|
|
|
|
max2175_write_bit(ctx, 56, 4, 0);
|
|
max2175_write_bits(ctx, 56, 3, 0, row);
|
|
|
|
usleep_range(2000, 2500);
|
|
max2175_read(ctx, 58, &data);
|
|
|
|
max2175_write_bits(ctx, 56, 3, 0, 0);
|
|
|
|
mxm_dbg(ctx, "read_rom: row %d data 0x%02x\n", row, data);
|
|
|
|
return data;
|
|
}
|
|
|
|
static void max2175_load_from_rom(struct max2175 *ctx)
|
|
{
|
|
u8 data = 0;
|
|
|
|
data = max2175_read_rom(ctx, 0);
|
|
ctx->rom_bbf_bw_am = data & 0x0f;
|
|
max2175_write_bits(ctx, 81, 3, 0, data >> 4);
|
|
|
|
data = max2175_read_rom(ctx, 1);
|
|
ctx->rom_bbf_bw_fm = data & 0x0f;
|
|
ctx->rom_bbf_bw_dab = data >> 4;
|
|
|
|
data = max2175_read_rom(ctx, 2);
|
|
max2175_write_bits(ctx, 82, 4, 0, data & 0x1f);
|
|
max2175_write_bits(ctx, 82, 7, 5, data >> 5);
|
|
|
|
data = max2175_read_rom(ctx, 3);
|
|
if (ctx->am_hiz) {
|
|
data &= 0x0f;
|
|
data |= (max2175_read_rom(ctx, 7) & 0x40) >> 2;
|
|
if (!data)
|
|
data |= 2;
|
|
} else {
|
|
data = (data & 0xf0) >> 4;
|
|
data |= (max2175_read_rom(ctx, 7) & 0x80) >> 3;
|
|
if (!data)
|
|
data |= 30;
|
|
}
|
|
max2175_write_bits(ctx, 80, 5, 0, data + 31);
|
|
|
|
data = max2175_read_rom(ctx, 6);
|
|
max2175_write_bits(ctx, 81, 7, 6, data >> 6);
|
|
}
|
|
|
|
static void max2175_load_full_fm_eu_1p0(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(full_fm_eu_1p0); i++)
|
|
max2175_write(ctx, i + 1, full_fm_eu_1p0[i]);
|
|
|
|
usleep_range(5000, 5500);
|
|
ctx->decim_ratio = 36;
|
|
}
|
|
|
|
static void max2175_load_full_fm_na_1p0(struct max2175 *ctx)
|
|
{
|
|
unsigned int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(full_fm_na_1p0); i++)
|
|
max2175_write(ctx, i + 1, full_fm_na_1p0[i]);
|
|
|
|
usleep_range(5000, 5500);
|
|
ctx->decim_ratio = 27;
|
|
}
|
|
|
|
static int max2175_core_init(struct max2175 *ctx, u32 refout_bits)
|
|
{
|
|
int ret;
|
|
|
|
/* MAX2175 uses 36.864MHz clock for EU & 40.154MHz for NA region */
|
|
if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ)
|
|
max2175_load_full_fm_eu_1p0(ctx);
|
|
else
|
|
max2175_load_full_fm_na_1p0(ctx);
|
|
|
|
/* The default settings assume master */
|
|
if (!ctx->master)
|
|
max2175_write_bit(ctx, 30, 7, 1);
|
|
|
|
mxm_dbg(ctx, "refout_bits %u\n", refout_bits);
|
|
|
|
/* Set REFOUT */
|
|
max2175_write_bits(ctx, 56, 7, 5, refout_bits);
|
|
|
|
/* ADC Reset */
|
|
max2175_write_bit(ctx, 99, 1, 0);
|
|
usleep_range(1000, 1500);
|
|
max2175_write_bit(ctx, 99, 1, 1);
|
|
|
|
/* Load ADC preset values */
|
|
max2175_load_adc_presets(ctx);
|
|
|
|
/* Initialize the power management state machine */
|
|
ret = max2175_init_power_manager(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Recalibrate ADC */
|
|
ret = max2175_recalibrate_adc(ctx);
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Load ROM values to appropriate registers */
|
|
max2175_load_from_rom(ctx);
|
|
|
|
if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
|
|
/* Load FIR coefficients into bank 0 */
|
|
max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0,
|
|
ch_coeff_fmeu);
|
|
max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
|
|
eq_coeff_fmeu1_ra02_m6db);
|
|
} else {
|
|
/* Load FIR coefficients into bank 0 */
|
|
max2175_set_filter_coeffs(ctx, MAX2175_CH_MSEL, 0,
|
|
ch_coeff_fmna);
|
|
max2175_set_filter_coeffs(ctx, MAX2175_EQ_MSEL, 0,
|
|
eq_coeff_fmna1_ra02_m6db);
|
|
}
|
|
mxm_dbg(ctx, "core initialized\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void max2175_s_ctrl_rx_mode(struct max2175 *ctx, u32 rx_mode)
|
|
{
|
|
/* Load mode. Range check already done */
|
|
max2175_set_rx_mode(ctx, rx_mode);
|
|
|
|
mxm_dbg(ctx, "s_ctrl_rx_mode: %u curr freq %u\n", rx_mode, ctx->freq);
|
|
|
|
/* Check if current freq valid for mode & update */
|
|
if (max2175_freq_rx_mode_valid(ctx, rx_mode, ctx->freq))
|
|
max2175_tune_rf_freq(ctx, ctx->freq, ctx->hsls->cur.val);
|
|
else
|
|
/* Use default freq of mode if current freq is not valid */
|
|
max2175_tune_rf_freq(ctx, ctx->rx_modes[rx_mode].freq,
|
|
ctx->hsls->cur.val);
|
|
}
|
|
|
|
static int max2175_s_ctrl(struct v4l2_ctrl *ctrl)
|
|
{
|
|
struct max2175 *ctx = max2175_from_ctrl_hdl(ctrl->handler);
|
|
|
|
mxm_dbg(ctx, "s_ctrl: id 0x%x, val %u\n", ctrl->id, ctrl->val);
|
|
switch (ctrl->id) {
|
|
case V4L2_CID_MAX2175_I2S_ENABLE:
|
|
max2175_i2s_enable(ctx, ctrl->val);
|
|
break;
|
|
case V4L2_CID_MAX2175_HSLS:
|
|
max2175_set_hsls(ctx, ctrl->val);
|
|
break;
|
|
case V4L2_CID_MAX2175_RX_MODE:
|
|
max2175_s_ctrl_rx_mode(ctx, ctrl->val);
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static u32 max2175_get_lna_gain(struct max2175 *ctx)
|
|
{
|
|
enum max2175_band band = max2175_read_bits(ctx, 5, 1, 0);
|
|
|
|
switch (band) {
|
|
case MAX2175_BAND_AM:
|
|
return max2175_read_bits(ctx, 51, 3, 0);
|
|
case MAX2175_BAND_FM:
|
|
return max2175_read_bits(ctx, 50, 3, 0);
|
|
case MAX2175_BAND_VHF:
|
|
return max2175_read_bits(ctx, 52, 5, 0);
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static int max2175_g_volatile_ctrl(struct v4l2_ctrl *ctrl)
|
|
{
|
|
struct max2175 *ctx = max2175_from_ctrl_hdl(ctrl->handler);
|
|
|
|
switch (ctrl->id) {
|
|
case V4L2_CID_RF_TUNER_LNA_GAIN:
|
|
ctrl->val = max2175_get_lna_gain(ctx);
|
|
break;
|
|
case V4L2_CID_RF_TUNER_IF_GAIN:
|
|
ctrl->val = max2175_read_bits(ctx, 49, 4, 0);
|
|
break;
|
|
case V4L2_CID_RF_TUNER_PLL_LOCK:
|
|
ctrl->val = (max2175_read_bits(ctx, 60, 7, 6) == 3);
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
};
|
|
|
|
static int max2175_set_freq_and_mode(struct max2175 *ctx, u32 freq)
|
|
{
|
|
u32 rx_mode;
|
|
int ret;
|
|
|
|
/* Get band from frequency */
|
|
ret = max2175_rx_mode_from_freq(ctx, freq, &rx_mode);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mxm_dbg(ctx, "set_freq_and_mode: freq %u rx_mode %d\n", freq, rx_mode);
|
|
|
|
/* Load mode */
|
|
max2175_set_rx_mode(ctx, rx_mode);
|
|
ctx->rx_mode->cur.val = rx_mode;
|
|
|
|
/* Tune to the new freq given */
|
|
return max2175_tune_rf_freq(ctx, freq, ctx->hsls->cur.val);
|
|
}
|
|
|
|
static int max2175_s_frequency(struct v4l2_subdev *sd,
|
|
const struct v4l2_frequency *vf)
|
|
{
|
|
struct max2175 *ctx = max2175_from_sd(sd);
|
|
u32 freq;
|
|
int ret = 0;
|
|
|
|
mxm_dbg(ctx, "s_freq: new %u curr %u, mode_resolved %d\n",
|
|
vf->frequency, ctx->freq, ctx->mode_resolved);
|
|
|
|
if (vf->tuner != 0)
|
|
return -EINVAL;
|
|
|
|
freq = clamp(vf->frequency, ctx->bands_rf->rangelow,
|
|
ctx->bands_rf->rangehigh);
|
|
|
|
/* Check new freq valid for rx_mode if already resolved */
|
|
if (ctx->mode_resolved &&
|
|
max2175_freq_rx_mode_valid(ctx, ctx->rx_mode->cur.val, freq))
|
|
ret = max2175_tune_rf_freq(ctx, freq, ctx->hsls->cur.val);
|
|
else
|
|
/* Find default rx_mode for freq and tune to it */
|
|
ret = max2175_set_freq_and_mode(ctx, freq);
|
|
|
|
mxm_dbg(ctx, "s_freq: ret %d curr %u mode_resolved %d mode %u\n",
|
|
ret, ctx->freq, ctx->mode_resolved, ctx->rx_mode->cur.val);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int max2175_g_frequency(struct v4l2_subdev *sd,
|
|
struct v4l2_frequency *vf)
|
|
{
|
|
struct max2175 *ctx = max2175_from_sd(sd);
|
|
|
|
if (vf->tuner != 0)
|
|
return -EINVAL;
|
|
|
|
/* RF freq */
|
|
vf->type = V4L2_TUNER_RF;
|
|
vf->frequency = ctx->freq;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max2175_enum_freq_bands(struct v4l2_subdev *sd,
|
|
struct v4l2_frequency_band *band)
|
|
{
|
|
struct max2175 *ctx = max2175_from_sd(sd);
|
|
|
|
if (band->tuner != 0 || band->index != 0)
|
|
return -EINVAL;
|
|
|
|
*band = *ctx->bands_rf;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max2175_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
|
|
{
|
|
struct max2175 *ctx = max2175_from_sd(sd);
|
|
|
|
if (vt->index > 0)
|
|
return -EINVAL;
|
|
|
|
strscpy(vt->name, "RF", sizeof(vt->name));
|
|
vt->type = V4L2_TUNER_RF;
|
|
vt->capability = V4L2_TUNER_CAP_1HZ | V4L2_TUNER_CAP_FREQ_BANDS;
|
|
vt->rangelow = ctx->bands_rf->rangelow;
|
|
vt->rangehigh = ctx->bands_rf->rangehigh;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max2175_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
|
|
{
|
|
/* Check tuner index is valid */
|
|
if (vt->index > 0)
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct v4l2_subdev_tuner_ops max2175_tuner_ops = {
|
|
.s_frequency = max2175_s_frequency,
|
|
.g_frequency = max2175_g_frequency,
|
|
.enum_freq_bands = max2175_enum_freq_bands,
|
|
.g_tuner = max2175_g_tuner,
|
|
.s_tuner = max2175_s_tuner,
|
|
};
|
|
|
|
static const struct v4l2_subdev_ops max2175_ops = {
|
|
.tuner = &max2175_tuner_ops,
|
|
};
|
|
|
|
static const struct v4l2_ctrl_ops max2175_ctrl_ops = {
|
|
.s_ctrl = max2175_s_ctrl,
|
|
.g_volatile_ctrl = max2175_g_volatile_ctrl,
|
|
};
|
|
|
|
/*
|
|
* I2S output enable/disable configuration. This is a private control.
|
|
* Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
|
|
*/
|
|
static const struct v4l2_ctrl_config max2175_i2s_en = {
|
|
.ops = &max2175_ctrl_ops,
|
|
.id = V4L2_CID_MAX2175_I2S_ENABLE,
|
|
.name = "I2S Enable",
|
|
.type = V4L2_CTRL_TYPE_BOOLEAN,
|
|
.min = 0,
|
|
.max = 1,
|
|
.step = 1,
|
|
.def = 1,
|
|
.is_private = 1,
|
|
};
|
|
|
|
/*
|
|
* HSLS value control LO freq adjacent location configuration.
|
|
* Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
|
|
*/
|
|
static const struct v4l2_ctrl_config max2175_hsls = {
|
|
.ops = &max2175_ctrl_ops,
|
|
.id = V4L2_CID_MAX2175_HSLS,
|
|
.name = "HSLS Above/Below Desired",
|
|
.type = V4L2_CTRL_TYPE_BOOLEAN,
|
|
.min = 0,
|
|
.max = 1,
|
|
.step = 1,
|
|
.def = 1,
|
|
};
|
|
|
|
/*
|
|
* Rx modes below are a set of preset configurations that decides the tuner's
|
|
* sck and sample rate of transmission. They are separate for EU & NA regions.
|
|
* Refer to Documentation/userspace-api/media/drivers/max2175.rst for more details.
|
|
*/
|
|
static const char * const max2175_ctrl_eu_rx_modes[] = {
|
|
[MAX2175_EU_FM_1_2] = "EU FM 1.2",
|
|
[MAX2175_DAB_1_2] = "DAB 1.2",
|
|
};
|
|
|
|
static const char * const max2175_ctrl_na_rx_modes[] = {
|
|
[MAX2175_NA_FM_1_0] = "NA FM 1.0",
|
|
[MAX2175_NA_FM_2_0] = "NA FM 2.0",
|
|
};
|
|
|
|
static const struct v4l2_ctrl_config max2175_eu_rx_mode = {
|
|
.ops = &max2175_ctrl_ops,
|
|
.id = V4L2_CID_MAX2175_RX_MODE,
|
|
.name = "RX Mode",
|
|
.type = V4L2_CTRL_TYPE_MENU,
|
|
.max = ARRAY_SIZE(max2175_ctrl_eu_rx_modes) - 1,
|
|
.def = 0,
|
|
.qmenu = max2175_ctrl_eu_rx_modes,
|
|
};
|
|
|
|
static const struct v4l2_ctrl_config max2175_na_rx_mode = {
|
|
.ops = &max2175_ctrl_ops,
|
|
.id = V4L2_CID_MAX2175_RX_MODE,
|
|
.name = "RX Mode",
|
|
.type = V4L2_CTRL_TYPE_MENU,
|
|
.max = ARRAY_SIZE(max2175_ctrl_na_rx_modes) - 1,
|
|
.def = 0,
|
|
.qmenu = max2175_ctrl_na_rx_modes,
|
|
};
|
|
|
|
static int max2175_refout_load_to_bits(struct i2c_client *client, u32 load,
|
|
u32 *bits)
|
|
{
|
|
if (load <= 40)
|
|
*bits = load / 10;
|
|
else if (load >= 60 && load <= 70)
|
|
*bits = load / 10 - 1;
|
|
else
|
|
return -EINVAL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int max2175_probe(struct i2c_client *client)
|
|
{
|
|
bool master = true, am_hiz = false;
|
|
u32 refout_load, refout_bits = 0; /* REFOUT disabled */
|
|
struct v4l2_ctrl_handler *hdl;
|
|
struct fwnode_handle *fwnode;
|
|
struct device_node *np;
|
|
struct v4l2_subdev *sd;
|
|
struct regmap *regmap;
|
|
struct max2175 *ctx;
|
|
struct clk *clk;
|
|
int ret;
|
|
|
|
/* Parse DT properties */
|
|
np = of_parse_phandle(client->dev.of_node, "maxim,master", 0);
|
|
if (np) {
|
|
master = false; /* Slave tuner */
|
|
of_node_put(np);
|
|
}
|
|
|
|
fwnode = of_fwnode_handle(client->dev.of_node);
|
|
if (fwnode_property_present(fwnode, "maxim,am-hiz-filter"))
|
|
am_hiz = true;
|
|
|
|
if (!fwnode_property_read_u32(fwnode, "maxim,refout-load",
|
|
&refout_load)) {
|
|
ret = max2175_refout_load_to_bits(client, refout_load,
|
|
&refout_bits);
|
|
if (ret) {
|
|
dev_err(&client->dev, "invalid refout_load %u\n",
|
|
refout_load);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
clk = devm_clk_get(&client->dev, NULL);
|
|
if (IS_ERR(clk)) {
|
|
ret = PTR_ERR(clk);
|
|
dev_err(&client->dev, "cannot get clock %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
regmap = devm_regmap_init_i2c(client, &max2175_regmap_config);
|
|
if (IS_ERR(regmap)) {
|
|
ret = PTR_ERR(regmap);
|
|
dev_err(&client->dev, "regmap init failed %d\n", ret);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* Alloc tuner context */
|
|
ctx = devm_kzalloc(&client->dev, sizeof(*ctx), GFP_KERNEL);
|
|
if (ctx == NULL)
|
|
return -ENOMEM;
|
|
|
|
sd = &ctx->sd;
|
|
ctx->master = master;
|
|
ctx->am_hiz = am_hiz;
|
|
ctx->mode_resolved = false;
|
|
ctx->regmap = regmap;
|
|
ctx->xtal_freq = clk_get_rate(clk);
|
|
dev_info(&client->dev, "xtal freq %luHz\n", ctx->xtal_freq);
|
|
|
|
v4l2_i2c_subdev_init(sd, client, &max2175_ops);
|
|
ctx->client = client;
|
|
|
|
sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
|
|
|
|
/* Controls */
|
|
hdl = &ctx->ctrl_hdl;
|
|
ret = v4l2_ctrl_handler_init(hdl, 7);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ctx->lna_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
|
|
V4L2_CID_RF_TUNER_LNA_GAIN,
|
|
0, 63, 1, 0);
|
|
ctx->lna_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
|
|
V4L2_CTRL_FLAG_READ_ONLY);
|
|
ctx->if_gain = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
|
|
V4L2_CID_RF_TUNER_IF_GAIN,
|
|
0, 31, 1, 0);
|
|
ctx->if_gain->flags |= (V4L2_CTRL_FLAG_VOLATILE |
|
|
V4L2_CTRL_FLAG_READ_ONLY);
|
|
ctx->pll_lock = v4l2_ctrl_new_std(hdl, &max2175_ctrl_ops,
|
|
V4L2_CID_RF_TUNER_PLL_LOCK,
|
|
0, 1, 1, 0);
|
|
ctx->pll_lock->flags |= (V4L2_CTRL_FLAG_VOLATILE |
|
|
V4L2_CTRL_FLAG_READ_ONLY);
|
|
ctx->i2s_en = v4l2_ctrl_new_custom(hdl, &max2175_i2s_en, NULL);
|
|
ctx->hsls = v4l2_ctrl_new_custom(hdl, &max2175_hsls, NULL);
|
|
|
|
if (ctx->xtal_freq == MAX2175_EU_XTAL_FREQ) {
|
|
ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
|
|
&max2175_eu_rx_mode, NULL);
|
|
ctx->rx_modes = eu_rx_modes;
|
|
ctx->bands_rf = &eu_bands_rf;
|
|
} else {
|
|
ctx->rx_mode = v4l2_ctrl_new_custom(hdl,
|
|
&max2175_na_rx_mode, NULL);
|
|
ctx->rx_modes = na_rx_modes;
|
|
ctx->bands_rf = &na_bands_rf;
|
|
}
|
|
ctx->sd.ctrl_handler = &ctx->ctrl_hdl;
|
|
|
|
/* Set the defaults */
|
|
ctx->freq = ctx->bands_rf->rangelow;
|
|
|
|
/* Register subdev */
|
|
ret = v4l2_async_register_subdev(sd);
|
|
if (ret) {
|
|
dev_err(&client->dev, "register subdev failed\n");
|
|
goto err_reg;
|
|
}
|
|
|
|
/* Initialize device */
|
|
ret = max2175_core_init(ctx, refout_bits);
|
|
if (ret)
|
|
goto err_init;
|
|
|
|
ret = v4l2_ctrl_handler_setup(hdl);
|
|
if (ret)
|
|
goto err_init;
|
|
|
|
return 0;
|
|
|
|
err_init:
|
|
v4l2_async_unregister_subdev(sd);
|
|
err_reg:
|
|
v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void max2175_remove(struct i2c_client *client)
|
|
{
|
|
struct v4l2_subdev *sd = i2c_get_clientdata(client);
|
|
struct max2175 *ctx = max2175_from_sd(sd);
|
|
|
|
v4l2_ctrl_handler_free(&ctx->ctrl_hdl);
|
|
v4l2_async_unregister_subdev(sd);
|
|
}
|
|
|
|
static const struct i2c_device_id max2175_id[] = {
|
|
{ DRIVER_NAME, 0},
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, max2175_id);
|
|
|
|
static const struct of_device_id max2175_of_ids[] = {
|
|
{ .compatible = "maxim,max2175", },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, max2175_of_ids);
|
|
|
|
static struct i2c_driver max2175_driver = {
|
|
.driver = {
|
|
.name = DRIVER_NAME,
|
|
.of_match_table = max2175_of_ids,
|
|
},
|
|
.probe_new = max2175_probe,
|
|
.remove = max2175_remove,
|
|
.id_table = max2175_id,
|
|
};
|
|
|
|
module_i2c_driver(max2175_driver);
|
|
|
|
MODULE_DESCRIPTION("Maxim MAX2175 RF to Bits tuner driver");
|
|
MODULE_LICENSE("GPL v2");
|
|
MODULE_AUTHOR("Ramesh Shanmugasundaram <ramesh.shanmugasundaram@bp.renesas.com>");
|