arch-wrpc: add subcommands to set advanced ppsi parameters

Like: --prio1 --prio2 --domain (domain number) --class (clock class) --accuracy (clock accuracy) --allan (clock allan variance) --tsource (time source) Signed-off-by: Adam Wujek <adam.wujek@creotech.pl>

arch-wrpc: add subcommands to set advanced ppsi parameters
Like: --prio1 --prio2 --domain (domain number) --class (clock class) --accuracy (clock accuracy) --allan (clock allan variance) --tsource (time source) Signed-off-by: Adam Wujek <adam.wujek@creotech.pl>
9a8c56f8 · Adam Wujek · Adam Wujek · 61319bde · 9a8c56f8 · 9a8c56f8
Commit 9a8c56f8 authored Jun 01, 2021 by Adam Wujek Committed by Adam Wujek Sep 24, 2021
Hide whitespace changes
Inline Side-by-side

Showing with 88 additions and 0 deletions

wrc_ptp_ppsi.c arch-wrpc/wrc_ptp_ppsi.c +81 -0

wrpc.h arch-wrpc/wrpc.h +7 -0

No files found.
--- a/arch-wrpc/wrc_ptp_ppsi.c
+++ b/arch-wrpc/wrc_ptp_ppsi.c
@@ -409,3 +409,84 @@ int wrc_ptp_is_abscal(void)
 {
 	return ptp_mode == WRC_MODE_ABSCAL;
 }
+
+/* lm32'S compiler does not remove strings used in the function if
+ * the function is optimized out. So if the option is not used don't include
+ * the nbot optimized out strings in functions wrpc_ptp_set*. Ugly but can be
+ * repoved when LM32's support is dropped. */
+#if defined CONFIG_CMD_PTP_ADV && defined CONFIG_ARCH_LM32
+static int assign_ptp_param(char *name, int *param, int value, int min, int max)
+{
+	int running;
+
+	if (value == -1) {
+		pp_printf("%s = %d\n", name, *param);
+		return 0;
+	}
+
+	if (value < min || value > max) {
+		/* value out of range */
+		return -EINVAL;
+	}
+
+	running = wrc_ptp_run(-1);
+	wrc_ptp_run(0);
+	*param = value;
+	/* copy updated parameters from rt_opts */
+	bmc_apply_configured_device_attributes(ppg);
+	wrc_ptp_run(running);
+	return 0;
+}
+
+int wrc_ptp_set_prio1(int prio1)
+{
+	return assign_ptp_param("prio1", &__pp_default_rt_opts.priority1,
+				prio1, PP_MIN_PRIORITY1, PP_MAX_PRIORITY1);
+}
+
+int wrc_ptp_set_prio2(int prio2)
+{
+	return assign_ptp_param("prio2", &__pp_default_rt_opts.priority2,
+				prio2, PP_MIN_PRIORITY2, PP_MAX_PRIORITY2);
+}
+
+int wrc_ptp_set_domain_number(int domain)
+{
+	return assign_ptp_param("domain", &__pp_default_rt_opts.domainNumber,
+				domain, PP_MIN_DOMAIN_NUMBER,
+				PP_MAX_DOMAIN_NUMBER);
+}
+
+int wrc_ptp_set_clock_class(int clock_class)
+{
+	return assign_ptp_param("clock class",
+				&__pp_default_rt_opts.clock_quality_clockClass,
+				clock_class, PP_MIN_CLOCK_CLASS,
+				PP_MAX_CLOCK_CLASS);
+}
+
+int wrc_ptp_set_clock_accuracy(int clock_accuracy)
+{
+	return assign_ptp_param("clock accuracy",
+				&__pp_default_rt_opts.clock_quality_clockAccuracy,
+				clock_accuracy, PP_MIN_CLOCK_ACCURACY,
+				PP_MAX_CLOCK_ACCURACY);
+}
+
+int wrc_ptp_set_clock_allan_variance(int clock_allan_variance)
+{
+	return assign_ptp_param("clock allan variance",
+				&__pp_default_rt_opts.clock_quality_offsetScaledLogVariance,
+				clock_allan_variance, PP_MIN_CLOCK_VARIANCE,
+				PP_MAX_CLOCK_VARIANCE);
+}
+
+int wrc_ptp_set_time_source(int time_source)
+{
+	return assign_ptp_param("time source",
+				&__pp_default_rt_opts.timeSource,
+				time_source, PP_MIN_TIME_SOURCE,
+				PP_MAX_TIME_SOURCE);
+}
+
+#endif
--- a/arch-wrpc/wrpc.h
+++ b/arch-wrpc/wrpc.h
@@ -26,6 +26,13 @@ extern int ptp_mode;
 int wrc_ptp_init(void);
 int wrc_ptp_set_mode(int mode);
 int wrc_ptp_get_mode(void);
+int wrc_ptp_set_prio1(int prio1);
+int wrc_ptp_set_prio2(int prio2);
+int wrc_ptp_set_domain_number(int domain);
+int wrc_ptp_set_clock_class(int clock_class);
+int wrc_ptp_set_clock_accuracy(int clock_accuracy);
+int wrc_ptp_set_clock_allan_variance(int clock_allan_variance);
+int wrc_ptp_set_time_source(int time_source);
 int wrc_ptp_sync_mech(int e2e_p2p_qry);
 int wrc_ptp_start(void);
 int wrc_ptp_stop(void);