[nrf fromlist] drivers: clock_control: nrf: Apply fix for nRF54L anomaly 30.

Applied fix for nRF54L anomaly 30, which requires a periodic
calibration of high-frequency clock.

Upstream PR #: 88112

Signed-off-by: Michał Stasiak <[email protected]>

Author: mstasiaknordic

drivers/clock_control/Kconfig.nrf

@@ -128,6 +128,27 @@ config CLOCK_CONTROL_NRF_USES_TEMP_SENSOR
 endif # CLOCK_CONTROL_NRF_DRIVER_CALIBRATION
 endif # CLOCK_CONTROL_NRF_K32SRC_RC_CALIBRATION
 
+config CLOCK_CONTROL_NRF_HF_CALIBRATION
+	bool "HF clock calibration"
+	depends on SOC_NRF54L05 || SOC_NRF54L10 || SOC_NRF54L15
+	default n
+	help
+	  Enables periodic calibration of high-frequency clock. Calibration
+	  is experimental.
+
+if CLOCK_CONTROL_NRF_HF_CALIBRATION
+
+config CLOCK_CONTROL_NRF_HF_CALIBRATION_PERIOD
+	int "HF clock calibration period in milliseconds"
+	default 60000
+	help
+	  Periodically, high-frequency clock calibration is performed.
+	  This includes requesting high-frequency clock and starting
+	  actual calibration. Once calibration is finished, the clock
+	  is released.
+
+endif # CLOCK_CONTROL_NRF_HF_CALIBRATION
+
 choice CLOCK_CONTROL_NRF_ACCURACY_PPM
 	prompt "32KHz clock accuracy"
 	default CLOCK_CONTROL_NRF_K32SRC_500PPM if CLOCK_CONTROL_NRF_K32SRC_RC && SOC_COMPATIBLE_NRF52X

drivers/clock_control/clock_control_nrf.c

@@ -14,6 +14,7 @@
 #include <zephyr/logging/log.h>
 #include <zephyr/shell/shell.h>
 #include <zephyr/irq.h>
+#include <nrf_erratas.h>
 
 LOG_MODULE_REGISTER(clock_control, CONFIG_CLOCK_CONTROL_LOG_LEVEL);
 
@@ -84,6 +85,11 @@ static uint64_t hf_stop_tstamp;
 static struct onoff_client lfsynth_cli;
 #endif
 
+#if CONFIG_CLOCK_CONTROL_NRF_HF_CALIBRATION
+static struct onoff_client hf_cal_cli;
+static K_SEM_DEFINE(cal_sem, 0, 1);
+#endif
+
 static struct nrf_clock_control_sub_data *get_sub_data(const struct device *dev,
 						       enum clock_control_nrf_type type)
 {
@@ -172,9 +178,78 @@ static void set_on_state(uint32_t *flags)
 	irq_unlock(key);
 }
 
+#if CONFIG_CLOCK_CONTROL_NRF_HF_CALIBRATION
+
+static void calibration_handler(struct k_timer *timer)
+{
+	if (nrfx_clock_hfclk_is_running()) {
+		return;
+	}
+	sys_notify_init_spinwait(&hf_cal_cli.notify);
+	(void)onoff_request(z_nrf_clock_control_get_onoff(CLOCK_CONTROL_NRF_SUBSYS_HF),
+			    &hf_cal_cli);
+	k_sem_take(&cal_sem, K_FOREVER);
+	(void)onoff_cancel_or_release(z_nrf_clock_control_get_onoff(CLOCK_CONTROL_NRF_SUBSYS_HF),
+				      &hf_cal_cli);
+}
+
+static K_TIMER_DEFINE(calibration_timer, calibration_handler, NULL);
+
+static void nrf_errata_30_workaround(void)
+{
+	if (!nrf54l_errata_30()) {
+		return;
+	}
+
+	while ((NRF_CLOCK->XO.STAT & CLOCK_XO_STAT_STATE_Msk) != CLOCK_XO_STAT_STATE_Running
+							      << CLOCK_XO_STAT_STATE_Pos) {
+	}
+	const uint32_t higher_bits = *((volatile uint32_t *)0x50120820ul) & 0xFFFFFFC0;
+	*((volatile uint32_t *)0x50120864ul) = 1 | (1 << 31);
+	*((volatile uint32_t *)0x50120848ul) = 1;
+	uint32_t off_abs = 24;
+
+	while (off_abs >= 24) {
+		*((volatile uint32_t *)0x50120844ul) = 1;
+		while (((*((volatile uint32_t *)0x50120840ul)) & (1 << 16)) != 0) {
+		}
+		const uint32_t current_trim = *((volatile uint32_t *)0x50120820ul) & 0x3F;
+		const uint32_t meetering_result = *((volatile uint32_t *)0x50120840ul) & 0x7FF;
+		int32_t off = 1024 - meetering_result;
+
+		off_abs = (off < 0) ? -off : off;
+		if (off >= 24 && current_trim < 0x3F) {
+			*((volatile uint32_t *)0x50120820ul) = higher_bits | (current_trim + 1);
+		} else if (off <= -24 && current_trim > 0) {
+			*((volatile uint32_t *)0x50120820ul) = higher_bits | (current_trim - 1);
+		}
+	}
+
+	*((volatile uint32_t *)0x50120848ul) = 0;
+
+	k_sem_give(&cal_sem);
+}
+
+static int calibration_init(void)
+{
+	k_timer_start(&calibration_timer,
+		      K_NO_WAIT,
+		      K_MSEC(CONFIG_CLOCK_CONTROL_NRF_HF_CALIBRATION_PERIOD));
+
+	return 0;
+}
+
+SYS_INIT(calibration_init, APPLICATION, 0);
+#endif
+
 static void clkstarted_handle(const struct device *dev,
 			      enum clock_control_nrf_type type)
 {
+#if CONFIG_CLOCK_CONTROL_NRF_HF_CALIBRATION
+	if (type == CLOCK_CONTROL_NRF_TYPE_HFCLK) {
+		nrf_errata_30_workaround();
+	}
+#endif
 	struct nrf_clock_control_sub_data *sub_data = get_sub_data(dev, type);
 	clock_control_cb_t callback = sub_data->cb;
 	void *user_data = sub_data->user_data;