cregit-Linux how code gets into the kernel

Release 4.7 drivers/media/radio/saa7706h.c

Directory: drivers/media/radio
/*
 * saa7706.c Philips SAA7706H Car Radio DSP driver
 * Copyright (c) 2009 Intel Corporation
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/interrupt.h>
#include <linux/i2c.h>
#include <linux/slab.h>
#include <media/v4l2-device.h>
#include <media/v4l2-ctrls.h>


#define DRIVER_NAME "saa7706h"

/* the I2C memory map looks like this

        $1C00 - $FFFF Not Used
        $2200 - $3FFF Reserved YRAM (DSP2) space
        $2000 - $21FF YRAM (DSP2)
        $1FF0 - $1FFF Hardware Registers
        $1280 - $1FEF Reserved XRAM (DSP2) space
        $1000 - $127F XRAM (DSP2)
        $0FFF        DSP CONTROL
        $0A00 - $0FFE Reserved
        $0980 - $09FF Reserved YRAM (DSP1) space
        $0800 - $097F YRAM (DSP1)
        $0200 - $07FF Not Used
        $0180 - $01FF Reserved XRAM (DSP1) space
        $0000 - $017F XRAM (DSP1)
*/


#define SAA7706H_REG_CTRL		0x0fff

#define SAA7706H_CTRL_BYP_PLL		0x0001

#define SAA7706H_CTRL_PLL_DIV_MASK	0x003e

#define SAA7706H_CTRL_PLL3_62975MHZ	0x003e

#define SAA7706H_CTRL_DSP_TURBO		0x0040

#define SAA7706H_CTRL_PC_RESET_DSP1	0x0080

#define SAA7706H_CTRL_PC_RESET_DSP2	0x0100

#define SAA7706H_CTRL_DSP1_ROM_EN_MASK	0x0600

#define SAA7706H_CTRL_DSP1_FUNC_PROM	0x0000

#define SAA7706H_CTRL_DSP2_ROM_EN_MASK	0x1800

#define SAA7706H_CTRL_DSP2_FUNC_PROM	0x0000

#define SAA7706H_CTRL_DIG_SIL_INTERPOL	0x8000


#define SAA7706H_REG_EVALUATION			0x1ff0

#define SAA7706H_EVAL_DISABLE_CHARGE_PUMP	0x000001

#define SAA7706H_EVAL_DCS_CLOCK			0x000002

#define SAA7706H_EVAL_GNDRC1_ENABLE		0x000004

#define SAA7706H_EVAL_GNDRC2_ENABLE		0x000008


#define SAA7706H_REG_CL_GEN1			0x1ff3

#define SAA7706H_CL_GEN1_MIN_LOOPGAIN_MASK	0x00000f

#define SAA7706H_CL_GEN1_LOOPGAIN_MASK		0x0000f0

#define SAA7706H_CL_GEN1_COARSE_RATION		0xffff00


#define SAA7706H_REG_CL_GEN2			0x1ff4

#define SAA7706H_CL_GEN2_WSEDGE_FALLING		0x000001

#define SAA7706H_CL_GEN2_STOP_VCO		0x000002

#define SAA7706H_CL_GEN2_FRERUN			0x000004

#define SAA7706H_CL_GEN2_ADAPTIVE		0x000008

#define SAA7706H_CL_GEN2_FINE_RATIO_MASK	0x0ffff0


#define SAA7706H_REG_CL_GEN4		0x1ff6

#define SAA7706H_CL_GEN4_BYPASS_PLL1	0x001000

#define SAA7706H_CL_GEN4_PLL1_DIV_MASK	0x03e000

#define SAA7706H_CL_GEN4_DSP1_TURBO	0x040000


#define SAA7706H_REG_SEL	0x1ff7

#define SAA7706H_SEL_DSP2_SRCA_MASK	0x000007

#define SAA7706H_SEL_DSP2_FMTA_MASK	0x000031

#define SAA7706H_SEL_DSP2_SRCB_MASK	0x0001c0

#define SAA7706H_SEL_DSP2_FMTB_MASK	0x000e00

