19e05bbacSSakari Ailus // SPDX-License-Identifier: GPL-2.0-only 29e05bbacSSakari Ailus /* 39e05bbacSSakari Ailus * drivers/media/i2c/ccs-pll.c 49e05bbacSSakari Ailus * 59e05bbacSSakari Ailus * Generic MIPI CCS/SMIA/SMIA++ PLL calculator 69e05bbacSSakari Ailus * 79e05bbacSSakari Ailus * Copyright (C) 2020 Intel Corporation 89e05bbacSSakari Ailus * Copyright (C) 2011--2012 Nokia Corporation 97389d01cSSakari Ailus * Contact: Sakari Ailus <sakari.ailus@linux.intel.com> 109e05bbacSSakari Ailus */ 119e05bbacSSakari Ailus 129e05bbacSSakari Ailus #include <linux/device.h> 139e05bbacSSakari Ailus #include <linux/gcd.h> 149e05bbacSSakari Ailus #include <linux/lcm.h> 159e05bbacSSakari Ailus #include <linux/module.h> 169e05bbacSSakari Ailus 179e05bbacSSakari Ailus #include "ccs-pll.h" 189e05bbacSSakari Ailus 199e05bbacSSakari Ailus /* Return an even number or one. */ 209e05bbacSSakari Ailus static inline uint32_t clk_div_even(uint32_t a) 219e05bbacSSakari Ailus { 229e05bbacSSakari Ailus return max_t(uint32_t, 1, a & ~1); 239e05bbacSSakari Ailus } 249e05bbacSSakari Ailus 259e05bbacSSakari Ailus /* Return an even number or one. */ 269e05bbacSSakari Ailus static inline uint32_t clk_div_even_up(uint32_t a) 279e05bbacSSakari Ailus { 289e05bbacSSakari Ailus if (a == 1) 299e05bbacSSakari Ailus return 1; 309e05bbacSSakari Ailus return (a + 1) & ~1; 319e05bbacSSakari Ailus } 329e05bbacSSakari Ailus 339e05bbacSSakari Ailus static inline uint32_t is_one_or_even(uint32_t a) 349e05bbacSSakari Ailus { 359e05bbacSSakari Ailus if (a == 1) 369e05bbacSSakari Ailus return 1; 379e05bbacSSakari Ailus if (a & 1) 389e05bbacSSakari Ailus return 0; 399e05bbacSSakari Ailus 409e05bbacSSakari Ailus return 1; 419e05bbacSSakari Ailus } 429e05bbacSSakari Ailus 43482e75e7SSakari Ailus static inline uint32_t one_or_more(uint32_t a) 44482e75e7SSakari Ailus { 45482e75e7SSakari Ailus return a ?: 1; 46482e75e7SSakari Ailus } 47482e75e7SSakari Ailus 489e05bbacSSakari Ailus static int bounds_check(struct device *dev, uint32_t val, 499e05bbacSSakari Ailus uint32_t min, uint32_t max, char *str) 509e05bbacSSakari Ailus { 519e05bbacSSakari Ailus if (val >= min && val <= max) 529e05bbacSSakari Ailus return 0; 539e05bbacSSakari Ailus 549e05bbacSSakari Ailus dev_dbg(dev, "%s out of bounds: %d (%d--%d)\n", str, val, min, max); 559e05bbacSSakari Ailus 569e05bbacSSakari Ailus return -EINVAL; 579e05bbacSSakari Ailus } 589e05bbacSSakari Ailus 599e05bbacSSakari Ailus static void print_pll(struct device *dev, struct ccs_pll *pll) 609e05bbacSSakari Ailus { 61415ddd99SSakari Ailus dev_dbg(dev, "pre_pll_clk_div\t%u\n", pll->vt_fr.pre_pll_clk_div); 62415ddd99SSakari Ailus dev_dbg(dev, "pll_multiplier \t%u\n", pll->vt_fr.pll_multiplier); 639e05bbacSSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS)) { 64415ddd99SSakari Ailus dev_dbg(dev, "op_sys_clk_div \t%u\n", pll->op_bk.sys_clk_div); 65415ddd99SSakari Ailus dev_dbg(dev, "op_pix_clk_div \t%u\n", pll->op_bk.pix_clk_div); 669e05bbacSSakari Ailus } 67415ddd99SSakari Ailus dev_dbg(dev, "vt_sys_clk_div \t%u\n", pll->vt_bk.sys_clk_div); 68415ddd99SSakari Ailus dev_dbg(dev, "vt_pix_clk_div \t%u\n", pll->vt_bk.pix_clk_div); 699e05bbacSSakari Ailus 709e05bbacSSakari Ailus dev_dbg(dev, "ext_clk_freq_hz \t%u\n", pll->ext_clk_freq_hz); 71415ddd99SSakari Ailus dev_dbg(dev, "pll_ip_clk_freq_hz \t%u\n", pll->vt_fr.pll_ip_clk_freq_hz); 72415ddd99SSakari Ailus dev_dbg(dev, "pll_op_clk_freq_hz \t%u\n", pll->vt_fr.pll_op_clk_freq_hz); 739e05bbacSSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS)) { 749e05bbacSSakari Ailus dev_dbg(dev, "op_sys_clk_freq_hz \t%u\n", 75415ddd99SSakari Ailus pll->op_bk.sys_clk_freq_hz); 769e05bbacSSakari Ailus dev_dbg(dev, "op_pix_clk_freq_hz \t%u\n", 77415ddd99SSakari Ailus pll->op_bk.pix_clk_freq_hz); 789e05bbacSSakari Ailus } 79415ddd99SSakari Ailus dev_dbg(dev, "vt_sys_clk_freq_hz \t%u\n", pll->vt_bk.sys_clk_freq_hz); 80415ddd99SSakari Ailus dev_dbg(dev, "vt_pix_clk_freq_hz \t%u\n", pll->vt_bk.pix_clk_freq_hz); 819e05bbacSSakari Ailus } 829e05bbacSSakari Ailus 839e05bbacSSakari Ailus static int check_all_bounds(struct device *dev, 84415ddd99SSakari Ailus const struct ccs_pll_limits *lim, 85415ddd99SSakari Ailus const struct ccs_pll_branch_limits_fr *op_lim_fr, 86415ddd99SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk, 87415ddd99SSakari Ailus struct ccs_pll *pll, 88415ddd99SSakari Ailus struct ccs_pll_branch_fr *op_pll_fr, 89415ddd99SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk) 909e05bbacSSakari Ailus { 919e05bbacSSakari Ailus int rval; 929e05bbacSSakari Ailus 93415ddd99SSakari Ailus rval = bounds_check(dev, op_pll_fr->pll_ip_clk_freq_hz, 94415ddd99SSakari Ailus op_lim_fr->min_pll_ip_clk_freq_hz, 95415ddd99SSakari Ailus op_lim_fr->max_pll_ip_clk_freq_hz, 969e05bbacSSakari Ailus "pll_ip_clk_freq_hz"); 979e05bbacSSakari Ailus if (!rval) 989e05bbacSSakari Ailus rval = bounds_check( 99415ddd99SSakari Ailus dev, op_pll_fr->pll_multiplier, 100415ddd99SSakari Ailus op_lim_fr->min_pll_multiplier, 101415ddd99SSakari Ailus op_lim_fr->max_pll_multiplier, "pll_multiplier"); 1029e05bbacSSakari Ailus if (!rval) 1039e05bbacSSakari Ailus rval = bounds_check( 104415ddd99SSakari Ailus dev, op_pll_fr->pll_op_clk_freq_hz, 105415ddd99SSakari Ailus op_lim_fr->min_pll_op_clk_freq_hz, 106415ddd99SSakari Ailus op_lim_fr->max_pll_op_clk_freq_hz, "pll_op_clk_freq_hz"); 1079e05bbacSSakari Ailus if (!rval) 1089e05bbacSSakari Ailus rval = bounds_check( 109415ddd99SSakari Ailus dev, op_pll_bk->sys_clk_div, 110415ddd99SSakari Ailus op_lim_bk->min_sys_clk_div, op_lim_bk->max_sys_clk_div, 1119e05bbacSSakari Ailus "op_sys_clk_div"); 1129e05bbacSSakari Ailus if (!rval) 1139e05bbacSSakari Ailus rval = bounds_check( 114415ddd99SSakari Ailus dev, op_pll_bk->sys_clk_freq_hz, 115415ddd99SSakari Ailus op_lim_bk->min_sys_clk_freq_hz, 116415ddd99SSakari Ailus op_lim_bk->max_sys_clk_freq_hz, 1179e05bbacSSakari Ailus "op_sys_clk_freq_hz"); 1189e05bbacSSakari Ailus if (!rval) 1199e05bbacSSakari Ailus rval = bounds_check( 120415ddd99SSakari Ailus dev, op_pll_bk->pix_clk_freq_hz, 121415ddd99SSakari Ailus op_lim_bk->min_pix_clk_freq_hz, 122415ddd99SSakari Ailus op_lim_bk->max_pix_clk_freq_hz, 1239e05bbacSSakari Ailus "op_pix_clk_freq_hz"); 1249e05bbacSSakari Ailus 1259e05bbacSSakari Ailus /* 1269e05bbacSSakari Ailus * If there are no OP clocks, the VT clocks are contained in 1279e05bbacSSakari Ailus * the OP clock struct. 1289e05bbacSSakari Ailus */ 1299e05bbacSSakari Ailus if (pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS) 1309e05bbacSSakari Ailus return rval; 1319e05bbacSSakari Ailus 1329e05bbacSSakari Ailus if (!rval) 1339e05bbacSSakari Ailus rval = bounds_check( 134415ddd99SSakari Ailus dev, pll->vt_bk.sys_clk_freq_hz, 135415ddd99SSakari Ailus lim->vt_bk.min_sys_clk_freq_hz, 136415ddd99SSakari Ailus lim->vt_bk.max_sys_clk_freq_hz, 1379e05bbacSSakari Ailus "vt_sys_clk_freq_hz"); 1389e05bbacSSakari Ailus if (!rval) 1399e05bbacSSakari Ailus rval = bounds_check( 140415ddd99SSakari Ailus dev, pll->vt_bk.pix_clk_freq_hz, 141415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_freq_hz, 142415ddd99SSakari Ailus lim->vt_bk.max_pix_clk_freq_hz, 1439e05bbacSSakari Ailus "vt_pix_clk_freq_hz"); 1449e05bbacSSakari Ailus 1459e05bbacSSakari Ailus return rval; 1469e05bbacSSakari Ailus } 1479e05bbacSSakari Ailus 148*8030aa4fSSakari Ailus #define CPHY_CONST 7 149*8030aa4fSSakari Ailus #define DPHY_CONST 16 150*8030aa4fSSakari Ailus #define PHY_CONST_DIV 16 151*8030aa4fSSakari Ailus 1529e05bbacSSakari Ailus /* 1539e05bbacSSakari Ailus * Heuristically guess the PLL tree for a given common multiplier and 1549e05bbacSSakari Ailus * divisor. Begin with the operational timing and continue to video 1559e05bbacSSakari Ailus * timing once operational timing has been verified. 1569e05bbacSSakari Ailus * 1579e05bbacSSakari Ailus * @mul is the PLL multiplier and @div is the common divisor 1589e05bbacSSakari Ailus * (pre_pll_clk_div and op_sys_clk_div combined). The final PLL 1599e05bbacSSakari Ailus * multiplier will be a multiple of @mul. 1609e05bbacSSakari Ailus * 1619e05bbacSSakari Ailus * @return Zero on success, error code on error. 1629e05bbacSSakari Ailus */ 1639e05bbacSSakari Ailus static int 164415ddd99SSakari Ailus __ccs_pll_calculate(struct device *dev, const struct ccs_pll_limits *lim, 165415ddd99SSakari Ailus const struct ccs_pll_branch_limits_fr *op_lim_fr, 166415ddd99SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk, 167415ddd99SSakari Ailus struct ccs_pll *pll, struct ccs_pll_branch_fr *op_pll_fr, 168415ddd99SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk, uint32_t mul, 169*8030aa4fSSakari Ailus uint32_t div, uint32_t l, bool cphy, uint32_t phy_const) 1709e05bbacSSakari Ailus { 1719e05bbacSSakari Ailus uint32_t sys_div; 1729e05bbacSSakari Ailus uint32_t best_pix_div = INT_MAX >> 1; 1739e05bbacSSakari Ailus uint32_t vt_op_binning_div; 1749e05bbacSSakari Ailus /* 1759e05bbacSSakari Ailus * Higher multipliers (and divisors) are often required than 1769e05bbacSSakari Ailus * necessitated by the external clock and the output clocks. 1779e05bbacSSakari Ailus * There are limits for all values in the clock tree. These 1789e05bbacSSakari Ailus * are the minimum and maximum multiplier for mul. 1799e05bbacSSakari Ailus */ 1809e05bbacSSakari Ailus uint32_t more_mul_min, more_mul_max; 1819e05bbacSSakari Ailus uint32_t more_mul_factor; 1829e05bbacSSakari Ailus uint32_t min_vt_div, max_vt_div, vt_div; 1839e05bbacSSakari Ailus uint32_t min_sys_div, max_sys_div; 184e583e654SSakari Ailus uint32_t i; 1859e05bbacSSakari Ailus 1869e05bbacSSakari Ailus /* 1879e05bbacSSakari Ailus * Get pre_pll_clk_div so that our pll_op_clk_freq_hz won't be 1889e05bbacSSakari Ailus * too high. 1899e05bbacSSakari Ailus */ 190415ddd99SSakari Ailus dev_dbg(dev, "op_pre_pll_clk_div %u\n", op_pll_fr->pre_pll_clk_div); 1919e05bbacSSakari Ailus 1929e05bbacSSakari Ailus /* Don't go above max pll multiplier. */ 193415ddd99SSakari Ailus more_mul_max = op_lim_fr->max_pll_multiplier / mul; 194415ddd99SSakari Ailus dev_dbg(dev, "more_mul_max: max_op_pll_multiplier check: %u\n", 1959e05bbacSSakari Ailus more_mul_max); 1969e05bbacSSakari Ailus /* Don't go above max pll op frequency. */ 1979e05bbacSSakari Ailus more_mul_max = 1989e05bbacSSakari Ailus min_t(uint32_t, 1999e05bbacSSakari Ailus more_mul_max, 200415ddd99SSakari Ailus op_lim_fr->max_pll_op_clk_freq_hz 201ae502e08SSakari Ailus / (pll->ext_clk_freq_hz / 202ae502e08SSakari Ailus op_pll_fr->pre_pll_clk_div * mul)); 203415ddd99SSakari Ailus dev_dbg(dev, "more_mul_max: max_pll_op_clk_freq_hz check: %u\n", 2049e05bbacSSakari Ailus more_mul_max); 2059e05bbacSSakari Ailus /* Don't go above the division capability of op sys clock divider. */ 2069e05bbacSSakari Ailus more_mul_max = min(more_mul_max, 207415ddd99SSakari Ailus op_lim_bk->max_sys_clk_div * op_pll_fr->pre_pll_clk_div 2089e05bbacSSakari Ailus / div); 2099e05bbacSSakari Ailus dev_dbg(dev, "more_mul_max: max_op_sys_clk_div check: %u\n", 2109e05bbacSSakari Ailus more_mul_max); 211c64cf71dSSakari Ailus /* Ensure we won't go above max_pll_multiplier. */ 21282ab97c8SSakari Ailus more_mul_max = min(more_mul_max, op_lim_fr->max_pll_multiplier / mul); 2139e05bbacSSakari Ailus dev_dbg(dev, "more_mul_max: min_pll_multiplier check: %u\n", 2149e05bbacSSakari Ailus more_mul_max); 2159e05bbacSSakari Ailus 216415ddd99SSakari Ailus /* Ensure we won't go below min_pll_op_clk_freq_hz. */ 217415ddd99SSakari Ailus more_mul_min = DIV_ROUND_UP(op_lim_fr->min_pll_op_clk_freq_hz, 218415ddd99SSakari Ailus pll->ext_clk_freq_hz / 219415ddd99SSakari Ailus op_pll_fr->pre_pll_clk_div * mul); 220415ddd99SSakari Ailus dev_dbg(dev, "more_mul_min: min_op_pll_op_clk_freq_hz check: %u\n", 2219e05bbacSSakari Ailus more_mul_min); 2229e05bbacSSakari Ailus /* Ensure we won't go below min_pll_multiplier. */ 2239e05bbacSSakari Ailus more_mul_min = max(more_mul_min, 224415ddd99SSakari Ailus DIV_ROUND_UP(op_lim_fr->min_pll_multiplier, mul)); 225415ddd99SSakari Ailus dev_dbg(dev, "more_mul_min: min_op_pll_multiplier check: %u\n", 2269e05bbacSSakari Ailus more_mul_min); 2279e05bbacSSakari Ailus 2289e05bbacSSakari Ailus if (more_mul_min > more_mul_max) { 2299e05bbacSSakari Ailus dev_dbg(dev, 2309e05bbacSSakari Ailus "unable to compute more_mul_min and more_mul_max\n"); 2319e05bbacSSakari Ailus return -EINVAL; 2329e05bbacSSakari Ailus } 2339e05bbacSSakari Ailus 234415ddd99SSakari Ailus more_mul_factor = lcm(div, op_pll_fr->pre_pll_clk_div) / div; 2359e05bbacSSakari Ailus dev_dbg(dev, "more_mul_factor: %u\n", more_mul_factor); 236415ddd99SSakari Ailus more_mul_factor = lcm(more_mul_factor, op_lim_bk->min_sys_clk_div); 2379e05bbacSSakari Ailus dev_dbg(dev, "more_mul_factor: min_op_sys_clk_div: %d\n", 2389e05bbacSSakari Ailus more_mul_factor); 2399e05bbacSSakari Ailus i = roundup(more_mul_min, more_mul_factor); 2409e05bbacSSakari Ailus if (!is_one_or_even(i)) 2419e05bbacSSakari Ailus i <<= 1; 2429e05bbacSSakari Ailus 2439e05bbacSSakari Ailus dev_dbg(dev, "final more_mul: %u\n", i); 2449e05bbacSSakari Ailus if (i > more_mul_max) { 2459e05bbacSSakari Ailus dev_dbg(dev, "final more_mul is bad, max %u\n", more_mul_max); 2469e05bbacSSakari Ailus return -EINVAL; 2479e05bbacSSakari Ailus } 2489e05bbacSSakari Ailus 249415ddd99SSakari Ailus op_pll_fr->pll_multiplier = mul * i; 250415ddd99SSakari Ailus op_pll_bk->sys_clk_div = div * i / op_pll_fr->pre_pll_clk_div; 251415ddd99SSakari Ailus dev_dbg(dev, "op_sys_clk_div: %u\n", op_pll_bk->sys_clk_div); 2529e05bbacSSakari Ailus 253415ddd99SSakari Ailus op_pll_fr->pll_ip_clk_freq_hz = pll->ext_clk_freq_hz 254415ddd99SSakari Ailus / op_pll_fr->pre_pll_clk_div; 2559e05bbacSSakari Ailus 256415ddd99SSakari Ailus op_pll_fr->pll_op_clk_freq_hz = op_pll_fr->pll_ip_clk_freq_hz 257415ddd99SSakari Ailus * op_pll_fr->pll_multiplier; 2589e05bbacSSakari Ailus 259c4c0b222SSakari Ailus if (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL) 260cac8f5d2SSakari Ailus op_pll_bk->pix_clk_div = pll->bits_per_pixel 261*8030aa4fSSakari Ailus * pll->op_lanes * phy_const 262*8030aa4fSSakari Ailus / PHY_CONST_DIV / pll->csi2.lanes / l; 263c4c0b222SSakari Ailus else 264*8030aa4fSSakari Ailus op_pll_bk->pix_clk_div = 265*8030aa4fSSakari Ailus pll->bits_per_pixel * phy_const / PHY_CONST_DIV / l; 266c4c0b222SSakari Ailus 267415ddd99SSakari Ailus op_pll_bk->pix_clk_freq_hz = 268415ddd99SSakari Ailus op_pll_bk->sys_clk_freq_hz / op_pll_bk->pix_clk_div; 269c4c0b222SSakari Ailus 270cac8f5d2SSakari Ailus dev_dbg(dev, "op_pix_clk_div: %u\n", op_pll_bk->pix_clk_div); 271cac8f5d2SSakari Ailus 2729e05bbacSSakari Ailus if (pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS) { 2739e05bbacSSakari Ailus /* No OP clocks --- VT clocks are used instead. */ 2749e05bbacSSakari Ailus goto out_skip_vt_calc; 2759e05bbacSSakari Ailus } 2769e05bbacSSakari Ailus 2779e05bbacSSakari Ailus /* 2789e05bbacSSakari Ailus * Some sensors perform analogue binning and some do this 2799e05bbacSSakari Ailus * digitally. The ones doing this digitally can be roughly be 2809e05bbacSSakari Ailus * found out using this formula. The ones doing this digitally 2819e05bbacSSakari Ailus * should run at higher clock rate, so smaller divisor is used 2829e05bbacSSakari Ailus * on video timing side. 2839e05bbacSSakari Ailus */ 284415ddd99SSakari Ailus if (lim->min_line_length_pck_bin > lim->min_line_length_pck 2859e05bbacSSakari Ailus / pll->binning_horizontal) 2869e05bbacSSakari Ailus vt_op_binning_div = pll->binning_horizontal; 2879e05bbacSSakari Ailus else 2889e05bbacSSakari Ailus vt_op_binning_div = 1; 2899e05bbacSSakari Ailus dev_dbg(dev, "vt_op_binning_div: %u\n", vt_op_binning_div); 2909e05bbacSSakari Ailus 2919e05bbacSSakari Ailus /* 2929e05bbacSSakari Ailus * Profile 2 supports vt_pix_clk_div E [4, 10] 2939e05bbacSSakari Ailus * 2949e05bbacSSakari Ailus * Horizontal binning can be used as a base for difference in 2959e05bbacSSakari Ailus * divisors. One must make sure that horizontal blanking is 2969e05bbacSSakari Ailus * enough to accommodate the CSI-2 sync codes. 2979e05bbacSSakari Ailus * 298cac8f5d2SSakari Ailus * Take scaling factor and number of VT lanes into account as well. 2999e05bbacSSakari Ailus * 3009e05bbacSSakari Ailus * Find absolute limits for the factor of vt divider. 3019e05bbacSSakari Ailus */ 3029e05bbacSSakari Ailus dev_dbg(dev, "scale_m: %u\n", pll->scale_m); 3039490a227SSakari Ailus min_vt_div = DIV_ROUND_UP(pll->bits_per_pixel * op_pll_bk->sys_clk_div 304*8030aa4fSSakari Ailus * pll->scale_n * pll->vt_lanes * phy_const, 3059490a227SSakari Ailus (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 3069490a227SSakari Ailus pll->csi2.lanes : 1) 307*8030aa4fSSakari Ailus * vt_op_binning_div * pll->scale_m 308*8030aa4fSSakari Ailus * PHY_CONST_DIV); 3099e05bbacSSakari Ailus 3109e05bbacSSakari Ailus /* Find smallest and biggest allowed vt divisor. */ 3119e05bbacSSakari Ailus dev_dbg(dev, "min_vt_div: %u\n", min_vt_div); 3129e05bbacSSakari Ailus min_vt_div = max(min_vt_div, 313415ddd99SSakari Ailus DIV_ROUND_UP(op_pll_fr->pll_op_clk_freq_hz, 314415ddd99SSakari Ailus lim->vt_bk.max_pix_clk_freq_hz)); 3159e05bbacSSakari Ailus dev_dbg(dev, "min_vt_div: max_vt_pix_clk_freq_hz: %u\n", 3169e05bbacSSakari Ailus min_vt_div); 3179e05bbacSSakari Ailus min_vt_div = max_t(uint32_t, min_vt_div, 318415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_div 319415ddd99SSakari Ailus * lim->vt_bk.min_sys_clk_div); 3209e05bbacSSakari Ailus dev_dbg(dev, "min_vt_div: min_vt_clk_div: %u\n", min_vt_div); 3219e05bbacSSakari Ailus 322415ddd99SSakari Ailus max_vt_div = lim->vt_bk.max_sys_clk_div * lim->vt_bk.max_pix_clk_div; 3239e05bbacSSakari Ailus dev_dbg(dev, "max_vt_div: %u\n", max_vt_div); 3249e05bbacSSakari Ailus max_vt_div = min(max_vt_div, 325415ddd99SSakari Ailus DIV_ROUND_UP(op_pll_fr->pll_op_clk_freq_hz, 326415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_freq_hz)); 3279e05bbacSSakari Ailus dev_dbg(dev, "max_vt_div: min_vt_pix_clk_freq_hz: %u\n", 3289e05bbacSSakari Ailus max_vt_div); 3299e05bbacSSakari Ailus 3309e05bbacSSakari Ailus /* 3319e05bbacSSakari Ailus * Find limitsits for sys_clk_div. Not all values are possible 3329e05bbacSSakari Ailus * with all values of pix_clk_div. 3339e05bbacSSakari Ailus */ 334415ddd99SSakari Ailus min_sys_div = lim->vt_bk.min_sys_clk_div; 3359e05bbacSSakari Ailus dev_dbg(dev, "min_sys_div: %u\n", min_sys_div); 3369e05bbacSSakari Ailus min_sys_div = max(min_sys_div, 3379e05bbacSSakari Ailus DIV_ROUND_UP(min_vt_div, 338415ddd99SSakari Ailus lim->vt_bk.max_pix_clk_div)); 3399e05bbacSSakari Ailus dev_dbg(dev, "min_sys_div: max_vt_pix_clk_div: %u\n", min_sys_div); 3409e05bbacSSakari Ailus min_sys_div = max(min_sys_div, 341415ddd99SSakari Ailus op_pll_fr->pll_op_clk_freq_hz 342415ddd99SSakari Ailus / lim->vt_bk.max_sys_clk_freq_hz); 3439e05bbacSSakari Ailus dev_dbg(dev, "min_sys_div: max_pll_op_clk_freq_hz: %u\n", min_sys_div); 3449e05bbacSSakari Ailus min_sys_div = clk_div_even_up(min_sys_div); 3459e05bbacSSakari Ailus dev_dbg(dev, "min_sys_div: one or even: %u\n", min_sys_div); 3469e05bbacSSakari Ailus 347415ddd99SSakari Ailus max_sys_div = lim->vt_bk.max_sys_clk_div; 3489e05bbacSSakari Ailus dev_dbg(dev, "max_sys_div: %u\n", max_sys_div); 3499e05bbacSSakari Ailus max_sys_div = min(max_sys_div, 3509e05bbacSSakari Ailus DIV_ROUND_UP(max_vt_div, 351415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_div)); 3529e05bbacSSakari Ailus dev_dbg(dev, "max_sys_div: min_vt_pix_clk_div: %u\n", max_sys_div); 3539e05bbacSSakari Ailus max_sys_div = min(max_sys_div, 354415ddd99SSakari Ailus DIV_ROUND_UP(op_pll_fr->pll_op_clk_freq_hz, 355415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_freq_hz)); 3569e05bbacSSakari Ailus dev_dbg(dev, "max_sys_div: min_vt_pix_clk_freq_hz: %u\n", max_sys_div); 3579e05bbacSSakari Ailus 3589e05bbacSSakari Ailus /* 3599e05bbacSSakari Ailus * Find pix_div such that a legal pix_div * sys_div results 3609e05bbacSSakari Ailus * into a value which is not smaller than div, the desired 3619e05bbacSSakari Ailus * divisor. 3629e05bbacSSakari Ailus */ 3639e05bbacSSakari Ailus for (vt_div = min_vt_div; vt_div <= max_vt_div; 3649e05bbacSSakari Ailus vt_div += 2 - (vt_div & 1)) { 3659e05bbacSSakari Ailus for (sys_div = min_sys_div; 3669e05bbacSSakari Ailus sys_div <= max_sys_div; 3679e05bbacSSakari Ailus sys_div += 2 - (sys_div & 1)) { 3689e05bbacSSakari Ailus uint16_t pix_div = DIV_ROUND_UP(vt_div, sys_div); 3699c1a0d9eSSakari Ailus uint16_t rounded_div; 3709e05bbacSSakari Ailus 371415ddd99SSakari Ailus if (pix_div < lim->vt_bk.min_pix_clk_div 372415ddd99SSakari Ailus || pix_div > lim->vt_bk.max_pix_clk_div) { 3739e05bbacSSakari Ailus dev_dbg(dev, 3749e05bbacSSakari Ailus "pix_div %u too small or too big (%u--%u)\n", 3759e05bbacSSakari Ailus pix_div, 376415ddd99SSakari Ailus lim->vt_bk.min_pix_clk_div, 377415ddd99SSakari Ailus lim->vt_bk.max_pix_clk_div); 3789e05bbacSSakari Ailus continue; 3799e05bbacSSakari Ailus } 3809e05bbacSSakari Ailus 3819c1a0d9eSSakari Ailus rounded_div = roundup(vt_div, best_pix_div); 3829c1a0d9eSSakari Ailus 3839e05bbacSSakari Ailus /* Check if this one is better. */ 3849c1a0d9eSSakari Ailus if (pix_div * sys_div <= rounded_div) 3859e05bbacSSakari Ailus best_pix_div = pix_div; 3869c1a0d9eSSakari Ailus 3879c1a0d9eSSakari Ailus /* Bail out if we've already found the best value. */ 3889c1a0d9eSSakari Ailus if (vt_div == rounded_div) 3899c1a0d9eSSakari Ailus break; 3909e05bbacSSakari Ailus } 3919e05bbacSSakari Ailus if (best_pix_div < INT_MAX >> 1) 3929e05bbacSSakari Ailus break; 3939e05bbacSSakari Ailus } 3949e05bbacSSakari Ailus 3959454432aSSakari Ailus pll->vt_bk.sys_clk_div = DIV_ROUND_UP(vt_div, best_pix_div); 396415ddd99SSakari Ailus pll->vt_bk.pix_clk_div = best_pix_div; 3979e05bbacSSakari Ailus 398415ddd99SSakari Ailus pll->vt_bk.sys_clk_freq_hz = 399415ddd99SSakari Ailus op_pll_fr->pll_op_clk_freq_hz / pll->vt_bk.sys_clk_div; 400415ddd99SSakari Ailus pll->vt_bk.pix_clk_freq_hz = 401415ddd99SSakari Ailus pll->vt_bk.sys_clk_freq_hz / pll->vt_bk.pix_clk_div; 4029e05bbacSSakari Ailus 4039e05bbacSSakari Ailus out_skip_vt_calc: 404cac8f5d2SSakari Ailus pll->pixel_rate_pixel_array = 405cac8f5d2SSakari Ailus pll->vt_bk.pix_clk_freq_hz * pll->vt_lanes; 4069e05bbacSSakari Ailus 407415ddd99SSakari Ailus return check_all_bounds(dev, lim, op_lim_fr, op_lim_bk, pll, op_pll_fr, 408415ddd99SSakari Ailus op_pll_bk); 4099e05bbacSSakari Ailus } 4109e05bbacSSakari Ailus 411415ddd99SSakari Ailus int ccs_pll_calculate(struct device *dev, const struct ccs_pll_limits *lim, 4129e05bbacSSakari Ailus struct ccs_pll *pll) 4139e05bbacSSakari Ailus { 414415ddd99SSakari Ailus const struct ccs_pll_branch_limits_fr *op_lim_fr = &lim->vt_fr; 415415ddd99SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk = &lim->op_bk; 416415ddd99SSakari Ailus struct ccs_pll_branch_fr *op_pll_fr = &pll->vt_fr; 417415ddd99SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk = &pll->op_bk; 418*8030aa4fSSakari Ailus bool cphy = pll->bus_type == CCS_PLL_BUS_TYPE_CSI2_CPHY; 419*8030aa4fSSakari Ailus uint32_t phy_const = cphy ? CPHY_CONST : DPHY_CONST; 420415ddd99SSakari Ailus uint16_t min_op_pre_pll_clk_div; 421415ddd99SSakari Ailus uint16_t max_op_pre_pll_clk_div; 4229e05bbacSSakari Ailus uint32_t mul, div; 423c4c0b222SSakari Ailus uint32_t l = (!pll->op_bits_per_lane || 424c4c0b222SSakari Ailus pll->op_bits_per_lane >= pll->bits_per_pixel) ? 1 : 2; 425e583e654SSakari Ailus uint32_t i; 4269e05bbacSSakari Ailus int rval = -EINVAL; 4279e05bbacSSakari Ailus 428cac8f5d2SSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL)) { 429cac8f5d2SSakari Ailus pll->op_lanes = 1; 430cac8f5d2SSakari Ailus pll->vt_lanes = 1; 431cac8f5d2SSakari Ailus } 4329490a227SSakari Ailus 433d7172c0eSSakari Ailus if (!pll->op_lanes || !pll->vt_lanes || !pll->bits_per_pixel || 434d7172c0eSSakari Ailus !pll->ext_clk_freq_hz || !pll->link_freq || !pll->scale_m || 435d7172c0eSSakari Ailus !op_lim_fr->min_pll_ip_clk_freq_hz || 436d7172c0eSSakari Ailus !op_lim_fr->max_pll_ip_clk_freq_hz || 437d7172c0eSSakari Ailus !op_lim_fr->min_pll_op_clk_freq_hz || 438d7172c0eSSakari Ailus !op_lim_fr->max_pll_op_clk_freq_hz || 439d7172c0eSSakari Ailus !op_lim_bk->max_sys_clk_div || !op_lim_fr->max_pll_multiplier) 440d7172c0eSSakari Ailus return -EINVAL; 441d7172c0eSSakari Ailus 4429490a227SSakari Ailus /* 4439490a227SSakari Ailus * Make sure op_pix_clk_div will be integer --- unless flexible 4449490a227SSakari Ailus * op_pix_clk_div is supported 4459490a227SSakari Ailus */ 4469490a227SSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_FLEXIBLE_OP_PIX_CLK_DIV) && 4479490a227SSakari Ailus (pll->bits_per_pixel * pll->op_lanes) % (pll->csi2.lanes * l)) { 4489490a227SSakari Ailus dev_dbg(dev, "op_pix_clk_div not an integer (bpp %u, op lanes %u, lanes %u, l %u)\n", 4499490a227SSakari Ailus pll->bits_per_pixel, pll->op_lanes, pll->csi2.lanes, l); 4509490a227SSakari Ailus return -EINVAL; 4519490a227SSakari Ailus } 4529490a227SSakari Ailus 453cac8f5d2SSakari Ailus dev_dbg(dev, "vt_lanes: %u\n", pll->vt_lanes); 454cac8f5d2SSakari Ailus dev_dbg(dev, "op_lanes: %u\n", pll->op_lanes); 455cac8f5d2SSakari Ailus 4569e05bbacSSakari Ailus if (pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS) { 4579e05bbacSSakari Ailus /* 4589e05bbacSSakari Ailus * If there's no OP PLL at all, use the VT values 4599e05bbacSSakari Ailus * instead. The OP values are ignored for the rest of 4609e05bbacSSakari Ailus * the PLL calculation. 4619e05bbacSSakari Ailus */ 462415ddd99SSakari Ailus op_lim_fr = &lim->vt_fr; 463415ddd99SSakari Ailus op_lim_bk = &lim->vt_bk; 464415ddd99SSakari Ailus op_pll_bk = &pll->vt_bk; 4659e05bbacSSakari Ailus } 4669e05bbacSSakari Ailus 4679e05bbacSSakari Ailus dev_dbg(dev, "binning: %ux%u\n", pll->binning_horizontal, 4689e05bbacSSakari Ailus pll->binning_vertical); 4699e05bbacSSakari Ailus 4709e05bbacSSakari Ailus switch (pll->bus_type) { 47147b6eaf3SSakari Ailus case CCS_PLL_BUS_TYPE_CSI2_DPHY: 4729e05bbacSSakari Ailus /* CSI transfers 2 bits per clock per lane; thus times 2 */ 473cab27256SSakari Ailus op_pll_bk->sys_clk_freq_hz = pll->link_freq * 2 474cac8f5d2SSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 475ae502e08SSakari Ailus 1 : pll->csi2.lanes); 4769e05bbacSSakari Ailus break; 477*8030aa4fSSakari Ailus case CCS_PLL_BUS_TYPE_CSI2_CPHY: 478*8030aa4fSSakari Ailus op_pll_bk->sys_clk_freq_hz = 479*8030aa4fSSakari Ailus pll->link_freq 480*8030aa4fSSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 481*8030aa4fSSakari Ailus 1 : pll->csi2.lanes); 482*8030aa4fSSakari Ailus break; 4839e05bbacSSakari Ailus default: 4849e05bbacSSakari Ailus return -EINVAL; 4859e05bbacSSakari Ailus } 4869e05bbacSSakari Ailus 487cac8f5d2SSakari Ailus pll->pixel_rate_csi = 488*8030aa4fSSakari Ailus div_u64((uint64_t)op_pll_bk->sys_clk_freq_hz 489cac8f5d2SSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 490*8030aa4fSSakari Ailus pll->csi2.lanes : 1) * PHY_CONST_DIV, 491*8030aa4fSSakari Ailus phy_const * pll->bits_per_pixel * l); 492cac8f5d2SSakari Ailus 493415ddd99SSakari Ailus /* Figure out limits for OP pre-pll divider based on extclk */ 494415ddd99SSakari Ailus dev_dbg(dev, "min / max op_pre_pll_clk_div: %u / %u\n", 495415ddd99SSakari Ailus op_lim_fr->min_pre_pll_clk_div, op_lim_fr->max_pre_pll_clk_div); 496415ddd99SSakari Ailus max_op_pre_pll_clk_div = 497415ddd99SSakari Ailus min_t(uint16_t, op_lim_fr->max_pre_pll_clk_div, 4989e05bbacSSakari Ailus clk_div_even(pll->ext_clk_freq_hz / 499415ddd99SSakari Ailus op_lim_fr->min_pll_ip_clk_freq_hz)); 500415ddd99SSakari Ailus min_op_pre_pll_clk_div = 501415ddd99SSakari Ailus max_t(uint16_t, op_lim_fr->min_pre_pll_clk_div, 5029e05bbacSSakari Ailus clk_div_even_up( 5039e05bbacSSakari Ailus DIV_ROUND_UP(pll->ext_clk_freq_hz, 504415ddd99SSakari Ailus op_lim_fr->max_pll_ip_clk_freq_hz))); 505415ddd99SSakari Ailus dev_dbg(dev, "pre-pll check: min / max op_pre_pll_clk_div: %u / %u\n", 506415ddd99SSakari Ailus min_op_pre_pll_clk_div, max_op_pre_pll_clk_div); 5079e05bbacSSakari Ailus 508cab27256SSakari Ailus i = gcd(op_pll_bk->sys_clk_freq_hz, pll->ext_clk_freq_hz); 509cab27256SSakari Ailus mul = op_pll_bk->sys_clk_freq_hz / i; 5109e05bbacSSakari Ailus div = pll->ext_clk_freq_hz / i; 5119e05bbacSSakari Ailus dev_dbg(dev, "mul %u / div %u\n", mul, div); 5129e05bbacSSakari Ailus 513415ddd99SSakari Ailus min_op_pre_pll_clk_div = 514415ddd99SSakari Ailus max_t(uint16_t, min_op_pre_pll_clk_div, 5159e05bbacSSakari Ailus clk_div_even_up( 516482e75e7SSakari Ailus mul / 517482e75e7SSakari Ailus one_or_more( 518482e75e7SSakari Ailus DIV_ROUND_UP(op_lim_fr->max_pll_op_clk_freq_hz, 519482e75e7SSakari Ailus pll->ext_clk_freq_hz)))); 520415ddd99SSakari Ailus dev_dbg(dev, "pll_op check: min / max op_pre_pll_clk_div: %u / %u\n", 521415ddd99SSakari Ailus min_op_pre_pll_clk_div, max_op_pre_pll_clk_div); 5229e05bbacSSakari Ailus 523415ddd99SSakari Ailus for (op_pll_fr->pre_pll_clk_div = min_op_pre_pll_clk_div; 524415ddd99SSakari Ailus op_pll_fr->pre_pll_clk_div <= max_op_pre_pll_clk_div; 5254e1e8d24SSakari Ailus op_pll_fr->pre_pll_clk_div += 5264e1e8d24SSakari Ailus (pll->flags & CCS_PLL_FLAG_EXT_IP_PLL_DIVIDER) ? 1 : 5274e1e8d24SSakari Ailus 2 - (op_pll_fr->pre_pll_clk_div & 1)) { 528415ddd99SSakari Ailus rval = __ccs_pll_calculate(dev, lim, op_lim_fr, op_lim_bk, pll, 529*8030aa4fSSakari Ailus op_pll_fr, op_pll_bk, mul, div, l, 530*8030aa4fSSakari Ailus cphy, phy_const); 5319e05bbacSSakari Ailus if (rval) 5329e05bbacSSakari Ailus continue; 5339e05bbacSSakari Ailus 5349e05bbacSSakari Ailus print_pll(dev, pll); 5359e05bbacSSakari Ailus return 0; 5369e05bbacSSakari Ailus } 5379e05bbacSSakari Ailus 5389e05bbacSSakari Ailus dev_dbg(dev, "unable to compute pre_pll divisor\n"); 5399e05bbacSSakari Ailus 5409e05bbacSSakari Ailus return rval; 5419e05bbacSSakari Ailus } 5429e05bbacSSakari Ailus EXPORT_SYMBOL_GPL(ccs_pll_calculate); 5439e05bbacSSakari Ailus 5447389d01cSSakari Ailus MODULE_AUTHOR("Sakari Ailus <sakari.ailus@linux.intel.com>"); 5459e05bbacSSakari Ailus MODULE_DESCRIPTION("Generic MIPI CCS/SMIA/SMIA++ PLL calculator"); 546b3c0115eSSakari Ailus MODULE_LICENSE("GPL v2"); 547