1 // SPDX-License-Identifier: GPL-2.0-only
3 * drivers/mfd/si476x-i2c.c -- Core device driver for si476x MFD
6 * Copyright (C) 2012 Innovative Converged Devices(ICD)
7 * Copyright (C) 2013 Andrey Smirnov
9 * Author: Andrey Smirnov <andrew.smirnov@gmail.com>
11 #include <linux/module.h>
13 #include <linux/slab.h>
14 #include <linux/interrupt.h>
15 #include <linux/delay.h>
16 #include <linux/gpio.h>
17 #include <linux/regulator/consumer.h>
18 #include <linux/i2c.h>
19 #include <linux/err.h>
21 #include <linux/mfd/si476x-core.h>
23 #define SI476X_MAX_IO_ERRORS 10
24 #define SI476X_DRIVER_RDS_FIFO_DEPTH 128
27 * si476x_core_config_pinmux() - pin function configuration function
29 * @core: Core device structure
31 * Configure the functions of the pins of the radio chip.
33 * The function returns zero in case of succes or negative error code
36 static int si476x_core_config_pinmux(struct si476x_core
*core
)
39 dev_dbg(&core
->client
->dev
, "Configuring pinmux\n");
40 err
= si476x_core_cmd_dig_audio_pin_cfg(core
,
46 dev_err(&core
->client
->dev
,
47 "Failed to configure digital audio pins(err = %d)\n",
52 err
= si476x_core_cmd_zif_pin_cfg(core
,
58 dev_err(&core
->client
->dev
,
59 "Failed to configure ZIF pins(err = %d)\n",
64 err
= si476x_core_cmd_ic_link_gpo_ctl_pin_cfg(core
,
70 dev_err(&core
->client
->dev
,
71 "Failed to configure IC-Link/GPO pins(err = %d)\n",
76 err
= si476x_core_cmd_ana_audio_pin_cfg(core
,
79 dev_err(&core
->client
->dev
,
80 "Failed to configure analog audio pins(err = %d)\n",
85 err
= si476x_core_cmd_intb_pin_cfg(core
,
89 dev_err(&core
->client
->dev
,
90 "Failed to configure interrupt pins(err = %d)\n",
98 static inline void si476x_core_schedule_polling_work(struct si476x_core
*core
)
100 schedule_delayed_work(&core
->status_monitor
,
101 usecs_to_jiffies(SI476X_STATUS_POLL_US
));
105 * si476x_core_start() - early chip startup function
106 * @core: Core device structure
107 * @soft: When set, this flag forces "soft" startup, where "soft"
108 * power down is the one done by sending appropriate command instead
109 * of using reset pin of the tuner
111 * Perform required startup sequence to correctly power
112 * up the chip and perform initial configuration. It does the
113 * following sequence of actions:
114 * 1. Claims and enables the power supplies VD and VIO1 required
115 * for I2C interface of the chip operation.
116 * 2. Waits for 100us, pulls the reset line up, enables irq,
117 * waits for another 100us as it is specified by the
119 * 3. Sends 'POWER_UP' command to the device with all provided
120 * information about power-up parameters.
121 * 4. Configures, pin multiplexor, disables digital audio and
122 * configures interrupt sources.
124 * The function returns zero in case of succes or negative error code
127 int si476x_core_start(struct si476x_core
*core
, bool soft
)
129 struct i2c_client
*client
= core
->client
;
133 if (gpio_is_valid(core
->gpio_reset
))
134 gpio_set_value_cansleep(core
->gpio_reset
, 1);
137 enable_irq(client
->irq
);
142 atomic_set(&core
->is_alive
, 1);
143 si476x_core_schedule_polling_work(core
);
147 enable_irq(client
->irq
);
149 atomic_set(&core
->is_alive
, 1);
150 si476x_core_schedule_polling_work(core
);
154 err
= si476x_core_cmd_power_up(core
,
155 &core
->power_up_parameters
);
158 dev_err(&core
->client
->dev
,
159 "Power up failure(err = %d)\n",
165 atomic_set(&core
->is_alive
, 1);
167 err
= si476x_core_config_pinmux(core
);
169 dev_err(&core
->client
->dev
,
170 "Failed to configure pinmux(err = %d)\n",
176 err
= regmap_write(core
->regmap
,
177 SI476X_PROP_INT_CTL_ENABLE
,
182 dev_err(&core
->client
->dev
,
183 "Failed to configure interrupt sources"
184 "(err = %d)\n", err
);
193 atomic_set(&core
->is_alive
, 0);
196 disable_irq(client
->irq
);
198 cancel_delayed_work_sync(&core
->status_monitor
);
200 if (gpio_is_valid(core
->gpio_reset
))
201 gpio_set_value_cansleep(core
->gpio_reset
, 0);
205 EXPORT_SYMBOL_GPL(si476x_core_start
);
208 * si476x_core_stop() - chip power-down function
209 * @core: Core device structure
210 * @soft: When set, function sends a POWER_DOWN command instead of
211 * bringing reset line low
213 * Power down the chip by performing following actions:
214 * 1. Disable IRQ or stop the polling worker
215 * 2. Send the POWER_DOWN command if the power down is soft or bring
216 * reset line low if not.
218 * The function returns zero in case of succes or negative error code
221 int si476x_core_stop(struct si476x_core
*core
, bool soft
)
224 atomic_set(&core
->is_alive
, 0);
227 /* TODO: This probably shoud be a configurable option,
228 * so it is possible to have the chips keep their
229 * oscillators running
231 struct si476x_power_down_args args
= {
234 err
= si476x_core_cmd_power_down(core
, &args
);
237 /* We couldn't disable those before
238 * 'si476x_core_cmd_power_down' since we expect to get CTS
240 if (core
->client
->irq
)
241 disable_irq(core
->client
->irq
);
243 cancel_delayed_work_sync(&core
->status_monitor
);
246 if (gpio_is_valid(core
->gpio_reset
))
247 gpio_set_value_cansleep(core
->gpio_reset
, 0);
251 EXPORT_SYMBOL_GPL(si476x_core_stop
);
254 * si476x_core_set_power_state() - set the level at which the power is
255 * supplied for the chip.
256 * @core: Core device structure
257 * @next_state: enum si476x_power_state describing power state to
260 * Switch on all the required power supplies
262 * This function returns 0 in case of suvccess and negative error code
265 int si476x_core_set_power_state(struct si476x_core
*core
,
266 enum si476x_power_state next_state
)
269 It is not clear form the datasheet if it is possible to
270 work with device if not all power domains are operational.
271 So for now the power-up policy is "power-up all the things!"
275 if (core
->power_state
== SI476X_POWER_INCONSISTENT
) {
276 dev_err(&core
->client
->dev
,
277 "The device in inconsistent power state\n");
281 if (next_state
!= core
->power_state
) {
282 switch (next_state
) {
283 case SI476X_POWER_UP_FULL
:
284 err
= regulator_bulk_enable(ARRAY_SIZE(core
->supplies
),
287 core
->power_state
= SI476X_POWER_INCONSISTENT
;
291 * Startup timing diagram recommends to have a
292 * 100 us delay between enabling of the power
293 * supplies and turning the tuner on.
297 err
= si476x_core_start(core
, false);
299 goto disable_regulators
;
301 core
->power_state
= next_state
;
304 case SI476X_POWER_DOWN
:
305 core
->power_state
= next_state
;
306 err
= si476x_core_stop(core
, false);
308 core
->power_state
= SI476X_POWER_INCONSISTENT
;
310 err
= regulator_bulk_disable(ARRAY_SIZE(core
->supplies
),
313 core
->power_state
= SI476X_POWER_INCONSISTENT
;
322 EXPORT_SYMBOL_GPL(si476x_core_set_power_state
);
325 * si476x_core_report_drainer_stop() - mark the completion of the RDS
326 * buffer drain porcess by the worker.
328 * @core: Core device structure
330 static inline void si476x_core_report_drainer_stop(struct si476x_core
*core
)
332 mutex_lock(&core
->rds_drainer_status_lock
);
333 core
->rds_drainer_is_working
= false;
334 mutex_unlock(&core
->rds_drainer_status_lock
);
338 * si476x_core_start_rds_drainer_once() - start RDS drainer worker if
339 * ther is none working, do nothing otherwise
341 * @core: Datastructure corresponding to the chip.
343 static inline void si476x_core_start_rds_drainer_once(struct si476x_core
*core
)
345 mutex_lock(&core
->rds_drainer_status_lock
);
346 if (!core
->rds_drainer_is_working
) {
347 core
->rds_drainer_is_working
= true;
348 schedule_work(&core
->rds_fifo_drainer
);
350 mutex_unlock(&core
->rds_drainer_status_lock
);
353 * si476x_core_drain_rds_fifo() - RDS buffer drainer.
354 * @work: struct work_struct being ppassed to the function by the
357 * Drain the contents of the RDS FIFO of
359 static void si476x_core_drain_rds_fifo(struct work_struct
*work
)
363 struct si476x_core
*core
= container_of(work
, struct si476x_core
,
366 struct si476x_rds_status_report report
;
368 si476x_core_lock(core
);
369 err
= si476x_core_cmd_fm_rds_status(core
, true, false, false, &report
);
371 int i
= report
.rdsfifoused
;
372 dev_dbg(&core
->client
->dev
,
373 "%d elements in RDS FIFO. Draining.\n", i
);
375 err
= si476x_core_cmd_fm_rds_status(core
, false, false,
380 kfifo_in(&core
->rds_fifo
, report
.rds
,
382 dev_dbg(&core
->client
->dev
, "RDS data:\n %*ph\n",
383 (int)sizeof(report
.rds
), report
.rds
);
385 dev_dbg(&core
->client
->dev
, "Drrrrained!\n");
386 wake_up_interruptible(&core
->rds_read_queue
);
390 si476x_core_unlock(core
);
391 si476x_core_report_drainer_stop(core
);
395 * si476x_core_pronounce_dead()
397 * @core: Core device structure
399 * Mark the device as being dead and wake up all potentially waiting
400 * threads of execution.
403 static void si476x_core_pronounce_dead(struct si476x_core
*core
)
405 dev_info(&core
->client
->dev
, "Core device is dead.\n");
407 atomic_set(&core
->is_alive
, 0);
409 /* Wake up al possible waiting processes */
410 wake_up_interruptible(&core
->rds_read_queue
);
412 atomic_set(&core
->cts
, 1);
413 wake_up(&core
->command
);
415 atomic_set(&core
->stc
, 1);
416 wake_up(&core
->tuning
);
420 * si476x_core_i2c_xfer()
422 * @core: Core device structure
423 * @type: Transfer type
424 * @buf: Transfer buffer for/with data
425 * @count: Transfer buffer size
427 * Perfrom and I2C transfer(either read or write) and keep a counter
428 * of I/O errors. If the error counter rises above the threshold
429 * pronounce device dead.
431 * The function returns zero on succes or negative error code on
434 int si476x_core_i2c_xfer(struct si476x_core
*core
,
435 enum si476x_i2c_type type
,
436 char *buf
, int count
)
438 static int io_errors_count
;
440 if (type
== SI476X_I2C_SEND
)
441 err
= i2c_master_send(core
->client
, buf
, count
);
443 err
= i2c_master_recv(core
->client
, buf
, count
);
446 if (io_errors_count
++ > SI476X_MAX_IO_ERRORS
)
447 si476x_core_pronounce_dead(core
);
454 EXPORT_SYMBOL_GPL(si476x_core_i2c_xfer
);
457 * si476x_core_get_status()
458 * @core: Core device structure
460 * Get the status byte of the core device by berforming one byte I2C
463 * The function returns a status value or a negative error code on
466 static int si476x_core_get_status(struct si476x_core
*core
)
469 int err
= si476x_core_i2c_xfer(core
, SI476X_I2C_RECV
,
470 &response
, sizeof(response
));
472 return (err
< 0) ? err
: response
;
476 * si476x_core_get_and_signal_status() - IRQ dispatcher
477 * @core: Core device structure
479 * Dispatch the arrived interrupt request based on the value of the
480 * status byte reported by the tuner.
483 static void si476x_core_get_and_signal_status(struct si476x_core
*core
)
485 int status
= si476x_core_get_status(core
);
487 dev_err(&core
->client
->dev
, "Failed to get status\n");
491 if (status
& SI476X_CTS
) {
492 /* Unfortunately completions could not be used for
493 * signalling CTS since this flag cannot be cleared
494 * in status byte, and therefore once it becomes true
495 * multiple calls to 'complete' would cause the
496 * commands following the current one to be completed
497 * before they actually are */
498 dev_dbg(&core
->client
->dev
, "[interrupt] CTSINT\n");
499 atomic_set(&core
->cts
, 1);
500 wake_up(&core
->command
);
503 if (status
& SI476X_FM_RDS_INT
) {
504 dev_dbg(&core
->client
->dev
, "[interrupt] RDSINT\n");
505 si476x_core_start_rds_drainer_once(core
);
508 if (status
& SI476X_STC_INT
) {
509 dev_dbg(&core
->client
->dev
, "[interrupt] STCINT\n");
510 atomic_set(&core
->stc
, 1);
511 wake_up(&core
->tuning
);
515 static void si476x_core_poll_loop(struct work_struct
*work
)
517 struct si476x_core
*core
= SI476X_WORK_TO_CORE(work
);
519 si476x_core_get_and_signal_status(core
);
521 if (atomic_read(&core
->is_alive
))
522 si476x_core_schedule_polling_work(core
);
525 static irqreturn_t
si476x_core_interrupt(int irq
, void *dev
)
527 struct si476x_core
*core
= dev
;
529 si476x_core_get_and_signal_status(core
);
535 * si476x_core_fwver_to_revision()
536 * @core: Core device structure
537 * @func: Selects the boot function of the device:
538 * *_BOOTLOADER - Boot loader
539 * *_FM_RECEIVER - FM receiver
540 * *_AM_RECEIVER - AM receiver
541 * *_WB_RECEIVER - Weatherband receiver
542 * @major: Firmware major number
543 * @minor1: Firmware first minor number
544 * @minor2: Firmware second minor number
546 * Convert a chip's firmware version number into an offset that later
547 * will be used to as offset in "vtable" of tuner functions
549 * This function returns a positive offset in case of success and a -1
550 * in case of failure.
552 static int si476x_core_fwver_to_revision(struct si476x_core
*core
,
554 int minor1
, int minor2
)
557 case SI476X_FUNC_FM_RECEIVER
:
560 return SI476X_REVISION_A10
;
562 return SI476X_REVISION_A20
;
564 return SI476X_REVISION_A30
;
566 goto unknown_revision
;
568 case SI476X_FUNC_AM_RECEIVER
:
571 return SI476X_REVISION_A10
;
573 return SI476X_REVISION_A20
;
575 return SI476X_REVISION_A30
;
577 goto unknown_revision
;
579 case SI476X_FUNC_WB_RECEIVER
:
582 return SI476X_REVISION_A10
;
584 return SI476X_REVISION_A20
;
586 return SI476X_REVISION_A30
;
588 goto unknown_revision
;
590 case SI476X_FUNC_BOOTLOADER
:
591 default: /* FALLTHROUGH */
597 dev_err(&core
->client
->dev
,
598 "Unsupported version of the firmware: %d.%d.%d, "
599 "reverting to A10 compatible functions\n",
600 major
, minor1
, minor2
);
602 return SI476X_REVISION_A10
;
606 * si476x_core_get_revision_info()
607 * @core: Core device structure
609 * Get the firmware version number of the device. It is done in
610 * following three steps:
611 * 1. Power-up the device
612 * 2. Send the 'FUNC_INFO' command
613 * 3. Powering the device down.
615 * The function return zero on success and a negative error code on
618 static int si476x_core_get_revision_info(struct si476x_core
*core
)
621 struct si476x_func_info info
;
623 si476x_core_lock(core
);
624 rval
= si476x_core_set_power_state(core
, SI476X_POWER_UP_FULL
);
628 rval
= si476x_core_cmd_func_info(core
, &info
);
632 core
->revision
= si476x_core_fwver_to_revision(core
, info
.func
,
634 info
.firmware
.minor
[0],
635 info
.firmware
.minor
[1]);
637 si476x_core_set_power_state(core
, SI476X_POWER_DOWN
);
639 si476x_core_unlock(core
);
644 bool si476x_core_has_am(struct si476x_core
*core
)
646 return core
->chip_id
== SI476X_CHIP_SI4761
||
647 core
->chip_id
== SI476X_CHIP_SI4764
;
649 EXPORT_SYMBOL_GPL(si476x_core_has_am
);
651 bool si476x_core_has_diversity(struct si476x_core
*core
)
653 return core
->chip_id
== SI476X_CHIP_SI4764
;
655 EXPORT_SYMBOL_GPL(si476x_core_has_diversity
);
657 bool si476x_core_is_a_secondary_tuner(struct si476x_core
*core
)
659 return si476x_core_has_diversity(core
) &&
660 (core
->diversity_mode
== SI476X_PHDIV_SECONDARY_ANTENNA
||
661 core
->diversity_mode
== SI476X_PHDIV_SECONDARY_COMBINING
);
663 EXPORT_SYMBOL_GPL(si476x_core_is_a_secondary_tuner
);
665 bool si476x_core_is_a_primary_tuner(struct si476x_core
*core
)
667 return si476x_core_has_diversity(core
) &&
668 (core
->diversity_mode
== SI476X_PHDIV_PRIMARY_ANTENNA
||
669 core
->diversity_mode
== SI476X_PHDIV_PRIMARY_COMBINING
);
671 EXPORT_SYMBOL_GPL(si476x_core_is_a_primary_tuner
);
673 bool si476x_core_is_in_am_receiver_mode(struct si476x_core
*core
)
675 return si476x_core_has_am(core
) &&
676 (core
->power_up_parameters
.func
== SI476X_FUNC_AM_RECEIVER
);
678 EXPORT_SYMBOL_GPL(si476x_core_is_in_am_receiver_mode
);
680 bool si476x_core_is_powered_up(struct si476x_core
*core
)
682 return core
->power_state
== SI476X_POWER_UP_FULL
;
684 EXPORT_SYMBOL_GPL(si476x_core_is_powered_up
);
686 static int si476x_core_probe(struct i2c_client
*client
)
688 const struct i2c_device_id
*id
= i2c_client_get_device_id(client
);
690 struct si476x_core
*core
;
691 struct si476x_platform_data
*pdata
;
692 struct mfd_cell
*cell
;
695 core
= devm_kzalloc(&client
->dev
, sizeof(*core
), GFP_KERNEL
);
699 core
->client
= client
;
701 core
->regmap
= devm_regmap_init_si476x(core
);
702 if (IS_ERR(core
->regmap
)) {
703 rval
= PTR_ERR(core
->regmap
);
704 dev_err(&client
->dev
,
705 "Failed to allocate register map: %d\n",
710 i2c_set_clientdata(client
, core
);
712 atomic_set(&core
->is_alive
, 0);
713 core
->power_state
= SI476X_POWER_DOWN
;
715 pdata
= dev_get_platdata(&client
->dev
);
717 memcpy(&core
->power_up_parameters
,
718 &pdata
->power_up_parameters
,
719 sizeof(core
->power_up_parameters
));
721 core
->gpio_reset
= -1;
722 if (gpio_is_valid(pdata
->gpio_reset
)) {
723 rval
= gpio_request(pdata
->gpio_reset
, "si476x reset");
725 dev_err(&client
->dev
,
726 "Failed to request gpio: %d\n", rval
);
729 core
->gpio_reset
= pdata
->gpio_reset
;
730 gpio_direction_output(core
->gpio_reset
, 0);
733 core
->diversity_mode
= pdata
->diversity_mode
;
734 memcpy(&core
->pinmux
, &pdata
->pinmux
,
735 sizeof(struct si476x_pinmux
));
737 dev_err(&client
->dev
, "No platform data provided\n");
741 core
->supplies
[0].supply
= "vd";
742 core
->supplies
[1].supply
= "va";
743 core
->supplies
[2].supply
= "vio1";
744 core
->supplies
[3].supply
= "vio2";
746 rval
= devm_regulator_bulk_get(&client
->dev
,
747 ARRAY_SIZE(core
->supplies
),
750 dev_err(&client
->dev
, "Failed to get all of the regulators\n");
754 mutex_init(&core
->cmd_lock
);
755 init_waitqueue_head(&core
->command
);
756 init_waitqueue_head(&core
->tuning
);
758 rval
= kfifo_alloc(&core
->rds_fifo
,
759 SI476X_DRIVER_RDS_FIFO_DEPTH
*
760 sizeof(struct v4l2_rds_data
),
763 dev_err(&client
->dev
, "Could not allocate the FIFO\n");
766 mutex_init(&core
->rds_drainer_status_lock
);
767 init_waitqueue_head(&core
->rds_read_queue
);
768 INIT_WORK(&core
->rds_fifo_drainer
, si476x_core_drain_rds_fifo
);
771 rval
= devm_request_threaded_irq(&client
->dev
,
773 si476x_core_interrupt
,
774 IRQF_TRIGGER_FALLING
|
778 dev_err(&client
->dev
, "Could not request IRQ %d\n",
782 disable_irq(client
->irq
);
783 dev_dbg(&client
->dev
, "IRQ requested.\n");
785 core
->rds_fifo_depth
= 20;
787 INIT_DELAYED_WORK(&core
->status_monitor
,
788 si476x_core_poll_loop
);
789 dev_info(&client
->dev
,
790 "No IRQ number specified, will use polling\n");
792 core
->rds_fifo_depth
= 5;
795 core
->chip_id
= id
->driver_data
;
797 rval
= si476x_core_get_revision_info(core
);
805 cell
= &core
->cells
[SI476X_RADIO_CELL
];
806 cell
->name
= "si476x-radio";
809 #ifdef CONFIG_SND_SOC_SI476X
810 if ((core
->chip_id
== SI476X_CHIP_SI4761
||
811 core
->chip_id
== SI476X_CHIP_SI4764
) &&
812 core
->pinmux
.dclk
== SI476X_DCLK_DAUDIO
&&
813 core
->pinmux
.dfs
== SI476X_DFS_DAUDIO
&&
814 core
->pinmux
.dout
== SI476X_DOUT_I2S_OUTPUT
&&
815 core
->pinmux
.xout
== SI476X_XOUT_TRISTATE
) {
816 cell
= &core
->cells
[SI476X_CODEC_CELL
];
817 cell
->name
= "si476x-codec";
821 rval
= mfd_add_devices(&client
->dev
,
822 (client
->adapter
->nr
<< 8) + client
->addr
,
823 core
->cells
, cell_num
,
829 kfifo_free(&core
->rds_fifo
);
832 if (gpio_is_valid(core
->gpio_reset
))
833 gpio_free(core
->gpio_reset
);
838 static void si476x_core_remove(struct i2c_client
*client
)
840 struct si476x_core
*core
= i2c_get_clientdata(client
);
842 si476x_core_pronounce_dead(core
);
843 mfd_remove_devices(&client
->dev
);
846 disable_irq(client
->irq
);
848 cancel_delayed_work_sync(&core
->status_monitor
);
850 kfifo_free(&core
->rds_fifo
);
852 if (gpio_is_valid(core
->gpio_reset
))
853 gpio_free(core
->gpio_reset
);
857 static const struct i2c_device_id si476x_id
[] = {
858 { "si4761", SI476X_CHIP_SI4761
},
859 { "si4764", SI476X_CHIP_SI4764
},
860 { "si4768", SI476X_CHIP_SI4768
},
863 MODULE_DEVICE_TABLE(i2c
, si476x_id
);
865 static struct i2c_driver si476x_core_driver
= {
867 .name
= "si476x-core",
869 .probe
= si476x_core_probe
,
870 .remove
= si476x_core_remove
,
871 .id_table
= si476x_id
,
873 module_i2c_driver(si476x_core_driver
);
876 MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
877 MODULE_DESCRIPTION("Si4761/64/68 AM/FM MFD core device driver");
878 MODULE_LICENSE("GPL");