#define SAA7706H_SEL_DSP1_SRC_MASK	0x003000

#define SAA7706H_SEL_DSP1_FMT_MASK	0x01c003

#define SAA7706H_SEL_SPDIF2		0x020000

#define SAA7706H_SEL_HOST_IO_FMT_MASK	0x1c0000

#define SAA7706H_SEL_EN_HOST_IO		0x200000


#define SAA7706H_REG_IAC		0x1ff8

#define SAA7706H_REG_CLK_SET		0x1ff9

#define SAA7706H_REG_CLK_COEFF		0x1ffa

#define SAA7706H_REG_INPUT_SENS		0x1ffb

#define SAA7706H_INPUT_SENS_RDS_VOL_MASK	0x0003f

#define SAA7706H_INPUT_SENS_FM_VOL_MASK		0x00fc0

#define SAA7706H_INPUT_SENS_FM_MPX		0x01000

#define SAA7706H_INPUT_SENS_OFF_FILTER_A_EN	0x02000

#define SAA7706H_INPUT_SENS_OFF_FILTER_B_EN	0x04000

#define SAA7706H_REG_PHONE_NAV_AUDIO	0x1ffc

#define SAA7706H_REG_IO_CONF_DSP2	0x1ffd

#define SAA7706H_REG_STATUS_DSP2	0x1ffe

#define SAA7706H_REG_PC_DSP2		0x1fff


#define SAA7706H_DSP1_MOD0	0x0800

#define SAA7706H_DSP1_ROM_VER	0x097f

#define SAA7706H_DSP2_MPTR0	0x1000


#define SAA7706H_DSP1_MODPNTR	0x0000


#define SAA7706H_DSP2_XMEM_CONTLLCW	0x113e

#define SAA7706H_DSP2_XMEM_BUSAMP	0x114a

#define SAA7706H_DSP2_XMEM_FDACPNTR	0x11f9

#define SAA7706H_DSP2_XMEM_IIS1PNTR	0x11fb


#define SAA7706H_DSP2_YMEM_PVGA		0x212a

#define SAA7706H_DSP2_YMEM_PVAT1	0x212b

#define SAA7706H_DSP2_YMEM_PVAT		0x212c

#define SAA7706H_DSP2_YMEM_ROM_VER	0x21ff


#define SUPPORTED_DSP1_ROM_VER		0x667


struct saa7706h_state {
	
struct v4l2_subdev sd;
	
struct v4l2_ctrl_handler hdl;
	
unsigned muted;
};




