arch/arm64: Modify the method for obtaining the CPU frequency

Summary:
1、cntfrq_el0 is used to store the timer frequency, which may
   be different from the CPU frequency.
2、Do not use up_perf interface for SMP.

Signed-off-by: wangming9 <wangming9@xiaomi.com>

arch/arm64/src/common/arm64_boot.c

@@ -202,6 +202,5 @@ void arm64_boot_el1_init(void)
 void arm64_boot_primary_c_routine(void)
 {
   arm64_chip_boot();
-  up_perf_init(NULL);
   nx_start();
 }

arch/arm64/src/common/arm64_cpustart.c

@@ -232,7 +232,5 @@ void arm64_boot_secondary_c_routine(void)
 
   arm64_gic_secondary_init();
 
-  up_perf_init(NULL);
-
   arm64_smp_init_top();
 }

arch/arm64/src/common/arm64_perf.c

@@ -28,12 +28,20 @@
 
 #ifdef CONFIG_ARCH_PERF_EVENTS
 
+/****************************************************************************
+ * Private Data
+ ****************************************************************************/
+
+static unsigned long g_cpu_freq = ULONG_MAX;
+
 /****************************************************************************
  * Public Functions
  ****************************************************************************/
 
 void up_perf_init(void *arg)
 {
+  g_cpu_freq = (unsigned long)(uintptr_t)arg;
+
   pmu_ccntr_ccfiltr_config(PMCCFILTR_EL0_NSH);
   pmu_cntr_control_config(PMCR_EL0_C | PMCR_EL0_E);
   pmu_cntr_trap_control(PMUSERENR_EL0_EN);
@@ -43,7 +51,7 @@ void up_perf_init(void *arg)
 
 unsigned long up_perf_getfreq(void)
 {
-  return read_sysreg(cntfrq_el0);
+  return g_cpu_freq;
 }
 
 unsigned long up_perf_gettime(void)
@@ -54,10 +62,9 @@ unsigned long up_perf_gettime(void)
 void up_perf_convert(unsigned long elapsed, struct timespec *ts)
 {
   unsigned long left;
-  unsigned long cpu_freq = read_sysreg(cntfrq_el0);
 
-  ts->tv_sec  = elapsed / cpu_freq;
-  left        = elapsed - ts->tv_sec * cpu_freq;
-  ts->tv_nsec = NSEC_PER_SEC * left / cpu_freq;
+  ts->tv_sec  = elapsed / g_cpu_freq;
+  left        = elapsed - ts->tv_sec * g_cpu_freq;
+  ts->tv_nsec = NSEC_PER_SEC * left / g_cpu_freq;
 }
 #endif

arch/arm64/src/fvp-v8r/fvp_boot.c

@@ -182,4 +182,8 @@ void arm64_chip_boot(void)
 
   arm64_earlyserialinit();
 #endif
+
+#ifdef CONFIG_ARCH_PERF_EVENTS
+  up_perf_init((void *)CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC);
+#endif
 }

arch/arm64/src/goldfish/goldfish_boot.c

@@ -170,6 +170,10 @@ void arm64_chip_boot(void)
 
   arm64_earlyserialinit();
 #endif
+
+#ifdef CONFIG_ARCH_PERF_EVENTS
+  up_perf_init((void *)CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC);
+#endif
 }
 
 #if defined(CONFIG_NET) && !defined(CONFIG_NETDEV_LATEINIT)

arch/arm64/src/imx8/imx8_boot.c

@@ -112,4 +112,8 @@ void arm64_chip_boot(void)
 
   arm64_earlyserialinit();
 #endif
+
+#ifdef CONFIG_ARCH_PERF_EVENTS
+  up_perf_init((void *)CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC);
+#endif
 }

arch/arm64/src/zynq-mpsoc/zynq_boot.c

@@ -195,6 +195,10 @@ void arm64_chip_boot(void)
 
   arm64_earlyserialinit();
 #endif
+
+#ifdef CONFIG_ARCH_PERF_EVENTS
+  up_perf_init((void *)CONFIG_SYS_CLOCK_HW_CYCLES_PER_SEC);
+#endif
 }
 
 #if defined(CONFIG_NET) && !defined(CONFIG_NETDEV_LATEINIT)