1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * drivers/media/radio/si4713-i2c.c
4  *
5  * Silicon Labs Si4713 FM Radio Transmitter I2C commands.
6  *
7  * Copyright (c) 2009 Nokia Corporation
8  * Contact: Eduardo Valentin <eduardo.valentin@nokia.com>
9  */
10 
11 #include <linux/completion.h>
12 #include <linux/delay.h>
13 #include <linux/err.h>
14 #include <linux/interrupt.h>
15 #include <linux/i2c.h>
16 #include <linux/slab.h>
17 #include <linux/gpio/consumer.h>
18 #include <linux/module.h>
19 #include <media/v4l2-device.h>
20 #include <media/v4l2-ioctl.h>
21 #include <media/v4l2-common.h>
22 
23 #include "si4713.h"
24 
25 /* module parameters */
26 static int debug;
27 module_param(debug, int, S_IRUGO | S_IWUSR);
28 MODULE_PARM_DESC(debug, "Debug level (0 - 2)");
29 
30 MODULE_LICENSE("GPL");
31 MODULE_AUTHOR("Eduardo Valentin <eduardo.valentin@nokia.com>");
32 MODULE_DESCRIPTION("I2C driver for Si4713 FM Radio Transmitter");
33 MODULE_VERSION("0.0.1");
34 
35 #define DEFAULT_RDS_PI			0x00
36 #define DEFAULT_RDS_PTY			0x00
37 #define DEFAULT_RDS_DEVIATION		0x00C8
38 #define DEFAULT_RDS_PS_REPEAT_COUNT	0x0003
39 #define DEFAULT_LIMITER_RTIME		0x1392
40 #define DEFAULT_LIMITER_DEV		0x102CA
41 #define DEFAULT_PILOT_FREQUENCY		0x4A38
42 #define DEFAULT_PILOT_DEVIATION		0x1A5E
43 #define DEFAULT_ACOMP_ATIME		0x0000
44 #define DEFAULT_ACOMP_RTIME		0xF4240L
45 #define DEFAULT_ACOMP_GAIN		0x0F
46 #define DEFAULT_ACOMP_THRESHOLD		(-0x28)
47 #define DEFAULT_MUTE			0x01
48 #define DEFAULT_POWER_LEVEL		88
49 #define DEFAULT_FREQUENCY		8800
50 #define DEFAULT_PREEMPHASIS		FMPE_EU
51 #define DEFAULT_TUNE_RNL		0xFF
52 
53 #define to_si4713_device(sd)	container_of(sd, struct si4713_device, sd)
54 
55 /* frequency domain transformation (using times 10 to avoid floats) */
56 #define FREQDEV_UNIT	100000
57 #define FREQV4L2_MULTI	625
58 #define si4713_to_v4l2(f)	((f * FREQDEV_UNIT) / FREQV4L2_MULTI)
59 #define v4l2_to_si4713(f)	((f * FREQV4L2_MULTI) / FREQDEV_UNIT)
60 #define FREQ_RANGE_LOW			7600
61 #define FREQ_RANGE_HIGH			10800
62 
63 #define MAX_ARGS 7
64 
65 #define RDS_BLOCK			8
66 #define RDS_BLOCK_CLEAR			0x03
67 #define RDS_BLOCK_LOAD			0x04
68 #define RDS_RADIOTEXT_2A		0x20
69 #define RDS_RADIOTEXT_BLK_SIZE		4
70 #define RDS_RADIOTEXT_INDEX_MAX		0x0F
71 #define RDS_CARRIAGE_RETURN		0x0D
72 
73 #define rds_ps_nblocks(len)	((len / RDS_BLOCK) + (len % RDS_BLOCK ? 1 : 0))
74 
75 #define get_status_bit(p, b, m)	(((p) & (m)) >> (b))
76 #define set_bits(p, v, b, m)	(((p) & ~(m)) | ((v) << (b)))
77 
78 #define ATTACK_TIME_UNIT	500
79 
80 #define POWER_OFF			0x00
81 #define POWER_ON			0x01
82 
83 #define msb(x)                  ((u8)((u16) x >> 8))
84 #define lsb(x)                  ((u8)((u16) x &  0x00FF))
85 #define compose_u16(msb, lsb)	(((u16)msb << 8) | lsb)
86 #define check_command_failed(status)	(!(status & SI4713_CTS) || \
87 					(status & SI4713_ERR))
88 /* mute definition */
89 #define set_mute(p)	(((p) & 1) | (((p) & 1) << 1))
90 
91 #ifdef DEBUG
92 #define DBG_BUFFER(device, message, buffer, size)			\
93 	{								\
94 		int i;							\
95 		char str[(size)*5];					\
96 		for (i = 0; i < size; i++)				\
97 			sprintf(str + i * 5, " 0x%02x", buffer[i]);	\
98 		v4l2_dbg(2, debug, device, "%s:%s\n", message, str);	\
99 	}
100 #else
101 #define DBG_BUFFER(device, message, buffer, size)
102 #endif
103 
104 /*
105  * Values for limiter release time (sorted by second column)
106  *	device	release
107  *	value	time (us)
108  */
109 static long limiter_times[] = {
110 	2000,	250,
111 	1000,	500,
112 	510,	1000,
113 	255,	2000,
114 	170,	3000,
115 	127,	4020,
116 	102,	5010,
117 	85,	6020,
118 	73,	7010,
119 	64,	7990,
120 	57,	8970,
121 	51,	10030,
122 	25,	20470,
123 	17,	30110,
124 	13,	39380,
125 	10,	51190,
126 	8,	63690,
127 	7,	73140,
128 	6,	85330,
129 	5,	102390,
130 };
131 
132 /*
133  * Values for audio compression release time (sorted by second column)
134  *	device	release
135  *	value	time (us)
136  */
137 static unsigned long acomp_rtimes[] = {
138 	0,	100000,
139 	1,	200000,
140 	2,	350000,
141 	3,	525000,
142 	4,	1000000,
143 };
144 
145 /*
146  * Values for preemphasis (sorted by second column)
147  *	device	preemphasis
148  *	value	value (v4l2)
149  */
150 static unsigned long preemphasis_values[] = {
151 	FMPE_DISABLED,	V4L2_PREEMPHASIS_DISABLED,
152 	FMPE_EU,	V4L2_PREEMPHASIS_50_uS,
153 	FMPE_USA,	V4L2_PREEMPHASIS_75_uS,
154 };
155 
156 static int usecs_to_dev(unsigned long usecs, unsigned long const array[],
157 			int size)
158 {
159 	int i;
160 	int rval = -EINVAL;
161 
162 	for (i = 0; i < size / 2; i++)
163 		if (array[(i * 2) + 1] >= usecs) {
164 			rval = array[i * 2];
165 			break;
166 		}
167 
168 	return rval;
169 }
170 
171 /* si4713_handler: IRQ handler, just complete work */
172 static irqreturn_t si4713_handler(int irq, void *dev)
173 {
174 	struct si4713_device *sdev = dev;
175 
176 	v4l2_dbg(2, debug, &sdev->sd,
177 			"%s: sending signal to completion work.\n", __func__);
178 	complete(&sdev->work);
179 
180 	return IRQ_HANDLED;
181 }
182 
183 /*
184  * si4713_send_command - sends a command to si4713 and waits its response
185  * @sdev: si4713_device structure for the device we are communicating
186  * @command: command id
187  * @args: command arguments we are sending (up to 7)
188  * @argn: actual size of @args
189  * @response: buffer to place the expected response from the device (up to 15)
190  * @respn: actual size of @response
191  * @usecs: amount of time to wait before reading the response (in usecs)
192  */
193 static int si4713_send_command(struct si4713_device *sdev, const u8 command,
194 				const u8 args[], const int argn,
195 				u8 response[], const int respn, const int usecs)
196 {
197 	struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd);
198 	unsigned long until_jiffies;
199 	u8 data1[MAX_ARGS + 1];
200 	int err;
201 
202 	if (!client->adapter)
203 		return -ENODEV;
204 
205 	/* First send the command and its arguments */
206 	data1[0] = command;
207 	memcpy(data1 + 1, args, argn);
208 	DBG_BUFFER(&sdev->sd, "Parameters", data1, argn + 1);
209 
210 	err = i2c_master_send(client, data1, argn + 1);
211 	if (err != argn + 1) {
212 		v4l2_err(&sdev->sd, "Error while sending command 0x%02x\n",
213 			command);
214 		return err < 0 ? err : -EIO;
215 	}
216 
217 	until_jiffies = jiffies + usecs_to_jiffies(usecs) + 1;
218 
219 	/* Wait response from interrupt */
220 	if (client->irq) {
221 		if (!wait_for_completion_timeout(&sdev->work,
222 				usecs_to_jiffies(usecs) + 1))
223 			v4l2_warn(&sdev->sd,
224 				"(%s) Device took too much time to answer.\n",
225 				__func__);
226 	}
227 
228 	do {
229 		err = i2c_master_recv(client, response, respn);
230 		if (err != respn) {
231 			v4l2_err(&sdev->sd,
232 				"Error %d while reading response for command 0x%02x\n",
233 				err, command);
234 			return err < 0 ? err : -EIO;
235 		}
236 
237 		DBG_BUFFER(&sdev->sd, "Response", response, respn);
238 		if (!check_command_failed(response[0]))
239 			return 0;
240 
241 		if (client->irq)
242 			return -EBUSY;
243 		if (usecs <= 1000)
244 			usleep_range(usecs, 1000);
245 		else
246 			usleep_range(1000, 2000);
247 	} while (time_is_after_jiffies(until_jiffies));
248 
249 	return -EBUSY;
250 }
251 
252 /*
253  * si4713_read_property - reads a si4713 property
254  * @sdev: si4713_device structure for the device we are communicating
255  * @prop: property identification number
256  * @pv: property value to be returned on success
257  */
258 static int si4713_read_property(struct si4713_device *sdev, u16 prop, u32 *pv)
259 {
260 	int err;
261 	u8 val[SI4713_GET_PROP_NRESP];
262 	/*
263 	 *	.First byte = 0
264 	 *	.Second byte = property's MSB
265 	 *	.Third byte = property's LSB
266 	 */
267 	const u8 args[SI4713_GET_PROP_NARGS] = {
268 		0x00,
269 		msb(prop),
270 		lsb(prop),
271 	};
272 
273 	err = si4713_send_command(sdev, SI4713_CMD_GET_PROPERTY,
274 				  args, ARRAY_SIZE(args), val,
275 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
276 
277 	if (err < 0)
278 		return err;
279 
280 	*pv = compose_u16(val[2], val[3]);
281 
282 	v4l2_dbg(1, debug, &sdev->sd,
283 			"%s: property=0x%02x value=0x%02x status=0x%02x\n",
284 			__func__, prop, *pv, val[0]);
285 
286 	return err;
287 }
288 
289 /*
290  * si4713_write_property - modifies a si4713 property
291  * @sdev: si4713_device structure for the device we are communicating
292  * @prop: property identification number
293  * @val: new value for that property
294  */
295 static int si4713_write_property(struct si4713_device *sdev, u16 prop, u16 val)
296 {
297 	int rval;
298 	u8 resp[SI4713_SET_PROP_NRESP];
299 	/*
300 	 *	.First byte = 0
301 	 *	.Second byte = property's MSB
302 	 *	.Third byte = property's LSB
303 	 *	.Fourth byte = value's MSB
304 	 *	.Fifth byte = value's LSB
305 	 */
306 	const u8 args[SI4713_SET_PROP_NARGS] = {
307 		0x00,
308 		msb(prop),
309 		lsb(prop),
310 		msb(val),
311 		lsb(val),
312 	};
313 
314 	rval = si4713_send_command(sdev, SI4713_CMD_SET_PROPERTY,
315 					args, ARRAY_SIZE(args),
316 					resp, ARRAY_SIZE(resp),
317 					DEFAULT_TIMEOUT);
318 
319 	if (rval < 0)
320 		return rval;
321 
322 	v4l2_dbg(1, debug, &sdev->sd,
323 			"%s: property=0x%02x value=0x%02x status=0x%02x\n",
324 			__func__, prop, val, resp[0]);
325 
326 	/*
327 	 * As there is no command response for SET_PROPERTY,
328 	 * wait Tcomp time to finish before proceed, in order
329 	 * to have property properly set.
330 	 */
331 	msleep(TIMEOUT_SET_PROPERTY);
332 
333 	return rval;
334 }
335 
336 /*
337  * si4713_powerup - Powers the device up
338  * @sdev: si4713_device structure for the device we are communicating
339  */
340 static int si4713_powerup(struct si4713_device *sdev)
341 {
342 	struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd);
343 	int err;
344 	u8 resp[SI4713_PWUP_NRESP];
345 	/*
346 	 *	.First byte = Enabled interrupts and boot function
347 	 *	.Second byte = Input operation mode
348 	 */
349 	u8 args[SI4713_PWUP_NARGS] = {
350 		SI4713_PWUP_GPO2OEN | SI4713_PWUP_FUNC_TX,
351 		SI4713_PWUP_OPMOD_ANALOG,
352 	};
353 
354 	if (sdev->power_state)
355 		return 0;
356 
357 	if (sdev->vdd) {
358 		err = regulator_enable(sdev->vdd);
359 		if (err) {
360 			v4l2_err(&sdev->sd, "Failed to enable vdd: %d\n", err);
361 			return err;
362 		}
363 	}
364 
365 	if (sdev->vio) {
366 		err = regulator_enable(sdev->vio);
367 		if (err) {
368 			v4l2_err(&sdev->sd, "Failed to enable vio: %d\n", err);
369 			return err;
370 		}
371 	}
372 
373 	if (sdev->gpio_reset) {
374 		udelay(50);
375 		gpiod_set_value(sdev->gpio_reset, 1);
376 	}
377 
378 	if (client->irq)
379 		args[0] |= SI4713_PWUP_CTSIEN;
380 
381 	err = si4713_send_command(sdev, SI4713_CMD_POWER_UP,
382 					args, ARRAY_SIZE(args),
383 					resp, ARRAY_SIZE(resp),
384 					TIMEOUT_POWER_UP);
385 
386 	if (!err) {
387 		v4l2_dbg(1, debug, &sdev->sd, "Powerup response: 0x%02x\n",
388 				resp[0]);
389 		v4l2_dbg(1, debug, &sdev->sd, "Device in power up mode\n");
390 		sdev->power_state = POWER_ON;
391 
392 		if (client->irq)
393 			err = si4713_write_property(sdev, SI4713_GPO_IEN,
394 						SI4713_STC_INT | SI4713_CTS);
395 		return err;
396 	}
397 	gpiod_set_value(sdev->gpio_reset, 0);
398 
399 
400 	if (sdev->vdd) {
401 		err = regulator_disable(sdev->vdd);
402 		if (err)
403 			v4l2_err(&sdev->sd, "Failed to disable vdd: %d\n", err);
404 	}
405 
406 	if (sdev->vio) {
407 		err = regulator_disable(sdev->vio);
408 		if (err)
409 			v4l2_err(&sdev->sd, "Failed to disable vio: %d\n", err);
410 	}
411 
412 	return err;
413 }
414 
415 /*
416  * si4713_powerdown - Powers the device down
417  * @sdev: si4713_device structure for the device we are communicating
418  */
419 static int si4713_powerdown(struct si4713_device *sdev)
420 {
421 	int err;
422 	u8 resp[SI4713_PWDN_NRESP];
423 
424 	if (!sdev->power_state)
425 		return 0;
426 
427 	err = si4713_send_command(sdev, SI4713_CMD_POWER_DOWN,
428 					NULL, 0,
429 					resp, ARRAY_SIZE(resp),
430 					DEFAULT_TIMEOUT);
431 
432 	if (!err) {
433 		v4l2_dbg(1, debug, &sdev->sd, "Power down response: 0x%02x\n",
434 				resp[0]);
435 		v4l2_dbg(1, debug, &sdev->sd, "Device in reset mode\n");
436 		if (sdev->gpio_reset)
437 			gpiod_set_value(sdev->gpio_reset, 0);
438 
439 		if (sdev->vdd) {
440 			err = regulator_disable(sdev->vdd);
441 			if (err) {
442 				v4l2_err(&sdev->sd,
443 					"Failed to disable vdd: %d\n", err);
444 			}
445 		}
446 
447 		if (sdev->vio) {
448 			err = regulator_disable(sdev->vio);
449 			if (err) {
450 				v4l2_err(&sdev->sd,
451 					"Failed to disable vio: %d\n", err);
452 			}
453 		}
454 		sdev->power_state = POWER_OFF;
455 	}
456 
457 	return err;
458 }
459 
460 /*
461  * si4713_checkrev - Checks if we are treating a device with the correct rev.
462  * @sdev: si4713_device structure for the device we are communicating
463  */
464 static int si4713_checkrev(struct si4713_device *sdev)
465 {
466 	struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd);
467 	int rval;
468 	u8 resp[SI4713_GETREV_NRESP];
469 
470 	rval = si4713_send_command(sdev, SI4713_CMD_GET_REV,
471 					NULL, 0,
472 					resp, ARRAY_SIZE(resp),
473 					DEFAULT_TIMEOUT);
474 
475 	if (rval < 0)
476 		return rval;
477 
478 	if (resp[1] == SI4713_PRODUCT_NUMBER) {
479 		v4l2_info(&sdev->sd, "chip found @ 0x%02x (%s)\n",
480 				client->addr << 1, client->adapter->name);
481 	} else {
482 		v4l2_err(&sdev->sd, "Invalid product number 0x%X\n", resp[1]);
483 		rval = -EINVAL;
484 	}
485 	return rval;
486 }
487 
488 /*
489  * si4713_wait_stc - Waits STC interrupt and clears status bits. Useful
490  *		     for TX_TUNE_POWER, TX_TUNE_FREQ and TX_TUNE_MEAS
491  * @sdev: si4713_device structure for the device we are communicating
492  * @usecs: timeout to wait for STC interrupt signal
493  */
494 static int si4713_wait_stc(struct si4713_device *sdev, const int usecs)
495 {
496 	struct i2c_client *client = v4l2_get_subdevdata(&sdev->sd);
497 	u8 resp[SI4713_GET_STATUS_NRESP];
498 	unsigned long start_jiffies = jiffies;
499 	int err;
500 
501 	if (client->irq &&
502 	    !wait_for_completion_timeout(&sdev->work, usecs_to_jiffies(usecs) + 1))
503 		v4l2_warn(&sdev->sd,
504 			"(%s) Device took too much time to answer.\n", __func__);
505 
506 	for (;;) {
507 		/* Clear status bits */
508 		err = si4713_send_command(sdev, SI4713_CMD_GET_INT_STATUS,
509 				NULL, 0,
510 				resp, ARRAY_SIZE(resp),
511 				DEFAULT_TIMEOUT);
512 		/* The USB device returns errors when it waits for the
513 		 * STC bit to be set. Hence polling */
514 		if (err >= 0) {
515 			v4l2_dbg(1, debug, &sdev->sd,
516 				"%s: status bits: 0x%02x\n", __func__, resp[0]);
517 
518 			if (resp[0] & SI4713_STC_INT)
519 				return 0;
520 		}
521 		if (jiffies_to_usecs(jiffies - start_jiffies) > usecs)
522 			return err < 0 ? err : -EIO;
523 		/* We sleep here for 3-4 ms in order to avoid flooding the device
524 		 * with USB requests. The si4713 USB driver was developed
525 		 * by reverse engineering the Windows USB driver. The windows
526 		 * driver also has a ~2.5 ms delay between responses. */
527 		usleep_range(3000, 4000);
528 	}
529 }
530 
531 /*
532  * si4713_tx_tune_freq - Sets the state of the RF carrier and sets the tuning
533  *			frequency between 76 and 108 MHz in 10 kHz units and
534  *			steps of 50 kHz.
535  * @sdev: si4713_device structure for the device we are communicating
536  * @frequency: desired frequency (76 - 108 MHz, unit 10 KHz, step 50 kHz)
537  */
538 static int si4713_tx_tune_freq(struct si4713_device *sdev, u16 frequency)
539 {
540 	int err;
541 	u8 val[SI4713_TXFREQ_NRESP];
542 	/*
543 	 *	.First byte = 0
544 	 *	.Second byte = frequency's MSB
545 	 *	.Third byte = frequency's LSB
546 	 */
547 	const u8 args[SI4713_TXFREQ_NARGS] = {
548 		0x00,
549 		msb(frequency),
550 		lsb(frequency),
551 	};
552 
553 	err = si4713_send_command(sdev, SI4713_CMD_TX_TUNE_FREQ,
554 				  args, ARRAY_SIZE(args), val,
555 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
556 
557 	if (err < 0)
558 		return err;
559 
560 	v4l2_dbg(1, debug, &sdev->sd,
561 			"%s: frequency=0x%02x status=0x%02x\n", __func__,
562 			frequency, val[0]);
563 
564 	err = si4713_wait_stc(sdev, TIMEOUT_TX_TUNE);
565 	if (err < 0)
566 		return err;
567 
568 	return compose_u16(args[1], args[2]);
569 }
570 
571 /*
572  * si4713_tx_tune_power - Sets the RF voltage level between 88 and 120 dBuV in
573  *			1 dB units. A value of 0x00 indicates off. The command
574  *			also sets the antenna tuning capacitance. A value of 0
575  *			indicates autotuning, and a value of 1 - 191 indicates
576  *			a manual override, which results in a tuning
577  *			capacitance of 0.25 pF x @antcap.
578  * @sdev: si4713_device structure for the device we are communicating
579  * @power: tuning power (88 - 120 dBuV, unit/step 1 dB)
580  * @antcap: value of antenna tuning capacitor (0 - 191)
581  */
582 static int si4713_tx_tune_power(struct si4713_device *sdev, u8 power,
583 				u8 antcap)
584 {
585 	int err;
586 	u8 val[SI4713_TXPWR_NRESP];
587 	/*
588 	 *	.First byte = 0
589 	 *	.Second byte = 0
590 	 *	.Third byte = power
591 	 *	.Fourth byte = antcap
592 	 */
593 	u8 args[SI4713_TXPWR_NARGS] = {
594 		0x00,
595 		0x00,
596 		power,
597 		antcap,
598 	};
599 
600 	/* Map power values 1-87 to MIN_POWER (88) */
601 	if (power > 0 && power < SI4713_MIN_POWER)
602 		args[2] = power = SI4713_MIN_POWER;
603 
604 	err = si4713_send_command(sdev, SI4713_CMD_TX_TUNE_POWER,
605 				  args, ARRAY_SIZE(args), val,
606 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
607 
608 	if (err < 0)
609 		return err;
610 
611 	v4l2_dbg(1, debug, &sdev->sd,
612 			"%s: power=0x%02x antcap=0x%02x status=0x%02x\n",
613 			__func__, power, antcap, val[0]);
614 
615 	return si4713_wait_stc(sdev, TIMEOUT_TX_TUNE_POWER);
616 }
617 
618 /*
619  * si4713_tx_tune_measure - Enters receive mode and measures the received noise
620  *			level in units of dBuV on the selected frequency.
621  *			The Frequency must be between 76 and 108 MHz in 10 kHz
622  *			units and steps of 50 kHz. The command also sets the
623  *			antenna	tuning capacitance. A value of 0 means
624  *			autotuning, and a value of 1 to 191 indicates manual
625  *			override.
626  * @sdev: si4713_device structure for the device we are communicating
627  * @frequency: desired frequency (76 - 108 MHz, unit 10 KHz, step 50 kHz)
628  * @antcap: value of antenna tuning capacitor (0 - 191)
629  */
630 static int si4713_tx_tune_measure(struct si4713_device *sdev, u16 frequency,
631 					u8 antcap)
632 {
633 	int err;
634 	u8 val[SI4713_TXMEA_NRESP];
635 	/*
636 	 *	.First byte = 0
637 	 *	.Second byte = frequency's MSB
638 	 *	.Third byte = frequency's LSB
639 	 *	.Fourth byte = antcap
640 	 */
641 	const u8 args[SI4713_TXMEA_NARGS] = {
642 		0x00,
643 		msb(frequency),
644 		lsb(frequency),
645 		antcap,
646 	};
647 
648 	sdev->tune_rnl = DEFAULT_TUNE_RNL;
649 
650 	if (antcap > SI4713_MAX_ANTCAP)
651 		return -EDOM;
652 
653 	err = si4713_send_command(sdev, SI4713_CMD_TX_TUNE_MEASURE,
654 				  args, ARRAY_SIZE(args), val,
655 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
656 
657 	if (err < 0)
658 		return err;
659 
660 	v4l2_dbg(1, debug, &sdev->sd,
661 			"%s: frequency=0x%02x antcap=0x%02x status=0x%02x\n",
662 			__func__, frequency, antcap, val[0]);
663 
664 	return si4713_wait_stc(sdev, TIMEOUT_TX_TUNE);
665 }
666 
667 /*
668  * si4713_tx_tune_status- Returns the status of the tx_tune_freq, tx_tune_mea or
669  *			tx_tune_power commands. This command return the current
670  *			frequency, output voltage in dBuV, the antenna tunning
671  *			capacitance value and the received noise level. The
672  *			command also clears the stcint interrupt bit when the
673  *			first bit of its arguments is high.
674  * @sdev: si4713_device structure for the device we are communicating
675  * @intack: 0x01 to clear the seek/tune complete interrupt status indicator.
676  * @frequency: returned frequency
677  * @power: returned power
678  * @antcap: returned antenna capacitance
679  * @noise: returned noise level
680  */
681 static int si4713_tx_tune_status(struct si4713_device *sdev, u8 intack,
682 					u16 *frequency,	u8 *power,
683 					u8 *antcap, u8 *noise)
684 {
685 	int err;
686 	u8 val[SI4713_TXSTATUS_NRESP];
687 	/*
688 	 *	.First byte = intack bit
689 	 */
690 	const u8 args[SI4713_TXSTATUS_NARGS] = {
691 		intack & SI4713_INTACK_MASK,
692 	};
693 
694 	err = si4713_send_command(sdev, SI4713_CMD_TX_TUNE_STATUS,
695 				  args, ARRAY_SIZE(args), val,
696 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
697 
698 	if (!err) {
699 		v4l2_dbg(1, debug, &sdev->sd,
700 			"%s: status=0x%02x\n", __func__, val[0]);
701 		*frequency = compose_u16(val[2], val[3]);
702 		sdev->frequency = *frequency;
703 		*power = val[5];
704 		*antcap = val[6];
705 		*noise = val[7];
706 		v4l2_dbg(1, debug, &sdev->sd,
707 			 "%s: response: %d x 10 kHz (power %d, antcap %d, rnl %d)\n",
708 			 __func__, *frequency, *power, *antcap, *noise);
709 	}
710 
711 	return err;
712 }
713 
714 /*
715  * si4713_tx_rds_buff - Loads the RDS group buffer FIFO or circular buffer.
716  * @sdev: si4713_device structure for the device we are communicating
717  * @mode: the buffer operation mode.
718  * @rdsb: RDS Block B
719  * @rdsc: RDS Block C
720  * @rdsd: RDS Block D
721  * @cbleft: returns the number of available circular buffer blocks minus the
722  *          number of used circular buffer blocks.
723  */
724 static int si4713_tx_rds_buff(struct si4713_device *sdev, u8 mode, u16 rdsb,
725 				u16 rdsc, u16 rdsd, s8 *cbleft)
726 {
727 	int err;
728 	u8 val[SI4713_RDSBUFF_NRESP];
729 
730 	const u8 args[SI4713_RDSBUFF_NARGS] = {
731 		mode & SI4713_RDSBUFF_MODE_MASK,
732 		msb(rdsb),
733 		lsb(rdsb),
734 		msb(rdsc),
735 		lsb(rdsc),
736 		msb(rdsd),
737 		lsb(rdsd),
738 	};
739 
740 	err = si4713_send_command(sdev, SI4713_CMD_TX_RDS_BUFF,
741 				  args, ARRAY_SIZE(args), val,
742 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
743 
744 	if (!err) {
745 		v4l2_dbg(1, debug, &sdev->sd,
746 			"%s: status=0x%02x\n", __func__, val[0]);
747 		*cbleft = (s8)val[2] - val[3];
748 		v4l2_dbg(1, debug, &sdev->sd,
749 			 "%s: response: interrupts 0x%02x cb avail: %d cb used %d fifo avail %d fifo used %d\n",
750 			 __func__, val[1], val[2], val[3], val[4], val[5]);
751 	}
752 
753 	return err;
754 }
755 
756 /*
757  * si4713_tx_rds_ps - Loads the program service buffer.
758  * @sdev: si4713_device structure for the device we are communicating
759  * @psid: program service id to be loaded.
760  * @pschar: assumed 4 size char array to be loaded into the program service
761  */
762 static int si4713_tx_rds_ps(struct si4713_device *sdev, u8 psid,
763 				unsigned char *pschar)
764 {
765 	int err;
766 	u8 val[SI4713_RDSPS_NRESP];
767 
768 	const u8 args[SI4713_RDSPS_NARGS] = {
769 		psid & SI4713_RDSPS_PSID_MASK,
770 		pschar[0],
771 		pschar[1],
772 		pschar[2],
773 		pschar[3],
774 	};
775 
776 	err = si4713_send_command(sdev, SI4713_CMD_TX_RDS_PS,
777 				  args, ARRAY_SIZE(args), val,
778 				  ARRAY_SIZE(val), DEFAULT_TIMEOUT);
779 
780 	if (err < 0)
781 		return err;
782 
783 	v4l2_dbg(1, debug, &sdev->sd, "%s: status=0x%02x\n", __func__, val[0]);
784 
785 	return err;
786 }
787 
788 static int si4713_set_power_state(struct si4713_device *sdev, u8 value)
789 {
790 	if (value)
791 		return si4713_powerup(sdev);
792 	return si4713_powerdown(sdev);
793 }
794 
795 static int si4713_set_mute(struct si4713_device *sdev, u16 mute)
796 {
797 	int rval = 0;
798 
799 	mute = set_mute(mute);
800 
801 	if (sdev->power_state)
802 		rval = si4713_write_property(sdev,
803 				SI4713_TX_LINE_INPUT_MUTE, mute);
804 
805 	return rval;
806 }
807 
808 static int si4713_set_rds_ps_name(struct si4713_device *sdev, char *ps_name)
809 {
810 	int rval = 0, i;
811 	u8 len = 0;
812 
813 	/* We want to clear the whole thing */
814 	if (!strlen(ps_name))
815 		memset(ps_name, 0, MAX_RDS_PS_NAME + 1);
816 
817 	if (sdev->power_state) {
818 		/* Write the new ps name and clear the padding */
819 		for (i = 0; i < MAX_RDS_PS_NAME; i += (RDS_BLOCK / 2)) {
820 			rval = si4713_tx_rds_ps(sdev, (i / (RDS_BLOCK / 2)),
821 						ps_name + i);
822 			if (rval < 0)
823 				return rval;
824 		}
825 
826 		/* Setup the size to be sent */
827 		if (strlen(ps_name))
828 			len = strlen(ps_name) - 1;
829 		else
830 			len = 1;
831 
832 		rval = si4713_write_property(sdev,
833 				SI4713_TX_RDS_PS_MESSAGE_COUNT,
834 				rds_ps_nblocks(len));
835 		if (rval < 0)
836 			return rval;
837 
838 		rval = si4713_write_property(sdev,
839 				SI4713_TX_RDS_PS_REPEAT_COUNT,
840 				DEFAULT_RDS_PS_REPEAT_COUNT * 2);
841 		if (rval < 0)
842 			return rval;
843 	}
844 
845 	return rval;
846 }
847 
848 static int si4713_set_rds_radio_text(struct si4713_device *sdev, const char *rt)
849 {
850 	static const char cr[RDS_RADIOTEXT_BLK_SIZE] = { RDS_CARRIAGE_RETURN, 0 };
851 	int rval = 0, i;
852 	u16 t_index = 0;
853 	u8 b_index = 0, cr_inserted = 0;
854 	s8 left;
855 
856 	if (!sdev->power_state)
857 		return rval;
858 
859 	rval = si4713_tx_rds_buff(sdev, RDS_BLOCK_CLEAR, 0, 0, 0, &left);
860 	if (rval < 0)
861 		return rval;
862 
863 	if (!strlen(rt))
864 		return rval;
865 
866 	do {
867 		/* RDS spec says that if the last block isn't used,
868 		 * then apply a carriage return
869 		 */
870 		if (t_index < (RDS_RADIOTEXT_INDEX_MAX * RDS_RADIOTEXT_BLK_SIZE)) {
871 			for (i = 0; i < RDS_RADIOTEXT_BLK_SIZE; i++) {
872 				if (!rt[t_index + i] ||
873 				    rt[t_index + i] == RDS_CARRIAGE_RETURN) {
874 					rt = cr;
875 					cr_inserted = 1;
876 					break;
877 				}
878 			}
879 		}
880 
881 		rval = si4713_tx_rds_buff(sdev, RDS_BLOCK_LOAD,
882 				compose_u16(RDS_RADIOTEXT_2A, b_index++),
883 				compose_u16(rt[t_index], rt[t_index + 1]),
884 				compose_u16(rt[t_index + 2], rt[t_index + 3]),
885 				&left);
886 		if (rval < 0)
887 			return rval;
888 
889 		t_index += RDS_RADIOTEXT_BLK_SIZE;
890 
891 		if (cr_inserted)
892 			break;
893 	} while (left > 0);
894 
895 	return rval;
896 }
897 
898 /*
899  * si4713_update_tune_status - update properties from tx_tune_status
900  * command. Must be called with sdev->mutex held.
901  * @sdev: si4713_device structure for the device we are communicating
902  */
903 static int si4713_update_tune_status(struct si4713_device *sdev)
904 {
905 	int rval;
906 	u16 f = 0;
907 	u8 p = 0, a = 0, n = 0;
908 
909 	rval = si4713_tx_tune_status(sdev, 0x00, &f, &p, &a, &n);
910 
911 	if (rval < 0)
912 		goto exit;
913 
914 /*	TODO: check that power_level and antenna_capacitor really are not
915 	changed by the hardware. If they are, then these controls should become
916 	volatiles.
917 	sdev->power_level = p;
918 	sdev->antenna_capacitor = a;*/
919 	sdev->tune_rnl = n;
920 
921 exit:
922 	return rval;
923 }
924 
925 static int si4713_choose_econtrol_action(struct si4713_device *sdev, u32 id,
926 		s32 *bit, s32 *mask, u16 *property, int *mul,
927 		unsigned long **table, int *size)
928 {
929 	s32 rval = 0;
930 
931 	switch (id) {
932 	/* FM_TX class controls */
933 	case V4L2_CID_RDS_TX_PI:
934 		*property = SI4713_TX_RDS_PI;
935 		*mul = 1;
936 		break;
937 	case V4L2_CID_AUDIO_COMPRESSION_THRESHOLD:
938 		*property = SI4713_TX_ACOMP_THRESHOLD;
939 		*mul = 1;
940 		break;
941 	case V4L2_CID_AUDIO_COMPRESSION_GAIN:
942 		*property = SI4713_TX_ACOMP_GAIN;
943 		*mul = 1;
944 		break;
945 	case V4L2_CID_PILOT_TONE_FREQUENCY:
946 		*property = SI4713_TX_PILOT_FREQUENCY;
947 		*mul = 1;
948 		break;
949 	case V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME:
950 		*property = SI4713_TX_ACOMP_ATTACK_TIME;
951 		*mul = ATTACK_TIME_UNIT;
952 		break;
953 	case V4L2_CID_PILOT_TONE_DEVIATION:
954 		*property = SI4713_TX_PILOT_DEVIATION;
955 		*mul = 10;
956 		break;
957 	case V4L2_CID_AUDIO_LIMITER_DEVIATION:
958 		*property = SI4713_TX_AUDIO_DEVIATION;
959 		*mul = 10;
960 		break;
961 	case V4L2_CID_RDS_TX_DEVIATION:
962 		*property = SI4713_TX_RDS_DEVIATION;
963 		*mul = 1;
964 		break;
965 
966 	case V4L2_CID_RDS_TX_PTY:
967 		*property = SI4713_TX_RDS_PS_MISC;
968 		*bit = 5;
969 		*mask = 0x1F << 5;
970 		break;
971 	case V4L2_CID_RDS_TX_DYNAMIC_PTY:
972 		*property = SI4713_TX_RDS_PS_MISC;
973 		*bit = 15;
974 		*mask = 1 << 15;
975 		break;
976 	case V4L2_CID_RDS_TX_COMPRESSED:
977 		*property = SI4713_TX_RDS_PS_MISC;
978 		*bit = 14;
979 		*mask = 1 << 14;
980 		break;
981 	case V4L2_CID_RDS_TX_ARTIFICIAL_HEAD:
982 		*property = SI4713_TX_RDS_PS_MISC;
983 		*bit = 13;
984 		*mask = 1 << 13;
985 		break;
986 	case V4L2_CID_RDS_TX_MONO_STEREO:
987 		*property = SI4713_TX_RDS_PS_MISC;
988 		*bit = 12;
989 		*mask = 1 << 12;
990 		break;
991 	case V4L2_CID_RDS_TX_TRAFFIC_PROGRAM:
992 		*property = SI4713_TX_RDS_PS_MISC;
993 		*bit = 10;
994 		*mask = 1 << 10;
995 		break;
996 	case V4L2_CID_RDS_TX_TRAFFIC_ANNOUNCEMENT:
997 		*property = SI4713_TX_RDS_PS_MISC;
998 		*bit = 4;
999 		*mask = 1 << 4;
1000 		break;
1001 	case V4L2_CID_RDS_TX_MUSIC_SPEECH:
1002 		*property = SI4713_TX_RDS_PS_MISC;
1003 		*bit = 3;
1004 		*mask = 1 << 3;
1005 		break;
1006 	case V4L2_CID_AUDIO_LIMITER_ENABLED:
1007 		*property = SI4713_TX_ACOMP_ENABLE;
1008 		*bit = 1;
1009 		*mask = 1 << 1;
1010 		break;
1011 	case V4L2_CID_AUDIO_COMPRESSION_ENABLED:
1012 		*property = SI4713_TX_ACOMP_ENABLE;
1013 		*bit = 0;
1014 		*mask = 1 << 0;
1015 		break;
1016 	case V4L2_CID_PILOT_TONE_ENABLED:
1017 		*property = SI4713_TX_COMPONENT_ENABLE;
1018 		*bit = 0;
1019 		*mask = 1 << 0;
1020 		break;
1021 
1022 	case V4L2_CID_AUDIO_LIMITER_RELEASE_TIME:
1023 		*property = SI4713_TX_LIMITER_RELEASE_TIME;
1024 		*table = limiter_times;
1025 		*size = ARRAY_SIZE(limiter_times);
1026 		break;
1027 	case V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME:
1028 		*property = SI4713_TX_ACOMP_RELEASE_TIME;
1029 		*table = acomp_rtimes;
1030 		*size = ARRAY_SIZE(acomp_rtimes);
1031 		break;
1032 	case V4L2_CID_TUNE_PREEMPHASIS:
1033 		*property = SI4713_TX_PREEMPHASIS;
1034 		*table = preemphasis_values;
1035 		*size = ARRAY_SIZE(preemphasis_values);
1036 		break;
1037 
1038 	default:
1039 		rval = -EINVAL;
1040 		break;
1041 	}
1042 
1043 	return rval;
1044 }
1045 
1046 static int si4713_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *f);
1047 static int si4713_s_modulator(struct v4l2_subdev *sd, const struct v4l2_modulator *);
1048 /*
1049  * si4713_setup - Sets the device up with current configuration.
1050  * @sdev: si4713_device structure for the device we are communicating
1051  */
1052 static int si4713_setup(struct si4713_device *sdev)
1053 {
1054 	struct v4l2_frequency f;
1055 	struct v4l2_modulator vm;
1056 	int rval;
1057 
1058 	/* Device procedure needs to set frequency first */
1059 	f.tuner = 0;
1060 	f.frequency = sdev->frequency ? sdev->frequency : DEFAULT_FREQUENCY;
1061 	f.frequency = si4713_to_v4l2(f.frequency);
1062 	rval = si4713_s_frequency(&sdev->sd, &f);
1063 
1064 	vm.index = 0;
1065 	if (sdev->stereo)
1066 		vm.txsubchans = V4L2_TUNER_SUB_STEREO;
1067 	else
1068 		vm.txsubchans = V4L2_TUNER_SUB_MONO;
1069 	if (sdev->rds_enabled)
1070 		vm.txsubchans |= V4L2_TUNER_SUB_RDS;
1071 	si4713_s_modulator(&sdev->sd, &vm);
1072 
1073 	return rval;
1074 }
1075 
1076 /*
1077  * si4713_initialize - Sets the device up with default configuration.
1078  * @sdev: si4713_device structure for the device we are communicating
1079  */
1080 static int si4713_initialize(struct si4713_device *sdev)
1081 {
1082 	int rval;
1083 
1084 	rval = si4713_set_power_state(sdev, POWER_ON);
1085 	if (rval < 0)
1086 		return rval;
1087 
1088 	rval = si4713_checkrev(sdev);
1089 	if (rval < 0)
1090 		return rval;
1091 
1092 	rval = si4713_set_power_state(sdev, POWER_OFF);
1093 	if (rval < 0)
1094 		return rval;
1095 
1096 	sdev->frequency = DEFAULT_FREQUENCY;
1097 	sdev->stereo = 1;
1098 	sdev->tune_rnl = DEFAULT_TUNE_RNL;
1099 	return 0;
1100 }
1101 
1102 /* si4713_s_ctrl - set the value of a control */
1103 static int si4713_s_ctrl(struct v4l2_ctrl *ctrl)
1104 {
1105 	struct si4713_device *sdev =
1106 		container_of(ctrl->handler, struct si4713_device, ctrl_handler);
1107 	u32 val = 0;
1108 	s32 bit = 0, mask = 0;
1109 	u16 property = 0;
1110 	int mul = 0;
1111 	unsigned long *table = NULL;
1112 	int size = 0;
1113 	bool force = false;
1114 	int c;
1115 	int ret = 0;
1116 
1117 	if (ctrl->id != V4L2_CID_AUDIO_MUTE)
1118 		return -EINVAL;
1119 	if (ctrl->is_new) {
1120 		if (ctrl->val) {
1121 			ret = si4713_set_mute(sdev, ctrl->val);
1122 			if (!ret)
1123 				ret = si4713_set_power_state(sdev, POWER_DOWN);
1124 			return ret;
1125 		}
1126 		ret = si4713_set_power_state(sdev, POWER_UP);
1127 		if (!ret)
1128 			ret = si4713_set_mute(sdev, ctrl->val);
1129 		if (!ret)
1130 			ret = si4713_setup(sdev);
1131 		if (ret)
1132 			return ret;
1133 		force = true;
1134 	}
1135 
1136 	if (!sdev->power_state)
1137 		return 0;
1138 
1139 	for (c = 1; !ret && c < ctrl->ncontrols; c++) {
1140 		ctrl = ctrl->cluster[c];
1141 
1142 		if (!force && !ctrl->is_new)
1143 			continue;
1144 
1145 		switch (ctrl->id) {
1146 		case V4L2_CID_RDS_TX_PS_NAME:
1147 			ret = si4713_set_rds_ps_name(sdev, ctrl->p_new.p_char);
1148 			break;
1149 
1150 		case V4L2_CID_RDS_TX_RADIO_TEXT:
1151 			ret = si4713_set_rds_radio_text(sdev, ctrl->p_new.p_char);
1152 			break;
1153 
1154 		case V4L2_CID_TUNE_ANTENNA_CAPACITOR:
1155 			/* don't handle this control if we force setting all
1156 			 * controls since in that case it will be handled by
1157 			 * V4L2_CID_TUNE_POWER_LEVEL. */
1158 			if (force)
1159 				break;
1160 			fallthrough;
1161 		case V4L2_CID_TUNE_POWER_LEVEL:
1162 			ret = si4713_tx_tune_power(sdev,
1163 				sdev->tune_pwr_level->val, sdev->tune_ant_cap->val);
1164 			if (!ret) {
1165 				/* Make sure we don't set this twice */
1166 				sdev->tune_ant_cap->is_new = false;
1167 				sdev->tune_pwr_level->is_new = false;
1168 			}
1169 			break;
1170 
1171 		case V4L2_CID_RDS_TX_ALT_FREQS_ENABLE:
1172 		case V4L2_CID_RDS_TX_ALT_FREQS:
1173 			if (sdev->rds_alt_freqs_enable->val) {
1174 				val = sdev->rds_alt_freqs->p_new.p_u32[0];
1175 				val = val / 100 - 876 + 0xe101;
1176 			} else {
1177 				val = 0xe0e0;
1178 			}
1179 			ret = si4713_write_property(sdev, SI4713_TX_RDS_PS_AF, val);
1180 			break;
1181 
1182 		default:
1183 			ret = si4713_choose_econtrol_action(sdev, ctrl->id, &bit,
1184 					&mask, &property, &mul, &table, &size);
1185 			if (ret < 0)
1186 				break;
1187 
1188 			val = ctrl->val;
1189 			if (mul) {
1190 				val = val / mul;
1191 			} else if (table) {
1192 				ret = usecs_to_dev(val, table, size);
1193 				if (ret < 0)
1194 					break;
1195 				val = ret;
1196 				ret = 0;
1197 			}
1198 
1199 			if (mask) {
1200 				ret = si4713_read_property(sdev, property, &val);
1201 				if (ret < 0)
1202 					break;
1203 				val = set_bits(val, ctrl->val, bit, mask);
1204 			}
1205 
1206 			ret = si4713_write_property(sdev, property, val);
1207 			if (ret < 0)
1208 				break;
1209 			if (mask)
1210 				val = ctrl->val;
1211 			break;
1212 		}
1213 	}
1214 
1215 	return ret;
1216 }
1217 
1218 /* si4713_ioctl - deal with private ioctls (only rnl for now) */
1219 static long si4713_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
1220 {
1221 	struct si4713_device *sdev = to_si4713_device(sd);
1222 	struct si4713_rnl *rnl = arg;
1223 	u16 frequency;
1224 	int rval = 0;
1225 
1226 	if (!arg)
1227 		return -EINVAL;
1228 
1229 	switch (cmd) {
1230 	case SI4713_IOC_MEASURE_RNL:
1231 		frequency = v4l2_to_si4713(rnl->frequency);
1232 
1233 		if (sdev->power_state) {
1234 			/* Set desired measurement frequency */
1235 			rval = si4713_tx_tune_measure(sdev, frequency, 0);
1236 			if (rval < 0)
1237 				return rval;
1238 			/* get results from tune status */
1239 			rval = si4713_update_tune_status(sdev);
1240 			if (rval < 0)
1241 				return rval;
1242 		}
1243 		rnl->rnl = sdev->tune_rnl;
1244 		break;
1245 
1246 	default:
1247 		/* nothing */
1248 		rval = -ENOIOCTLCMD;
1249 	}
1250 
1251 	return rval;
1252 }
1253 
1254 /* si4713_g_modulator - get modulator attributes */
1255 static int si4713_g_modulator(struct v4l2_subdev *sd, struct v4l2_modulator *vm)
1256 {
1257 	struct si4713_device *sdev = to_si4713_device(sd);
1258 	int rval = 0;
1259 
1260 	if (!sdev)
1261 		return -ENODEV;
1262 
1263 	if (vm->index > 0)
1264 		return -EINVAL;
1265 
1266 	strscpy(vm->name, "FM Modulator", sizeof(vm->name));
1267 	vm->capability = V4L2_TUNER_CAP_STEREO | V4L2_TUNER_CAP_LOW |
1268 		V4L2_TUNER_CAP_RDS | V4L2_TUNER_CAP_RDS_CONTROLS;
1269 
1270 	/* Report current frequency range limits */
1271 	vm->rangelow = si4713_to_v4l2(FREQ_RANGE_LOW);
1272 	vm->rangehigh = si4713_to_v4l2(FREQ_RANGE_HIGH);
1273 
1274 	if (sdev->power_state) {
1275 		u32 comp_en = 0;
1276 
1277 		rval = si4713_read_property(sdev, SI4713_TX_COMPONENT_ENABLE,
1278 						&comp_en);
1279 		if (rval < 0)
1280 			return rval;
1281 
1282 		sdev->stereo = get_status_bit(comp_en, 1, 1 << 1);
1283 	}
1284 
1285 	/* Report current audio mode: mono or stereo */
1286 	if (sdev->stereo)
1287 		vm->txsubchans = V4L2_TUNER_SUB_STEREO;
1288 	else
1289 		vm->txsubchans = V4L2_TUNER_SUB_MONO;
1290 
1291 	/* Report rds feature status */
1292 	if (sdev->rds_enabled)
1293 		vm->txsubchans |= V4L2_TUNER_SUB_RDS;
1294 	else
1295 		vm->txsubchans &= ~V4L2_TUNER_SUB_RDS;
1296 
1297 	return rval;
1298 }
1299 
1300 /* si4713_s_modulator - set modulator attributes */
1301 static int si4713_s_modulator(struct v4l2_subdev *sd, const struct v4l2_modulator *vm)
1302 {
1303 	struct si4713_device *sdev = to_si4713_device(sd);
1304 	int rval = 0;
1305 	u16 stereo, rds;
1306 	u32 p;
1307 
1308 	if (!sdev)
1309 		return -ENODEV;
1310 
1311 	if (vm->index > 0)
1312 		return -EINVAL;
1313 
1314 	/* Set audio mode: mono or stereo */
1315 	if (vm->txsubchans & V4L2_TUNER_SUB_STEREO)
1316 		stereo = 1;
1317 	else if (vm->txsubchans & V4L2_TUNER_SUB_MONO)
1318 		stereo = 0;
1319 	else
1320 		return -EINVAL;
1321 
1322 	rds = !!(vm->txsubchans & V4L2_TUNER_SUB_RDS);
1323 
1324 	if (sdev->power_state) {
1325 		rval = si4713_read_property(sdev,
1326 						SI4713_TX_COMPONENT_ENABLE, &p);
1327 		if (rval < 0)
1328 			return rval;
1329 
1330 		p = set_bits(p, stereo, 1, 1 << 1);
1331 		p = set_bits(p, rds, 2, 1 << 2);
1332 
1333 		rval = si4713_write_property(sdev,
1334 						SI4713_TX_COMPONENT_ENABLE, p);
1335 		if (rval < 0)
1336 			return rval;
1337 	}
1338 
1339 	sdev->stereo = stereo;
1340 	sdev->rds_enabled = rds;
1341 
1342 	return rval;
1343 }
1344 
1345 /* si4713_g_frequency - get tuner or modulator radio frequency */
1346 static int si4713_g_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *f)
1347 {
1348 	struct si4713_device *sdev = to_si4713_device(sd);
1349 	int rval = 0;
1350 
1351 	if (f->tuner)
1352 		return -EINVAL;
1353 
1354 	if (sdev->power_state) {
1355 		u16 freq;
1356 		u8 p, a, n;
1357 
1358 		rval = si4713_tx_tune_status(sdev, 0x00, &freq, &p, &a, &n);
1359 		if (rval < 0)
1360 			return rval;
1361 
1362 		sdev->frequency = freq;
1363 	}
1364 
1365 	f->frequency = si4713_to_v4l2(sdev->frequency);
1366 
1367 	return rval;
1368 }
1369 
1370 /* si4713_s_frequency - set tuner or modulator radio frequency */
1371 static int si4713_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *f)
1372 {
1373 	struct si4713_device *sdev = to_si4713_device(sd);
1374 	int rval = 0;
1375 	u16 frequency = v4l2_to_si4713(f->frequency);
1376 
1377 	if (f->tuner)
1378 		return -EINVAL;
1379 
1380 	/* Check frequency range */
1381 	frequency = clamp_t(u16, frequency, FREQ_RANGE_LOW, FREQ_RANGE_HIGH);
1382 
1383 	if (sdev->power_state) {
1384 		rval = si4713_tx_tune_freq(sdev, frequency);
1385 		if (rval < 0)
1386 			return rval;
1387 		frequency = rval;
1388 		rval = 0;
1389 	}
1390 	sdev->frequency = frequency;
1391 
1392 	return rval;
1393 }
1394 
1395 static const struct v4l2_ctrl_ops si4713_ctrl_ops = {
1396 	.s_ctrl = si4713_s_ctrl,
1397 };
1398 
1399 static const struct v4l2_subdev_core_ops si4713_subdev_core_ops = {
1400 	.ioctl		= si4713_ioctl,
1401 };
1402 
1403 static const struct v4l2_subdev_tuner_ops si4713_subdev_tuner_ops = {
1404 	.g_frequency	= si4713_g_frequency,
1405 	.s_frequency	= si4713_s_frequency,
1406 	.g_modulator	= si4713_g_modulator,
1407 	.s_modulator	= si4713_s_modulator,
1408 };
1409 
1410 static const struct v4l2_subdev_ops si4713_subdev_ops = {
1411 	.core		= &si4713_subdev_core_ops,
1412 	.tuner		= &si4713_subdev_tuner_ops,
1413 };
1414 
1415 static const struct v4l2_ctrl_config si4713_alt_freqs_ctrl = {
1416 	.id = V4L2_CID_RDS_TX_ALT_FREQS,
1417 	.type = V4L2_CTRL_TYPE_U32,
1418 	.min = 87600,
1419 	.max = 107900,
1420 	.step = 100,
1421 	.def = 87600,
1422 	.dims = { 1 },
1423 	.elem_size = sizeof(u32),
1424 };
1425 
1426 /*
1427  * I2C driver interface
1428  */
1429 /* si4713_probe - probe for the device */
1430 static int si4713_probe(struct i2c_client *client)
1431 {
1432 	struct si4713_device *sdev;
1433 	struct v4l2_ctrl_handler *hdl;
1434 	struct si4713_platform_data *pdata = client->dev.platform_data;
1435 	struct device_node *np = client->dev.of_node;
1436 	struct radio_si4713_platform_data si4713_pdev_pdata;
1437 	struct platform_device *si4713_pdev;
1438 	int rval;
1439 
1440 	sdev = devm_kzalloc(&client->dev, sizeof(*sdev), GFP_KERNEL);
1441 	if (!sdev) {
1442 		dev_err(&client->dev, "Failed to alloc video device.\n");
1443 		rval = -ENOMEM;
1444 		goto exit;
1445 	}
1446 
1447 	sdev->gpio_reset = devm_gpiod_get_optional(&client->dev, "reset",
1448 						   GPIOD_OUT_LOW);
1449 	if (IS_ERR(sdev->gpio_reset)) {
1450 		rval = PTR_ERR(sdev->gpio_reset);
1451 		dev_err(&client->dev, "Failed to request gpio: %d\n", rval);
1452 		goto exit;
1453 	}
1454 
1455 	sdev->vdd = devm_regulator_get_optional(&client->dev, "vdd");
1456 	if (IS_ERR(sdev->vdd)) {
1457 		rval = PTR_ERR(sdev->vdd);
1458 		if (rval == -EPROBE_DEFER)
1459 			goto exit;
1460 
1461 		dev_dbg(&client->dev, "no vdd regulator found: %d\n", rval);
1462 		sdev->vdd = NULL;
1463 	}
1464 
1465 	sdev->vio = devm_regulator_get_optional(&client->dev, "vio");
1466 	if (IS_ERR(sdev->vio)) {
1467 		rval = PTR_ERR(sdev->vio);
1468 		if (rval == -EPROBE_DEFER)
1469 			goto exit;
1470 
1471 		dev_dbg(&client->dev, "no vio regulator found: %d\n", rval);
1472 		sdev->vio = NULL;
1473 	}
1474 
1475 	v4l2_i2c_subdev_init(&sdev->sd, client, &si4713_subdev_ops);
1476 
1477 	init_completion(&sdev->work);
1478 
1479 	hdl = &sdev->ctrl_handler;
1480 	v4l2_ctrl_handler_init(hdl, 20);
1481 	sdev->mute = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1482 			V4L2_CID_AUDIO_MUTE, 0, 1, 1, DEFAULT_MUTE);
1483 
1484 	sdev->rds_pi = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1485 			V4L2_CID_RDS_TX_PI, 0, 0xffff, 1, DEFAULT_RDS_PI);
1486 	sdev->rds_pty = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1487 			V4L2_CID_RDS_TX_PTY, 0, 31, 1, DEFAULT_RDS_PTY);
1488 	sdev->rds_compressed = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1489 			V4L2_CID_RDS_TX_COMPRESSED, 0, 1, 1, 0);
1490 	sdev->rds_art_head = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1491 			V4L2_CID_RDS_TX_ARTIFICIAL_HEAD, 0, 1, 1, 0);
1492 	sdev->rds_stereo = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1493 			V4L2_CID_RDS_TX_MONO_STEREO, 0, 1, 1, 1);
1494 	sdev->rds_tp = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1495 			V4L2_CID_RDS_TX_TRAFFIC_PROGRAM, 0, 1, 1, 0);
1496 	sdev->rds_ta = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1497 			V4L2_CID_RDS_TX_TRAFFIC_ANNOUNCEMENT, 0, 1, 1, 0);
1498 	sdev->rds_ms = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1499 			V4L2_CID_RDS_TX_MUSIC_SPEECH, 0, 1, 1, 1);
1500 	sdev->rds_dyn_pty = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1501 			V4L2_CID_RDS_TX_DYNAMIC_PTY, 0, 1, 1, 0);
1502 	sdev->rds_alt_freqs_enable = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1503 			V4L2_CID_RDS_TX_ALT_FREQS_ENABLE, 0, 1, 1, 0);
1504 	sdev->rds_alt_freqs = v4l2_ctrl_new_custom(hdl, &si4713_alt_freqs_ctrl, NULL);
1505 	sdev->rds_deviation = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1506 			V4L2_CID_RDS_TX_DEVIATION, 0, MAX_RDS_DEVIATION,
1507 			10, DEFAULT_RDS_DEVIATION);
1508 	/*
1509 	 * Report step as 8. From RDS spec, psname
1510 	 * should be 8. But there are receivers which scroll strings
1511 	 * sized as 8xN.
1512 	 */
1513 	sdev->rds_ps_name = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1514 			V4L2_CID_RDS_TX_PS_NAME, 0, MAX_RDS_PS_NAME, 8, 0);
1515 	/*
1516 	 * Report step as 32 (2A block). From RDS spec,
1517 	 * radio text should be 32 for 2A block. But there are receivers
1518 	 * which scroll strings sized as 32xN. Setting default to 32.
1519 	 */
1520 	sdev->rds_radio_text = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1521 			V4L2_CID_RDS_TX_RADIO_TEXT, 0, MAX_RDS_RADIO_TEXT, 32, 0);
1522 
1523 	sdev->limiter_enabled = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1524 			V4L2_CID_AUDIO_LIMITER_ENABLED, 0, 1, 1, 1);
1525 	sdev->limiter_release_time = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1526 			V4L2_CID_AUDIO_LIMITER_RELEASE_TIME, 250,
1527 			MAX_LIMITER_RELEASE_TIME, 10, DEFAULT_LIMITER_RTIME);
1528 	sdev->limiter_deviation = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1529 			V4L2_CID_AUDIO_LIMITER_DEVIATION, 0,
1530 			MAX_LIMITER_DEVIATION, 10, DEFAULT_LIMITER_DEV);
1531 
1532 	sdev->compression_enabled = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1533 			V4L2_CID_AUDIO_COMPRESSION_ENABLED, 0, 1, 1, 1);
1534 	sdev->compression_gain = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1535 			V4L2_CID_AUDIO_COMPRESSION_GAIN, 0, MAX_ACOMP_GAIN, 1,
1536 			DEFAULT_ACOMP_GAIN);
1537 	sdev->compression_threshold = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1538 			V4L2_CID_AUDIO_COMPRESSION_THRESHOLD,
1539 			MIN_ACOMP_THRESHOLD, MAX_ACOMP_THRESHOLD, 1,
1540 			DEFAULT_ACOMP_THRESHOLD);
1541 	sdev->compression_attack_time = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1542 			V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME, 0,
1543 			MAX_ACOMP_ATTACK_TIME, 500, DEFAULT_ACOMP_ATIME);
1544 	sdev->compression_release_time = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1545 			V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME, 100000,
1546 			MAX_ACOMP_RELEASE_TIME, 100000, DEFAULT_ACOMP_RTIME);
1547 
1548 	sdev->pilot_tone_enabled = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1549 			V4L2_CID_PILOT_TONE_ENABLED, 0, 1, 1, 1);
1550 	sdev->pilot_tone_deviation = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1551 			V4L2_CID_PILOT_TONE_DEVIATION, 0, MAX_PILOT_DEVIATION,
1552 			10, DEFAULT_PILOT_DEVIATION);
1553 	sdev->pilot_tone_freq = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1554 			V4L2_CID_PILOT_TONE_FREQUENCY, 0, MAX_PILOT_FREQUENCY,
1555 			1, DEFAULT_PILOT_FREQUENCY);
1556 
1557 	sdev->tune_preemphasis = v4l2_ctrl_new_std_menu(hdl, &si4713_ctrl_ops,
1558 			V4L2_CID_TUNE_PREEMPHASIS,
1559 			V4L2_PREEMPHASIS_75_uS, 0, V4L2_PREEMPHASIS_50_uS);
1560 	sdev->tune_pwr_level = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1561 			V4L2_CID_TUNE_POWER_LEVEL, 0, SI4713_MAX_POWER,
1562 			1, DEFAULT_POWER_LEVEL);
1563 	sdev->tune_ant_cap = v4l2_ctrl_new_std(hdl, &si4713_ctrl_ops,
1564 			V4L2_CID_TUNE_ANTENNA_CAPACITOR, 0, SI4713_MAX_ANTCAP,
1565 			1, 0);
1566 
1567 	if (hdl->error) {
1568 		rval = hdl->error;
1569 		goto free_ctrls;
1570 	}
1571 	v4l2_ctrl_cluster(29, &sdev->mute);
1572 	sdev->sd.ctrl_handler = hdl;
1573 
1574 	if (client->irq) {
1575 		rval = devm_request_irq(&client->dev, client->irq,
1576 			si4713_handler, IRQF_TRIGGER_FALLING,
1577 			client->name, sdev);
1578 		if (rval < 0) {
1579 			v4l2_err(&sdev->sd, "Could not request IRQ\n");
1580 			goto free_ctrls;
1581 		}
1582 		v4l2_dbg(1, debug, &sdev->sd, "IRQ requested.\n");
1583 	} else {
1584 		v4l2_warn(&sdev->sd, "IRQ not configured. Using timeouts.\n");
1585 	}
1586 
1587 	rval = si4713_initialize(sdev);
1588 	if (rval < 0) {
1589 		v4l2_err(&sdev->sd, "Failed to probe device information.\n");
1590 		goto free_ctrls;
1591 	}
1592 
1593 	if (!np && (!pdata || !pdata->is_platform_device))
1594 		return 0;
1595 
1596 	si4713_pdev = platform_device_alloc("radio-si4713", -1);
1597 	if (!si4713_pdev) {
1598 		rval = -ENOMEM;
1599 		goto put_main_pdev;
1600 	}
1601 
1602 	si4713_pdev_pdata.subdev = client;
1603 	rval = platform_device_add_data(si4713_pdev, &si4713_pdev_pdata,
1604 					sizeof(si4713_pdev_pdata));
1605 	if (rval)
1606 		goto put_main_pdev;
1607 
1608 	rval = platform_device_add(si4713_pdev);
1609 	if (rval)
1610 		goto put_main_pdev;
1611 
1612 	sdev->pd = si4713_pdev;
1613 
1614 	return 0;
1615 
1616 put_main_pdev:
1617 	platform_device_put(si4713_pdev);
1618 	v4l2_device_unregister_subdev(&sdev->sd);
1619 free_ctrls:
1620 	v4l2_ctrl_handler_free(hdl);
1621 exit:
1622 	return rval;
1623 }
1624 
1625 /* si4713_remove - remove the device */
1626 static void si4713_remove(struct i2c_client *client)
1627 {
1628 	struct v4l2_subdev *sd = i2c_get_clientdata(client);
1629 	struct si4713_device *sdev = to_si4713_device(sd);
1630 
1631 	platform_device_unregister(sdev->pd);
1632 
1633 	if (sdev->power_state)
1634 		si4713_set_power_state(sdev, POWER_DOWN);
1635 
1636 	v4l2_device_unregister_subdev(sd);
1637 	v4l2_ctrl_handler_free(sd->ctrl_handler);
1638 }
1639 
1640 /* si4713_i2c_driver - i2c driver interface */
1641 static const struct i2c_device_id si4713_id[] = {
1642 	{ "si4713" , 0 },
1643 	{ },
1644 };
1645 MODULE_DEVICE_TABLE(i2c, si4713_id);
1646 
1647 #if IS_ENABLED(CONFIG_OF)
1648 static const struct of_device_id si4713_of_match[] = {
1649 	{ .compatible = "silabs,si4713" },
1650 	{ },
1651 };
1652 MODULE_DEVICE_TABLE(of, si4713_of_match);
1653 #endif
1654 
1655 static struct i2c_driver si4713_i2c_driver = {
1656 	.driver		= {
1657 		.name	= "si4713",
1658 		.of_match_table = of_match_ptr(si4713_of_match),
1659 	},
1660 	.probe_new	= si4713_probe,
1661 	.remove         = si4713_remove,
1662 	.id_table       = si4713_id,
1663 };
1664 
1665 module_i2c_driver(si4713_i2c_driver);
1666