Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

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