tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1/*
2 * tef6862.c Philips TEF6862 Car Radio Enhanced Selectivity Tuner
3 * Copyright (c) 2009 Intel Corporation
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15#include <linux/module.h>
16#include <linux/init.h>
17#include <linux/errno.h>
18#include <linux/kernel.h>
19#include <linux/interrupt.h>
20#include <linux/i2c.h>
21#include <linux/slab.h>
22#include <media/v4l2-ioctl.h>
23#include <media/v4l2-device.h>
24
25#define DRIVER_NAME "tef6862"
26
27#define FREQ_MUL 16000
28
29#define TEF6862_LO_FREQ (875U * FREQ_MUL / 10)
30#define TEF6862_HI_FREQ (108U * FREQ_MUL)
31
32/* Write mode sub addresses */
33#define WM_SUB_BANDWIDTH 0x0
34#define WM_SUB_PLLM 0x1
35#define WM_SUB_PLLL 0x2
36#define WM_SUB_DAA 0x3
37#define WM_SUB_AGC 0x4
38#define WM_SUB_BAND 0x5
39#define WM_SUB_CONTROL 0x6
40#define WM_SUB_LEVEL 0x7
41#define WM_SUB_IFCF 0x8
42#define WM_SUB_IFCAP 0x9
43#define WM_SUB_ACD 0xA
44#define WM_SUB_TEST 0xF
45
46/* Different modes of the MSA register */
47#define MSA_MODE_BUFFER 0x0
48#define MSA_MODE_PRESET 0x1
49#define MSA_MODE_SEARCH 0x2
50#define MSA_MODE_AF_UPDATE 0x3
51#define MSA_MODE_JUMP 0x4
52#define MSA_MODE_CHECK 0x5
53#define MSA_MODE_LOAD 0x6
54#define MSA_MODE_END 0x7
55#define MSA_MODE_SHIFT 5
56
57struct tef6862_state {
58 struct v4l2_subdev sd;
59 unsigned long freq;
60};
61
62static inline struct tef6862_state *to_state(struct v4l2_subdev *sd)
63{
64 return container_of(sd, struct tef6862_state, sd);
65}
66
67static u16 tef6862_sigstr(struct i2c_client *client)
68{
69 u8 buf[4];
70 int err = i2c_master_recv(client, buf, sizeof(buf));
71 if (err == sizeof(buf))
72 return buf[3] << 8;
73 return 0;
74}
75
76static int tef6862_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *v)
77{
78 if (v->index > 0)
79 return -EINVAL;
80
81 /* only support FM for now */
82 strlcpy(v->name, "FM", sizeof(v->name));
83 v->type = V4L2_TUNER_RADIO;
84 v->rangelow = TEF6862_LO_FREQ;
85 v->rangehigh = TEF6862_HI_FREQ;
86 v->rxsubchans = V4L2_TUNER_SUB_MONO;
87 v->capability = V4L2_TUNER_CAP_LOW;
88 v->audmode = V4L2_TUNER_MODE_STEREO;
89 v->signal = tef6862_sigstr(v4l2_get_subdevdata(sd));
90
91 return 0;
92}
93
94static int tef6862_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *v)
95{
96 return v->index ? -EINVAL : 0;
97}
98
99static int tef6862_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *f)
100{
101 struct tef6862_state *state = to_state(sd);
102 struct i2c_client *client = v4l2_get_subdevdata(sd);
103 unsigned freq = f->frequency;
104 u16 pll;
105 u8 i2cmsg[3];
106 int err;
107
108 if (f->tuner != 0)
109 return -EINVAL;
110
111 freq = clamp(freq, TEF6862_LO_FREQ, TEF6862_HI_FREQ);
112 pll = 1964 + ((freq - TEF6862_LO_FREQ) * 20) / FREQ_MUL;
113 i2cmsg[0] = (MSA_MODE_PRESET << MSA_MODE_SHIFT) | WM_SUB_PLLM;
114 i2cmsg[1] = (pll >> 8) & 0xff;
115 i2cmsg[2] = pll & 0xff;
116
117 err = i2c_master_send(client, i2cmsg, sizeof(i2cmsg));
118 if (err != sizeof(i2cmsg))
119 return err < 0 ? err : -EIO;
120
121 state->freq = freq;
122 return 0;
123}
124
125static int tef6862_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
126{
127 struct tef6862_state *state = to_state(sd);
128
129 if (f->tuner != 0)
130 return -EINVAL;
131 f->type = V4L2_TUNER_RADIO;
132 f->frequency = state->freq;
133 return 0;
134}
135
136static const struct v4l2_subdev_tuner_ops tef6862_tuner_ops = {
137 .g_tuner = tef6862_g_tuner,
138 .s_tuner = tef6862_s_tuner,
139 .s_frequency = tef6862_s_frequency,
140 .g_frequency = tef6862_g_frequency,
141};
142
143static const struct v4l2_subdev_ops tef6862_ops = {
144 .tuner = &tef6862_tuner_ops,
145};
146
147/*
148 * Generic i2c probe
149 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
150 */
151
152static int tef6862_probe(struct i2c_client *client,
153 const struct i2c_device_id *id)
154{
155 struct tef6862_state *state;
156 struct v4l2_subdev *sd;
157
158 /* Check if the adapter supports the needed features */
159 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
160 return -EIO;
161
162 v4l_info(client, "chip found @ 0x%02x (%s)\n",
163 client->addr << 1, client->adapter->name);
164
165 state = kzalloc(sizeof(struct tef6862_state), GFP_KERNEL);
166 if (state == NULL)
167 return -ENOMEM;
168 state->freq = TEF6862_LO_FREQ;
169
170 sd = &state->sd;
171 v4l2_i2c_subdev_init(sd, client, &tef6862_ops);
172
173 return 0;
174}
175
176static int tef6862_remove(struct i2c_client *client)
177{
178 struct v4l2_subdev *sd = i2c_get_clientdata(client);
179
180 v4l2_device_unregister_subdev(sd);
181 kfree(to_state(sd));
182 return 0;
183}
184
185static const struct i2c_device_id tef6862_id[] = {
186 {DRIVER_NAME, 0},
187 {},
188};
189
190MODULE_DEVICE_TABLE(i2c, tef6862_id);
191
192static struct i2c_driver tef6862_driver = {
193 .driver = {
194 .name = DRIVER_NAME,
195 },
196 .probe = tef6862_probe,
197 .remove = tef6862_remove,
198 .id_table = tef6862_id,
199};
200
201module_i2c_driver(tef6862_driver);
202
203MODULE_DESCRIPTION("TEF6862 Car Radio Enhanced Selectivity Tuner");
204MODULE_AUTHOR("Mocean Laboratories");
205MODULE_LICENSE("GPL v2");