static inline struct saa7706h_state *to_state(struct v4l2_subdev *sd)
{
	return container_of(sd, struct saa7706h_state, sd);
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors25100.00%1100.00%


Total25100.00%1100.00%






static int saa7706h_i2c_send(struct i2c_client *client, const u8 *data, int len)
{
	int err = i2c_master_send(client, data, len);
	if (err == len)
		return 0;
	return err > 0 ? -EIO : err;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors50100.00%1100.00%


Total50100.00%1100.00%






static int saa7706h_i2c_transfer(struct i2c_client *client,
	struct i2c_msg *msgs, int num)
{
	int err = i2c_transfer(client->adapter, msgs, num);
	if (err == num)
		return 0;
	return err > 0 ? -EIO : err;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors52100.00%1100.00%


Total52100.00%1100.00%






static int saa7706h_set_reg24(struct v4l2_subdev *sd, u16 reg, u32 val)
{
	struct i2c_client *client = v4l2_get_subdevdata(sd);
	u8 buf[5];
	int pos = 0;

	buf[pos++] = reg >> 8;
	buf[pos++] = reg;
	buf[pos++] = val >> 16;
	buf[pos++] = val >> 8;
	buf[pos++] = val;

	return saa7706h_i2c_send(client, buf, pos);
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors94100.00%1100.00%


Total94100.00%1100.00%






static int saa7706h_set_reg24_err(struct v4l2_subdev *sd, u16 reg, u32 val,
	int *err)
{
	return *err ? *err : saa7706h_set_reg24(sd, reg, val);
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors37100.00%1100.00%


Total37100.00%1100.00%






static int saa7706h_set_reg16(struct v4l2_subdev *sd, u16 reg, u16 val)
{
	struct i2c_client *client = v4l2_get_subdevdata(sd);
	u8 buf[4];
	int pos = 0;

	buf[pos++] = reg >> 8;
	buf[pos++] = reg;
	buf[pos++] = val >> 8;
	buf[pos++] = val;

	return saa7706h_i2c_send(client, buf, pos);
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors84100.00%1100.00%


Total84100.00%1100.00%






static int saa7706h_set_reg16_err(struct v4l2_subdev *sd, u16 reg, u16 val,
	int *err)
{
	return *err ? *err : saa7706h_set_reg16(sd, reg, val);
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors37100.00%1100.00%


Total37100.00%1100.00%






static int saa7706h_get_reg16(struct v4l2_subdev *sd, u16 reg)
{
	struct i2c_client *client = v4l2_get_subdevdata(sd);
	u8 buf[2];
	int err;
	u8 regaddr[] = {reg >> 8, reg};
	struct i2c_msg msg[] = {
					{
						.addr = client->addr,
						.len = sizeof(regaddr),
						.buf = regaddr
					},
					{
						.addr = client->addr,
						.flags = I2C_M_RD,
						.len = sizeof(buf),
						.buf = buf
					}
				};

	err = saa7706h_i2c_transfer(client, msg, ARRAY_SIZE(msg));
	if (err)
		return err;

	return buf[0] << 8 | buf[1];
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors11484.44%150.00%


shubhrajyoti dattashubhrajyoti datta2115.56%150.00%


Total135100.00%2100.00%






static int saa7706h_unmute(struct v4l2_subdev *sd)
{
	struct saa7706h_state *state = to_state(sd);
	int err = 0;

	err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL,
		SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 |
		SAA7706H_CTRL_PC_RESET_DSP2, &err);

	/* newer versions of the chip requires a small sleep after reset */
	msleep(1);

	err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL,
		SAA7706H_CTRL_PLL3_62975MHZ, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_EVALUATION, 0, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN1, 0x040022, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN2,
		SAA7706H_CL_GEN2_WSEDGE_FALLING, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN4, 0x024080, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_SEL, 0x200080, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IAC, 0xf4caed, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_SET, 0x124334, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_COEFF, 0x004a1a,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_INPUT_SENS, 0x0071c7,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PHONE_NAV_AUDIO,
		0x0e22ff, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IO_CONF_DSP2, 0x001ff8,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_STATUS_DSP2, 0x080003,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PC_DSP2, 0x000004, &err);

	err = saa7706h_set_reg16_err(sd, SAA7706H_DSP1_MOD0, 0x0c6c, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_MPTR0, 0x000b4b, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x000600, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x0000c0, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000819,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x00085a,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_BUSAMP, 0x7fffff,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_FDACPNTR, 0x2000cb,
		&err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_IIS1PNTR, 0x2000cb,
		&err);

	err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVGA, 0x0f80, &err);

	err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT1, 0x0800,
		&err);

	err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT, 0x0800, &err);

	err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000905,
		&err);
	if (!err)
		state->muted = 0;
	return err;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors442100.00%1100.00%


Total442100.00%1100.00%






static int saa7706h_mute(struct v4l2_subdev *sd)
{
	struct saa7706h_state *state = to_state(sd);
	int err;

	err = saa7706h_set_reg16(sd, SAA7706H_REG_CTRL,
		SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 |
		SAA7706H_CTRL_PC_RESET_DSP2);
	if (!err)
		state->muted = 1;
	return err;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors53100.00%1100.00%


Total53100.00%1100.00%






static int saa7706h_s_ctrl(struct v4l2_ctrl *ctrl)
{
	struct saa7706h_state *state =
		container_of(ctrl->handler, struct saa7706h_state, hdl);

	switch (ctrl->id) {
	case V4L2_CID_AUDIO_MUTE:
		if (ctrl->val)
			return saa7706h_mute(&state->sd);
		return saa7706h_unmute(&state->sd);
	}
	return -EINVAL;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors4973.13%150.00%


hans verkuilhans verkuil1826.87%150.00%


Total67100.00%2100.00%




static const struct v4l2_ctrl_ops saa7706h_ctrl_ops = {
	.s_ctrl = saa7706h_s_ctrl,
};


static const struct v4l2_subdev_ops empty_ops = {};

/*
 * Generic i2c probe
 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
 */




static int saa7706h_probe(struct i2c_client *client,
			  const struct i2c_device_id *id)
{
	struct saa7706h_state *state;
	struct v4l2_subdev *sd;
	int err;

	/* Check if the adapter supports the needed features */
	if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
		return -EIO;

	v4l_info(client, "chip found @ 0x%02x (%s)\n",
			client->addr << 1, client->adapter->name);

	state = kzalloc(sizeof(struct saa7706h_state), GFP_KERNEL);
	if (state == NULL)
		return -ENOMEM;
	sd = &state->sd;
	v4l2_i2c_subdev_init(sd, client, &empty_ops);

	v4l2_ctrl_handler_init(&state->hdl, 4);
	v4l2_ctrl_new_std(&state->hdl, &saa7706h_ctrl_ops,
			V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1);
	sd->ctrl_handler = &state->hdl;
	err = state->hdl.error;
	if (err)
		goto err;

	/* check the rom versions */
	err = saa7706h_get_reg16(sd, SAA7706H_DSP1_ROM_VER);
	if (err < 0)
		goto err;
	if (err != SUPPORTED_DSP1_ROM_VER)
		v4l2_warn(sd, "Unknown DSP1 ROM code version: 0x%x\n", err);
	state->muted = 1;

	/* startup in a muted state */
	err = saa7706h_mute(sd);
	if (err)
		goto err;

	return 0;

err:
	v4l2_device_unregister_subdev(sd);
	v4l2_ctrl_handler_free(&state->hdl);
	kfree(to_state(sd));

	printk(KERN_ERR DRIVER_NAME ": Failed to probe: %d\n", err);

	return err;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors18874.31%125.00%


hans verkuilhans verkuil6324.90%125.00%


ricardo ribaldaricardo ribalda10.40%125.00%


herton ronaldo krzesinskiherton ronaldo krzesinski10.40%125.00%


Total253100.00%4100.00%






static int saa7706h_remove(struct i2c_client *client)
{
	struct v4l2_subdev *sd = i2c_get_clientdata(client);
	struct saa7706h_state *state = to_state(sd);

	saa7706h_mute(sd);
	v4l2_device_unregister_subdev(sd);
	v4l2_ctrl_handler_free(&state->hdl);
	kfree(to_state(sd));
	return 0;
}


Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors4270.00%150.00%


hans verkuilhans verkuil1830.00%150.00%


Total60100.00%2100.00%




static const struct i2c_device_id saa7706h_id[] = {
	{DRIVER_NAME, 0},
	{},
};

MODULE_DEVICE_TABLE(i2c, saa7706h_id);


static struct i2c_driver saa7706h_driver = {
	.driver = {
		.name	= DRIVER_NAME,
        },
	.probe		= saa7706h_probe,
	.remove		= saa7706h_remove,
	.id_table	= saa7706h_id,
};


module_i2c_driver(saa7706h_driver);

MODULE_DESCRIPTION("SAA7706H Car Radio DSP driver");
MODULE_AUTHOR("Mocean Laboratories");
MODULE_LICENSE("GPL v2");

Overall Contributors
PersonTokensPropCommitsCommitProp
richard rojforsrichard rojfors165891.75%114.29%


hans verkuilhans verkuil1196.59%114.29%


shubhrajyoti dattashubhrajyoti datta211.16%114.29%


ricardo ribaldaricardo ribalda30.17%114.29%


tejun heotejun heo30.17%114.29%


axel linaxel lin20.11%114.29%


herton ronaldo krzesinskiherton ronaldo krzesinski10.06%114.29%


Total1807100.00%7100.00%

  
Directory: drivers/media/radio



Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
{% endraw %}