From patchwork Thu May 22 17:22:02 2014 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Abhilash Kesavan X-Patchwork-Id: 4225091 Return-Path: X-Original-To: patchwork-linux-arm@patchwork.kernel.org Delivered-To: patchwork-parsemail@patchwork2.web.kernel.org Received: from mail.kernel.org (mail.kernel.org [198.145.19.201]) by patchwork2.web.kernel.org (Postfix) with ESMTP id 9B392BF90B for ; Thu, 22 May 2014 17:27:07 +0000 (UTC) Received: from mail.kernel.org (localhost [127.0.0.1]) by mail.kernel.org (Postfix) with ESMTP id CF11C2038C for ; Thu, 22 May 2014 17:27:05 +0000 (UTC) Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.9]) (using TLSv1.2 with cipher DHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 101DB20131 for ; Thu, 22 May 2014 17:27:04 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.80.1 #2 (Red Hat Linux)) id 1WnWjG-0002z3-Dk; Thu, 22 May 2014 17:24:30 +0000 Received: from mail-pb0-x229.google.com ([2607:f8b0:400e:c01::229]) by bombadil.infradead.org with esmtps (Exim 4.80.1 #2 (Red Hat Linux)) id 1WnWhv-0001vg-Hx for linux-arm-kernel@lists.infradead.org; Thu, 22 May 2014 17:23:09 +0000 Received: by mail-pb0-f41.google.com with SMTP id uo5so2789022pbc.14 for ; Thu, 22 May 2014 10:22:46 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20120113; h=sender:from:to:cc:subject:date:message-id:in-reply-to:references; bh=RJ8pp/wxDHXRXm+F/CEB/J+f6z7vZZkf0AwyH3TfSGA=; b=Tkv1sGJoZMgupGL80hbwZ5eTiqtlmEJWL+kbHqWBgk8EA0bx12QjVu6hYGKvikmAfC 0EdneNOND/jxmj94DkglVm810KoiYSNtePBnVyJQZ/oDjxgniw1RuYdfXD4K4P2wn7TD PNFCUaBCOuMBgeAjDHu4jZn4oE+62BOkAACmcN/nfTS/rrXBIAuNHdxC7+TKKvMU4pkt bISr/ckPIFF97EQu3vjnCmo5hT/J5WtgHTKTq/xQhQslzPKd2rsls5c8His48B2WCfvm 95w5lgjErhdEstDgQxHyzBeQMAIZYY/b1Cpno9KOSD8ol9zj6mzTyYeOlgCv4uXx7lYJ zFsw== X-Received: by 10.68.170.66 with SMTP id ak2mr68699797pbc.5.1400779366128; Thu, 22 May 2014 10:22:46 -0700 (PDT) Received: from localhost.localdomain ([122.171.109.13]) by mx.google.com with ESMTPSA id cj1sm1718316pac.40.2014.05.22.10.22.42 for (version=TLSv1.2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Thu, 22 May 2014 10:22:45 -0700 (PDT) From: Abhilash Kesavan To: linux-arm-kernel@lists.infradead.org, kgene.kim@samsung.com, t.figa@samsung.com, myungjoo.ham@samsung.com, rafael.j.wysocki@intel.com, linux-pm@vger.kernel.org, devicetree@vger.kernel.org Subject: [PATCH RFC v2 7/7] PM / devfreq: Add devfreq driver for Exynos5420 Date: Thu, 22 May 2014 22:52:02 +0530 Message-Id: <1400779322-4410-8-git-send-email-a.kesavan@samsung.com> X-Mailer: git-send-email 2.0.0.rc0 In-Reply-To: <1400779322-4410-1-git-send-email-a.kesavan@samsung.com> References: <1400779322-4410-1-git-send-email-a.kesavan@samsung.com> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20140522_102307_712204_555C3DB6 X-CRM114-Status: GOOD ( 24.35 ) X-Spam-Score: 0.0 (/) Cc: kesavan.abhilash@gmail.com X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.15 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+patchwork-linux-arm=patchwork.kernel.org@lists.infradead.org X-Spam-Status: No, score=-2.4 required=5.0 tests=BAYES_00,DKIM_SIGNED, RP_MATCHES_RCVD, T_DKIM_INVALID, UNPARSEABLE_RELAY autolearn=unavailable version=3.3.1 X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on mail.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: "Arjun.K.V" Exynos5420 bus device devfreq driver monitors PPMU counters and adjusts INT domain operating frequencies and voltages. Support for 5420 has been added to the extant 5250 support. Signed-off-by: Arjun.K.V Signed-off-by: Andrew Bresticker Signed-off-by: Doug Anderson Signed-off-by: Abhilash Kesavan --- drivers/devfreq/Kconfig | 10 +- drivers/devfreq/exynos/exynos5_bus.c | 598 ++++++++++++++++++++++++++++------ 2 files changed, 508 insertions(+), 100 deletions(-) diff --git a/drivers/devfreq/Kconfig b/drivers/devfreq/Kconfig index c023c57..4e84615 100644 --- a/drivers/devfreq/Kconfig +++ b/drivers/devfreq/Kconfig @@ -80,14 +80,14 @@ config ARM_EXYNOS4_BUS_DEVFREQ (CONFIG_EXYNOS_ASV). config ARM_EXYNOS5_BUS_DEVFREQ - bool "ARM Exynos5250 Bus DEVFREQ Driver" - depends on SOC_EXYNOS5250 + bool "ARM Exynos5 Bus DEVFREQ Driver" + depends on (SOC_EXYNOS5250 || SOC_EXYNOS5420) select ARCH_HAS_OPP select DEVFREQ_GOV_SIMPLE_ONDEMAND select PM_OPP help - This adds the DEVFREQ driver for Exynos5250 bus interface (vdd_int). - It reads PPMU counters of memory controllers and adjusts the - operating frequencies and voltages with OPP support. + This adds the DEVFREQ driver for Exynos5250/5420 bus interface + (vdd_int). It reads PPMU counters of memory controllers and adjusts + the operating frequencies and voltages with OPP support. endif # PM_DEVFREQ diff --git a/drivers/devfreq/exynos/exynos5_bus.c b/drivers/devfreq/exynos/exynos5_bus.c index 1196653..7ce5b76 100644 --- a/drivers/devfreq/exynos/exynos5_bus.c +++ b/drivers/devfreq/exynos/exynos5_bus.c @@ -1,10 +1,10 @@ /* - * Copyright (c) 2012 Samsung Electronics Co., Ltd. + * Copyright (c) 2012-14 Samsung Electronics Co., Ltd. * http://www.samsung.com/ * * EXYNOS5 INT clock frequency scaling support using DEVFREQ framework * Based on work done by Jonghwan Choi - * Support for only EXYNOS5250 is present. + * Support for EXYNOS5250 and Exynos5420 is present. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as @@ -14,23 +14,28 @@ #include #include -#include #include #include #include #include -#include #include -#include #include #include -#include #include "exynos_ppmu.h" -#define MAX_SAFEVOLT 1100000 /* 1.10V */ -/* Assume that the bus is saturated if the utilization is 25% */ -#define INT_BUS_SATURATION_RATIO 25 +/* Assume that we need to bump up the level if the utilization is 10% */ +#define INT_BUS_SATURATION_RATIO 10 +#define INT_VOLT_STEP_UV 12500 + +struct exynos5_busfreq_drv_data { + int busf_type; +}; + +enum exynos5_busf_type { + TYPE_BUSF_EXYNOS5250, + TYPE_BUSF_EXYNOS5420, +}; enum int_level_idx { LV_0, @@ -41,12 +46,31 @@ enum int_level_idx { _LV_END }; -enum exynos_ppmu_list { +enum exynos5250_ppmu_list { + PPMU_DDR_C, + PPMU_DDR_L, + PPMU_DDR_R, PPMU_RIGHT, - PPMU_END, + PPMU_END_5250, +}; + +enum exynos5420_ppmu_list { + PPMU_DMC_0_1, + PPMU_DMC_1_0, + PPMU_DMC_1_1, + PPMU_END_5420, +}; + +enum int_bus_pll { + C_PLL = 0, + D_PLL, + M_PLL, + I_PLL, }; struct busfreq_data_int { + enum exynos5_busf_type type; + struct list_head list; struct device *dev; struct devfreq *devfreq; struct regulator *vdd_int; @@ -56,7 +80,11 @@ struct busfreq_data_int { struct notifier_block pm_notifier; struct mutex lock; - struct pm_qos_request int_req; + + struct clk *mout_mpll; + struct clk *mout_dpll; + struct clk *mout_cpll; + struct clk *mout_ipll; }; struct int_bus_opp_table { @@ -70,13 +98,29 @@ struct int_clk_table { unsigned long freq; }; -struct int_clk { +struct int_simple_clk { const char *clk_name; struct clk *clk; struct int_clk_table *freq_table; }; -static struct int_bus_opp_table exynos5_int_opp_table[] = { +struct int_clk_info { + unsigned int idx; + unsigned long target_freq; + enum int_bus_pll src_pll; +}; + +struct int_comp_clks { + struct list_head node; + const char *mux_clk_name; /* The parent of the div clock */ + struct clk *mux_clk; + const char *div_clk_name; + struct clk *div_clk; + struct int_clk_info *clk_info; +}; + +static struct int_bus_opp_table *exynos5_int_opp_table; +static struct int_bus_opp_table exynos5250_int_opp_table[] = { {LV_0, 266000, 1025000}, {LV_1, 200000, 1025000}, {LV_2, 160000, 1025000}, @@ -85,7 +129,16 @@ static struct int_bus_opp_table exynos5_int_opp_table[] = { {0, 0, 0}, }; -static struct int_clk_table aclk_166[] = { +static struct int_bus_opp_table exynos5420_int_opp_table[] = { + {LV_0, 400000, 1100000}, + {LV_1, 333000, 1100000}, + {LV_2, 222000, 1100000}, + {LV_3, 111000, 1100000}, + {LV_4, 83000, 1100000}, + {0, 0, 0}, +}; + +static struct int_clk_table exynos5250_aclk_166[] = { {LV_0, 167000}, {LV_1, 111000}, {LV_2, 84000}, @@ -93,7 +146,7 @@ static struct int_clk_table aclk_166[] = { {LV_4, 42000}, }; -static struct int_clk_table aclk_200[] = { +static struct int_clk_table exynos5250_aclk_200[] = { {LV_0, 200000}, {LV_1, 160000}, {LV_2, 160000}, @@ -101,7 +154,7 @@ static struct int_clk_table aclk_200[] = { {LV_4, 100000}, }; -static struct int_clk_table aclk_266[] = { +static struct int_clk_table exynos5250_aclk_266[] = { {LV_0, 267000}, {LV_1, 200000}, {LV_2, 160000}, @@ -109,7 +162,7 @@ static struct int_clk_table aclk_266[] = { {LV_4, 100000}, }; -static struct int_clk_table aclk_333[] = { +static struct int_clk_table exynos5250_aclk_333[] = { {LV_0, 333000}, {LV_1, 167000}, {LV_2, 111000}, @@ -117,7 +170,7 @@ static struct int_clk_table aclk_333[] = { {LV_4, 42000}, }; -static struct int_clk_table aclk_300_disp1[] = { +static struct int_clk_table exynos5250_aclk_300_disp1[] = { {LV_0, 267000}, {LV_1, 267000}, {LV_2, 267000}, @@ -125,7 +178,7 @@ static struct int_clk_table aclk_300_disp1[] = { {LV_4, 200000}, }; -static struct int_clk_table aclk_300_gscl[] = { +static struct int_clk_table exynos5250_aclk_300_gscl[] = { {LV_0, 267000}, {LV_1, 267000}, {LV_2, 267000}, @@ -133,27 +186,183 @@ static struct int_clk_table aclk_300_gscl[] = { {LV_4, 100000}, }; -#define EXYNOS5_INT_CLK(name, tbl) { \ +#define EXYNOS5250_INT_CLK(name, tbl) { \ .clk_name = name, \ .freq_table = tbl, \ } -static struct int_clk exynos5_int_clks[] = { - EXYNOS5_INT_CLK("aclk166_d", aclk_166), - EXYNOS5_INT_CLK("aclk200_d", aclk_200), - EXYNOS5_INT_CLK("aclk266_d", aclk_266), - EXYNOS5_INT_CLK("aclk333_d", aclk_333), - EXYNOS5_INT_CLK("aclk300_disp1_d", aclk_300_disp1), - EXYNOS5_INT_CLK("aclk300_gscl_d", aclk_300_gscl), +static struct int_simple_clk exynos5250_int_clks[] = { + EXYNOS5250_INT_CLK("aclk166_d", exynos5250_aclk_166), + EXYNOS5250_INT_CLK("aclk200_d", exynos5250_aclk_200), + EXYNOS5250_INT_CLK("aclk266_d", exynos5250_aclk_266), + EXYNOS5250_INT_CLK("aclk333_d", exynos5250_aclk_333), + EXYNOS5250_INT_CLK("aclk300_disp1_d", exynos5250_aclk_300_disp1), + EXYNOS5250_INT_CLK("aclk300_gscl_d", exynos5250_aclk_300_gscl), +}; + +static struct int_clk_info exynos5420_aclk_200_fsys[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 200000, D_PLL}, + {LV_1, 200000, D_PLL}, + {LV_2, 150000, D_PLL}, + {LV_3, 100000, D_PLL}, + {LV_4, 100000, D_PLL}, +}; + +static struct int_clk_info exynos5420_pclk_200_fsys[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 200000, D_PLL}, + {LV_1, 150000, D_PLL}, + {LV_2, 150000, D_PLL}, + {LV_3, 100000, D_PLL}, + {LV_4, 100000, D_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_100_noc[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 100000, D_PLL}, + {LV_1, 86000, D_PLL}, + {LV_2, 75000, D_PLL}, + {LV_3, 75000, D_PLL}, + {LV_4, 75000, D_PLL}, }; -static int exynos5_int_set_rate(struct busfreq_data_int *data, +static struct int_clk_info exynos5420_aclk_400_wcore[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 400000, M_PLL}, + {LV_1, 333000, C_PLL}, + {LV_2, 333000, C_PLL}, + {LV_3, 333000, C_PLL}, + {LV_4, 333000, C_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_200_fsys2[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 200000, D_PLL}, + {LV_1, 200000, D_PLL}, + {LV_2, 150000, D_PLL}, + {LV_3, 100000, D_PLL}, + {LV_4, 100000, D_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_400_mscl[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 400000, M_PLL}, + {LV_1, 333000, C_PLL}, + {LV_2, 222000, C_PLL}, + {LV_3, 167000, C_PLL}, + {LV_4, 84000, C_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_166[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 167000, C_PLL}, + {LV_1, 134000, C_PLL}, + {LV_2, 111000, C_PLL}, + {LV_3, 84000, C_PLL}, + {LV_4, 84000, C_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_266[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 267000, M_PLL}, + {LV_1, 160000, M_PLL}, + {LV_2, 134000, M_PLL}, + {LV_3, 134000, M_PLL}, + {LV_4, 86000, D_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_66[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 67000, C_PLL}, + {LV_1, 67000, C_PLL}, + {LV_2, 67000, C_PLL}, + {LV_3, 67000, C_PLL}, + {LV_4, 67000, C_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_300_disp1[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 200000, D_PLL}, + {LV_1, 200000, D_PLL}, + {LV_2, 200000, D_PLL}, + {LV_3, 200000, D_PLL}, + {LV_4, 120000, D_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_400_disp1[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 300000, D_PLL}, + {LV_1, 300000, D_PLL}, + {LV_2, 200000, D_PLL}, + {LV_3, 200000, D_PLL}, + {LV_4, 120000, D_PLL}, +}; + +static struct int_clk_info exynos5420_aclk_300_jpeg[] = { + /* Level, Freq, Parent_Pll */ + {LV_0, 300000, D_PLL}, + {LV_1, 300000, D_PLL}, + {LV_2, 200000, D_PLL}, + {LV_3, 150000, D_PLL}, + {LV_4, 75000, D_PLL}, +}; + +#define EXYNOS5420_INT_PM_CLK(NAME, CLK, PCLK, CLK_INFO) \ +static struct int_comp_clks int_pm_clks_##NAME = { \ + .mux_clk_name = CLK, \ + .div_clk_name = PCLK, \ + .clk_info = CLK_INFO, \ +} + +EXYNOS5420_INT_PM_CLK(aclk_200_fsys, "aclk200_fsys", + "aclk200_fsys_d", exynos5420_aclk_200_fsys); +EXYNOS5420_INT_PM_CLK(pclk_200_fsys, "pclk200_fsys", + "pclk200_fsys_d", exynos5420_pclk_200_fsys); +EXYNOS5420_INT_PM_CLK(aclk_100_noc, "aclk100_noc", + "aclk100_noc_d", exynos5420_aclk_100_noc); +EXYNOS5420_INT_PM_CLK(aclk_400_wcore, "aclk400_wcore", + "aclk400_wcore_d", exynos5420_aclk_400_wcore); +EXYNOS5420_INT_PM_CLK(aclk_200_fsys2, "aclk200_fsys2", + "aclk200_fsys2_d", exynos5420_aclk_200_fsys2); +EXYNOS5420_INT_PM_CLK(aclk_400_mscl, "aclk400_mscl", + "aclk400_mscl_d", exynos5420_aclk_400_mscl); +EXYNOS5420_INT_PM_CLK(aclk_166, "aclk166", + "aclk166_d", exynos5420_aclk_166); +EXYNOS5420_INT_PM_CLK(aclk_266, "aclk266", + "aclk266_d", exynos5420_aclk_266); +EXYNOS5420_INT_PM_CLK(aclk_66, "aclk66", + "aclk66_d", exynos5420_aclk_66); +EXYNOS5420_INT_PM_CLK(aclk_300_disp1, "aclk300_disp1", + "aclk300_disp1_d", exynos5420_aclk_300_disp1); +EXYNOS5420_INT_PM_CLK(aclk_300_jpeg, "aclk300_jpeg", + "aclk300_jpeg_d", exynos5420_aclk_300_jpeg); +EXYNOS5420_INT_PM_CLK(aclk_400_disp1, "aclk400_disp1", + "aclk400_disp1_d", exynos5420_aclk_400_disp1); + +static struct int_comp_clks *exynos5420_int_pm_clks[] = { + &int_pm_clks_aclk_200_fsys, + &int_pm_clks_pclk_200_fsys, + &int_pm_clks_aclk_100_noc, + &int_pm_clks_aclk_400_wcore, + &int_pm_clks_aclk_200_fsys2, + &int_pm_clks_aclk_400_mscl, + &int_pm_clks_aclk_166, + &int_pm_clks_aclk_266, + &int_pm_clks_aclk_66, + &int_pm_clks_aclk_300_disp1, + &int_pm_clks_aclk_300_jpeg, + &int_pm_clks_aclk_400_disp1, + NULL, +}; + +static int exynos5250_int_set_rate(struct busfreq_data_int *data, unsigned long rate) { int index, i; - for (index = 0; index < ARRAY_SIZE(exynos5_int_opp_table); index++) { - if (exynos5_int_opp_table[index].clk == rate) + for (index = 0; index < ARRAY_SIZE(exynos5250_int_opp_table); index++) { + if (exynos5250_int_opp_table[index].clk == rate) break; } @@ -161,8 +370,8 @@ static int exynos5_int_set_rate(struct busfreq_data_int *data, return -EINVAL; /* Change the system clock divider values */ - for (i = 0; i < ARRAY_SIZE(exynos5_int_clks); i++) { - struct int_clk *clk_info = &exynos5_int_clks[i]; + for (i = 0; i < ARRAY_SIZE(exynos5250_int_clks); i++) { + struct int_simple_clk *clk_info = &exynos5250_int_clks[i]; int ret; ret = clk_set_rate(clk_info->clk, @@ -177,10 +386,111 @@ static int exynos5_int_set_rate(struct busfreq_data_int *data, return 0; } +static struct clk *exynos5420_find_pll(struct busfreq_data_int *data, + enum int_bus_pll target_pll) +{ + struct clk *target_src_clk = NULL; + + switch (target_pll) { + case C_PLL: + target_src_clk = data->mout_cpll; + break; + case M_PLL: + target_src_clk = data->mout_mpll; + break; + case D_PLL: + target_src_clk = data->mout_dpll; + break; + case I_PLL: + target_src_clk = data->mout_ipll; + break; + default: + break; + } + + return target_src_clk; +} + +static int exynos5420_int_set_rate(struct busfreq_data_int *data, + unsigned long target_freq, unsigned long pre_freq) +{ + unsigned int i; + unsigned long tar_rate; + int target_idx = -EINVAL; + int pre_idx = -EINVAL; + struct int_comp_clks *int_clk; + struct clk *new_src_pll; + struct clk *old_src_pll; + unsigned long old_src_rate, new_src_rate; + unsigned long rate1, rate2, rate3, rate4; + + /* Find the levels for target and previous frequencies */ + for (i = 0; i < _LV_END; i++) { + if (exynos5420_int_opp_table[i].clk == target_freq) + target_idx = exynos5420_int_opp_table[i].idx; + if (exynos5420_int_opp_table[i].clk == pre_freq) + pre_idx = exynos5420_int_opp_table[i].idx; + } + + list_for_each_entry(int_clk, &data->list, node) { + tar_rate = int_clk->clk_info[target_idx].target_freq * 1000; + + old_src_pll = clk_get_parent(int_clk->mux_clk); + new_src_pll = exynos5420_find_pll(data, + int_clk->clk_info[target_idx].src_pll); + + if (old_src_pll == new_src_pll) { + /* No need to change pll */ + clk_set_rate(int_clk->div_clk, tar_rate); + pr_debug("%s: %s now %lu (%lu)\n", __func__, + int_clk->mux_clk_name, + clk_get_rate(int_clk->div_clk), tar_rate); + continue; + } + + old_src_rate = clk_get_rate(old_src_pll); + new_src_rate = clk_get_rate(new_src_pll); + rate1 = clk_get_rate(int_clk->div_clk); + + /* + * If we're switching to a faster PLL we should bump up the + * divider before switching. + */ + if (new_src_rate > old_src_rate) { + int new_div; + unsigned long tmp_rate; + + new_div = DIV_ROUND_UP(new_src_rate, tar_rate); + tmp_rate = DIV_ROUND_UP(old_src_rate, new_div); + clk_set_rate(int_clk->div_clk, tmp_rate); + } + rate2 = clk_get_rate(int_clk->div_clk); + + /* We can safely change the mux now */ + clk_set_parent(int_clk->mux_clk, new_src_pll); + rate3 = clk_get_rate(int_clk->div_clk); + + /* + * Give us a proper divider; technically not needed in the case + * where we pre-calculated the divider above (the new_src_rate > + * old_src_rate case), but let's be formal about it. + */ + clk_set_rate(int_clk->div_clk, tar_rate); + rate4 = clk_get_rate(int_clk->div_clk); + + pr_debug("%s: %s => PLL %d; %lu=>%lu=>%lu=>%lu (%lu)\n", + __func__, int_clk->mux_clk_name, + int_clk->clk_info[target_idx].src_pll, + rate1, rate2, rate3, rate4, tar_rate); + } + return 0; +} + static int exynos5_int_setvolt(struct busfreq_data_int *data, unsigned long volt) { - return regulator_set_voltage(data->vdd_int, volt, MAX_SAFEVOLT); + return regulator_set_voltage(data->vdd_int, volt, + volt + INT_VOLT_STEP_UV); } static int exynos5_busfreq_int_target(struct device *dev, unsigned long *_freq, @@ -218,18 +528,15 @@ static int exynos5_busfreq_int_target(struct device *dev, unsigned long *_freq, if (data->disabled) goto out; - if (freq > exynos5_int_opp_table[0].clk) - pm_qos_update_request(&data->int_req, freq * 16 / 1000); - else - pm_qos_update_request(&data->int_req, -1); - if (old_freq < freq) err = exynos5_int_setvolt(data, volt); if (err) goto out; - err = exynos5_int_set_rate(data, freq); - + if (data->type == TYPE_BUSF_EXYNOS5250) + err = exynos5250_int_set_rate(data, freq); + else + err = exynos5420_int_set_rate(data, freq, old_freq); if (err) goto out; @@ -267,16 +574,20 @@ static int exynos5_int_get_dev_status(struct device *dev, } static struct devfreq_dev_profile exynos5_devfreq_int_profile = { - .initial_freq = 160000, - .polling_ms = 100, + .polling_ms = 10, .target = exynos5_busfreq_int_target, .get_dev_status = exynos5_int_get_dev_status, }; -static int exynos5250_init_int_tables(struct busfreq_data_int *data) +static int exynos5_init_int_tables(struct busfreq_data_int *data) { int i, err = 0; + if (data->type == TYPE_BUSF_EXYNOS5250) + exynos5_int_opp_table = exynos5250_int_opp_table; + else + exynos5_int_opp_table = exynos5420_int_opp_table; + for (i = LV_0; i < _LV_END; i++) { err = dev_pm_opp_add(data->dev, exynos5_int_opp_table[i].clk, exynos5_int_opp_table[i].volt); @@ -297,6 +608,7 @@ static int exynos5_busfreq_int_pm_notifier_event(struct notifier_block *this, struct dev_pm_opp *opp; unsigned long maxfreq = ULONG_MAX; unsigned long freq; + unsigned long old_freq; unsigned long volt; int err = 0; @@ -322,8 +634,14 @@ static int exynos5_busfreq_int_pm_notifier_event(struct notifier_block *this, if (err) goto unlock; - err = exynos5_int_set_rate(data, freq); + old_freq = data->curr_freq; + if (data->type == TYPE_BUSF_EXYNOS5250) + err = exynos5250_int_set_rate(data, freq); + else if (data->type == TYPE_BUSF_EXYNOS5420) + err = exynos5420_int_set_rate(data, freq, old_freq); + else + err = -EINVAL; if (err) goto unlock; @@ -345,16 +663,38 @@ unlock: return NOTIFY_DONE; } +static const struct of_device_id exynos5_busfreq_dt_match[]; + +static inline int exynos5_busfreq_get_driver_data(struct platform_device *pdev) +{ +#ifdef CONFIG_OF + struct exynos5_busfreq_drv_data *data; + + if (pdev->dev.of_node) { + const struct of_device_id *match; + + match = of_match_node(exynos5_busfreq_dt_match, + pdev->dev.of_node); + data = (struct exynos5_busfreq_drv_data *) match->data; + return data->busf_type; + } +#endif + return platform_get_device_id(pdev)->driver_data; +} + static int exynos5_busfreq_int_probe(struct platform_device *pdev) { struct busfreq_data_int *data; struct busfreq_ppmu_data *ppmu_data; + struct device_node *np = pdev->dev.of_node; struct dev_pm_opp *opp; struct device *dev = &pdev->dev; - struct device_node *np; unsigned long initial_freq; unsigned long initial_volt; + struct clk *mux_clk, *div_clk; + struct int_comp_clks *int_pm_clk; int err = 0; + int nr_clk; int i; data = devm_kzalloc(&pdev->dev, sizeof(struct busfreq_data_int), @@ -364,22 +704,27 @@ static int exynos5_busfreq_int_probe(struct platform_device *pdev) return -ENOMEM; } + INIT_LIST_HEAD(&data->list); + data->type = exynos5_busfreq_get_driver_data(pdev); + ppmu_data = &data->ppmu_data; - ppmu_data->ppmu_end = PPMU_END; + if (data->type == TYPE_BUSF_EXYNOS5250) { + ppmu_data->ppmu_end = PPMU_END_5250; + } else if (data->type == TYPE_BUSF_EXYNOS5420) { + ppmu_data->ppmu_end = PPMU_END_5420; + } else { + dev_err(dev, "Cannot determine the device id %d\n", data->type); + return -EINVAL; + } + ppmu_data->ppmu = devm_kzalloc(dev, - sizeof(struct exynos_ppmu) * PPMU_END, - GFP_KERNEL); + sizeof(struct exynos_ppmu) * (ppmu_data->ppmu_end), + GFP_KERNEL); if (!ppmu_data->ppmu) { dev_err(dev, "Failed to allocate memory for exynos_ppmu\n"); return -ENOMEM; } - np = of_find_compatible_node(NULL, NULL, "samsung,exynos5250-ppmu"); - if (np == NULL) { - pr_err("Unable to find PPMU node\n"); - return -ENOENT; - } - for (i = 0; i < ppmu_data->ppmu_end; i++) { /* map PPMU memory region */ ppmu_data->ppmu[i].hw_base = of_iomap(np, i); @@ -388,13 +733,17 @@ static int exynos5_busfreq_int_probe(struct platform_device *pdev) return -ENOMEM; } } + data->pm_notifier.notifier_call = exynos5_busfreq_int_pm_notifier_event; data->dev = dev; mutex_init(&data->lock); - err = exynos5250_init_int_tables(data); - if (err) + err = exynos5_init_int_tables(data); + if (err) { + dev_err(dev, "Cannot initialize busfreq table %d\n", + data->type); return err; + } data->vdd_int = devm_regulator_get(dev, "vdd_int"); if (IS_ERR(data->vdd_int)) { @@ -402,18 +751,70 @@ static int exynos5_busfreq_int_probe(struct platform_device *pdev) return PTR_ERR(data->vdd_int); } - for (i = 0; i < ARRAY_SIZE(exynos5_int_clks); i++) { - struct int_clk *clk_info = &exynos5_int_clks[i]; + if (data->type == TYPE_BUSF_EXYNOS5250) { + for (i = 0; i < ARRAY_SIZE(exynos5250_int_clks); i++) { + struct int_simple_clk *clk_info = + &exynos5250_int_clks[i]; + + clk_info->clk = devm_clk_get(dev, clk_info->clk_name); + if (IS_ERR(clk_info->clk)) { + dev_err(dev, "Failed to get clock %s\n", + clk_info->clk_name); + return PTR_ERR(clk_info->clk); + } + } + } else { + data->mout_ipll = devm_clk_get(dev, "mout_ipll"); + if (IS_ERR(data->mout_ipll)) { + dev_err(dev, "Cannot get clock \"mout_ipll\"\n"); + return PTR_ERR(data->mout_ipll); + } - clk_info->clk = devm_clk_get(dev, clk_info->clk_name); - if (IS_ERR(clk_info->clk)) { - dev_err(dev, "Failed to get clock %s\n", - clk_info->clk_name); - return PTR_ERR(clk_info->clk); + data->mout_mpll = devm_clk_get(dev, "mout_mpll"); + if (IS_ERR(data->mout_mpll)) { + dev_err(dev, "Cannot get clock \"mout_mpll\"\n"); + return PTR_ERR(data->mout_mpll); + } + + data->mout_dpll = devm_clk_get(dev, "mout_dpll"); + if (IS_ERR(data->mout_dpll)) { + dev_err(dev, "Cannot get clock \"mout_dpll\"\n"); + return PTR_ERR(data->mout_dpll); + } + + data->mout_cpll = devm_clk_get(dev, "mout_cpll"); + if (IS_ERR(data->mout_cpll)) { + dev_err(dev, "Cannot get clock \"mout_cpll\"\n"); + return PTR_ERR(data->mout_cpll); + } + + for (nr_clk = 0; exynos5420_int_pm_clks[nr_clk] != NULL; + nr_clk++) { + int_pm_clk = exynos5420_int_pm_clks[nr_clk]; + mux_clk = devm_clk_get(dev, int_pm_clk->mux_clk_name); + if (IS_ERR(mux_clk)) { + dev_err(dev, "Cannot get mux clock: %s\n", + int_pm_clk->mux_clk_name); + return PTR_ERR(mux_clk); + } + div_clk = devm_clk_get(dev, int_pm_clk->div_clk_name); + if (IS_ERR(div_clk)) { + dev_err(dev, "Cannot get div clock: %s\n", + int_pm_clk->div_clk_name); + return PTR_ERR(div_clk); + } + int_pm_clk->mux_clk = mux_clk; + int_pm_clk->div_clk = div_clk; + list_add_tail(&int_pm_clk->node, &data->list); } } rcu_read_lock(); + if (data->type == TYPE_BUSF_EXYNOS5250) + exynos5_devfreq_int_profile.initial_freq = 160000; + else + exynos5_devfreq_int_profile.initial_freq = 333000; + opp = dev_pm_opp_find_freq_floor(dev, &exynos5_devfreq_int_profile.initial_freq); if (IS_ERR(opp)) { @@ -428,10 +829,15 @@ static int exynos5_busfreq_int_probe(struct platform_device *pdev) data->curr_freq = initial_freq; err = exynos5_int_setvolt(data, initial_volt); - if (err) + if (err) { + dev_err(dev, "Failed to set initial voltage\n"); return err; + } - err = exynos5_int_set_rate(data, initial_freq); + if (data->type == TYPE_BUSF_EXYNOS5250) + err = exynos5250_int_set_rate(data, initial_freq); + else + err = exynos5420_int_set_rate(data, initial_freq, initial_freq); if (err) { dev_err(dev, "Failed to set initial frequency\n"); return err; @@ -439,28 +845,31 @@ static int exynos5_busfreq_int_probe(struct platform_device *pdev) platform_set_drvdata(pdev, data); - busfreq_mon_reset(ppmu_data); - - data->devfreq = devm_devfreq_add_device(dev, &exynos5_devfreq_int_profile, - "simple_ondemand", NULL); + data->devfreq = devm_devfreq_add_device(dev, + &exynos5_devfreq_int_profile, "simple_ondemand", NULL); if (IS_ERR(data->devfreq)) return PTR_ERR(data->devfreq); + /* + * Start PPMU (Performance Profiling Monitoring Unit) to check + * utilization of each IP in the Exynos4 SoC. + */ + busfreq_mon_reset(ppmu_data); + + /* Register opp_notifier for Exynos5 busfreq */ err = devm_devfreq_register_opp_notifier(dev, data->devfreq); if (err < 0) { dev_err(dev, "Failed to register opp notifier\n"); return err; } + /* Register pm_notifier for Exynos5 busfreq */ err = register_pm_notifier(&data->pm_notifier); if (err) { dev_err(dev, "Failed to setup pm notifier\n"); return err; } - /* TODO: Add a new QOS class for int/mif bus */ - pm_qos_add_request(&data->int_req, PM_QOS_NETWORK_THROUGHPUT, -1); - return 0; } @@ -468,7 +877,7 @@ static int exynos5_busfreq_int_remove(struct platform_device *pdev) { struct busfreq_data_int *data = platform_get_drvdata(pdev); - pm_qos_remove_request(&data->int_req); + /* Unregister all of notifier chain */ unregister_pm_notifier(&data->pm_notifier); return 0; @@ -492,8 +901,24 @@ static const struct dev_pm_ops exynos5_busfreq_int_pm = { static SIMPLE_DEV_PM_OPS(exynos5_busfreq_int_pm_ops, NULL, exynos5_busfreq_int_resume); -/* platform device pointer for exynos5 devfreq device. */ -static struct platform_device *exynos5_devfreq_pdev; +#ifdef CONFIG_OF +static struct exynos5_busfreq_drv_data exynos_busfreq_data_array[] = { + [TYPE_BUSF_EXYNOS5250] = { TYPE_BUSF_EXYNOS5250 }, + [TYPE_BUSF_EXYNOS5420] = { TYPE_BUSF_EXYNOS5420 }, +}; + +static const struct of_device_id exynos5_busfreq_dt_match[] = { + { + .compatible = "samsung,exynos5250-int-busfreq", + .data = &exynos_busfreq_data_array[TYPE_BUSF_EXYNOS5250], + }, { + .compatible = "samsung,exynos5420-int-busfreq", + .data = &exynos_busfreq_data_array[TYPE_BUSF_EXYNOS5420], + }, + {}, +}; +MODULE_DEVICE_TABLE(of, exynos5_busfreq_dt_match); +#endif static struct platform_driver exynos5_busfreq_int_driver = { .probe = exynos5_busfreq_int_probe, @@ -502,35 +927,18 @@ static struct platform_driver exynos5_busfreq_int_driver = { .name = "exynos5-bus-int", .owner = THIS_MODULE, .pm = &exynos5_busfreq_int_pm_ops, + .of_match_table = of_match_ptr(exynos5_busfreq_dt_match), }, }; static int __init exynos5_busfreq_int_init(void) { - int ret; - - ret = platform_driver_register(&exynos5_busfreq_int_driver); - if (ret < 0) - goto out; - - exynos5_devfreq_pdev = - platform_device_register_simple("exynos5-bus-int", -1, NULL, 0); - if (IS_ERR(exynos5_devfreq_pdev)) { - ret = PTR_ERR(exynos5_devfreq_pdev); - goto out1; - } - - return 0; -out1: - platform_driver_unregister(&exynos5_busfreq_int_driver); -out: - return ret; + return platform_driver_register(&exynos5_busfreq_int_driver); } late_initcall(exynos5_busfreq_int_init); static void __exit exynos5_busfreq_int_exit(void) { - platform_device_unregister(exynos5_devfreq_pdev); platform_driver_unregister(&exynos5_busfreq_int_driver); } module_exit(exynos5_busfreq_int_exit);