Scale with SYSCLKDIV in McuE_GetSystemClock for mpc551x

diff --git a/arch/ppc/mpc55xx/drivers/Mcu.c b/arch/ppc/mpc55xx/drivers/Mcu.c
index 0b1db9a3f598f5c119e195842a49d204c72c4488..6bb7755e28768b4e3e506c09c260d790dd484b13 100644 (file)
--- a/arch/ppc/mpc55xx/drivers/Mcu.c
+++ b/arch/ppc/mpc55xx/drivers/Mcu.c
@@ -520,6 +520,14 @@ uint32_t McuE_GetSystemClock(void)
 \r
   f_sys =  CALC_SYSTEM_CLOCK(extal,emfd,eprediv,erfd);\r
 \r
+#if defined(CFG_MPC5516)\r
+  // Scale according to SYSCLKDIV to get "System Clock". See RM Figure 3-1\r
+  uint32_t sysclkdiv = SIU.SYSCLK.B.SYSCLKDIV;\r
+  f_sys = f_sys / (1 << sysclkdiv);\r
+#elif defined(CFG_MPC5554) || defined(CFG_MPC5567) || defined(CFG_MPC5633)\r
+  // TODO: Do these CPUs have an equvalent?\r
+#endif\r
+\r
   return f_sys;\r
 }\r
 \r