127 lines
3.2 KiB
C
127 lines
3.2 KiB
C
/* Copyright (c) 2013-2014, The Linux Foundation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 and
|
|
* only version 2 as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/cpu.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
|
|
struct boot_stats {
|
|
uint32_t bootloader_start;
|
|
uint32_t bootloader_end;
|
|
uint32_t bootloader_display;
|
|
uint32_t bootloader_load_kernel;
|
|
};
|
|
|
|
#if defined(CONFIG_SEC_BSP)
|
|
uint32_t bootloader_start;
|
|
uint32_t bootloader_end;
|
|
uint32_t bootloader_display;
|
|
uint32_t bootloader_load_kernel;
|
|
#endif
|
|
|
|
static void __iomem *mpm_counter_base;
|
|
static uint32_t mpm_counter_freq;
|
|
static struct boot_stats __iomem *boot_stats;
|
|
|
|
static int mpm_parse_dt(void)
|
|
{
|
|
struct device_node *np;
|
|
u32 freq;
|
|
|
|
np = of_find_compatible_node(NULL, NULL, "qcom,msm-imem-boot_stats");
|
|
if (!np) {
|
|
pr_err("can't find qcom,msm-imem node\n");
|
|
return -ENODEV;
|
|
}
|
|
boot_stats = of_iomap(np, 0);
|
|
if (!boot_stats) {
|
|
pr_err("boot_stats: Can't map imem\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
np = of_find_compatible_node(NULL, NULL, "qcom,mpm2-sleep-counter");
|
|
if (!np) {
|
|
pr_err("mpm_counter: can't find DT node\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
if (!of_property_read_u32(np, "clock-frequency", &freq))
|
|
mpm_counter_freq = freq;
|
|
else
|
|
return -ENODEV;
|
|
|
|
if (of_get_address(np, 0, NULL, NULL)) {
|
|
mpm_counter_base = of_iomap(np, 0);
|
|
if (!mpm_counter_base) {
|
|
pr_err("mpm_counter: cant map counter base\n");
|
|
return -ENODEV;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void print_boot_stats(void)
|
|
{
|
|
#if defined(CONFIG_SEC_BSP)
|
|
bootloader_start = readl_relaxed(&boot_stats->bootloader_start);
|
|
bootloader_end = readl_relaxed(&boot_stats->bootloader_end);
|
|
bootloader_display = readl_relaxed(&boot_stats->bootloader_display);
|
|
bootloader_load_kernel = readl_relaxed(&boot_stats->bootloader_load_kernel);
|
|
#endif
|
|
pr_info("KPI: Bootloader start count = %u\n",
|
|
readl_relaxed(&boot_stats->bootloader_start));
|
|
pr_info("KPI: Bootloader end count = %u\n",
|
|
readl_relaxed(&boot_stats->bootloader_end));
|
|
pr_info("KPI: Bootloader display count = %u\n",
|
|
readl_relaxed(&boot_stats->bootloader_display));
|
|
pr_info("KPI: Bootloader load kernel count = %u\n",
|
|
readl_relaxed(&boot_stats->bootloader_load_kernel));
|
|
pr_info("KPI: Kernel MPM timestamp = %u\n",
|
|
readl_relaxed(mpm_counter_base));
|
|
pr_info("KPI: Kernel MPM Clock frequency = %u\n",
|
|
mpm_counter_freq);
|
|
}
|
|
|
|
#if defined(CONFIG_SEC_BSP)
|
|
unsigned int get_boot_stat_time(void)
|
|
{
|
|
return readl_relaxed(mpm_counter_base);
|
|
}
|
|
#endif
|
|
|
|
int boot_stats_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = mpm_parse_dt();
|
|
if (ret < 0)
|
|
return -ENODEV;
|
|
|
|
print_boot_stats();
|
|
|
|
iounmap(boot_stats);
|
|
#if !defined(CONFIG_SEC_BSP)
|
|
iounmap(mpm_counter_base);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|