From e3e2b6c7954e46dd52d7abffdd37405b05f2d56a Mon Sep 17 00:00:00 2001 From: Maurizio Lombardi Date: Sun, 10 Feb 2013 23:20:02 +0100 Subject: [PATCH] add a function to get the sys clock frequency --- kernel/genarch/include/drivers/am335x/ctrl_module.h | 19 +++++++++++++++++++ 1 file changed, 19 insertions(+) diff --git a/kernel/genarch/include/drivers/am335x/ctrl_module.h b/kernel/genarch/include/drivers/am335x/ctrl_module.h index 30748b810..91b1023b4 100644 --- a/kernel/genarch/include/drivers/am335x/ctrl_module.h +++ b/kernel/genarch/include/drivers/am335x/ctrl_module.h @@ -41,6 +41,25 @@ #define AM335x_CTRL_MODULE_BASE_ADDRESS 0x44E10000 #define AM335x_CTRL_MODULE_SIZE 131072 /* 128 Kb */ +static unsigned am335x_ctrl_module_clock_freq_get(void *base) +{ + unsigned const control_status = AM335x_CTRL_MODULE_REG_ADDR(base, + CONTROL_SYSCONFIG); + unsigned const sysboot = (control_status >> 22) & 0x03; + + switch (sysboot) { + default: + case 0: + return 19200000; /* 19.2 Mhz */ + case 1: + return 24000000; /* 24 Mhz */ + case 2: + return 25000000; /* 25 Mhz */ + case 3: + return 26000000; /* 26 Mhz */ + } +} + #endif /** -- 2.11.4.GIT