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 1488030aa4fSSakari Ailus #define CPHY_CONST 7 1498030aa4fSSakari Ailus #define DPHY_CONST 16 1508030aa4fSSakari Ailus #define PHY_CONST_DIV 16 1518030aa4fSSakari Ailus 152*3e2db036SSakari Ailus static void 153*3e2db036SSakari Ailus __ccs_pll_calculate_vt(struct device *dev, const struct ccs_pll_limits *lim, 154*3e2db036SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk, 155*3e2db036SSakari Ailus struct ccs_pll *pll, struct ccs_pll_branch_fr *pll_fr, 156*3e2db036SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk, bool cphy, 157*3e2db036SSakari Ailus uint32_t phy_const) 158*3e2db036SSakari Ailus { 159*3e2db036SSakari Ailus uint32_t sys_div; 160*3e2db036SSakari Ailus uint32_t best_pix_div = INT_MAX >> 1; 161*3e2db036SSakari Ailus uint32_t vt_op_binning_div; 162*3e2db036SSakari Ailus uint32_t min_vt_div, max_vt_div, vt_div; 163*3e2db036SSakari Ailus uint32_t min_sys_div, max_sys_div; 164*3e2db036SSakari Ailus 165*3e2db036SSakari Ailus /* 166*3e2db036SSakari Ailus * Some sensors perform analogue binning and some do this 167*3e2db036SSakari Ailus * digitally. The ones doing this digitally can be roughly be 168*3e2db036SSakari Ailus * found out using this formula. The ones doing this digitally 169*3e2db036SSakari Ailus * should run at higher clock rate, so smaller divisor is used 170*3e2db036SSakari Ailus * on video timing side. 171*3e2db036SSakari Ailus */ 172*3e2db036SSakari Ailus if (lim->min_line_length_pck_bin > lim->min_line_length_pck 173*3e2db036SSakari Ailus / pll->binning_horizontal) 174*3e2db036SSakari Ailus vt_op_binning_div = pll->binning_horizontal; 175*3e2db036SSakari Ailus else 176*3e2db036SSakari Ailus vt_op_binning_div = 1; 177*3e2db036SSakari Ailus dev_dbg(dev, "vt_op_binning_div: %u\n", vt_op_binning_div); 178*3e2db036SSakari Ailus 179*3e2db036SSakari Ailus /* 180*3e2db036SSakari Ailus * Profile 2 supports vt_pix_clk_div E [4, 10] 181*3e2db036SSakari Ailus * 182*3e2db036SSakari Ailus * Horizontal binning can be used as a base for difference in 183*3e2db036SSakari Ailus * divisors. One must make sure that horizontal blanking is 184*3e2db036SSakari Ailus * enough to accommodate the CSI-2 sync codes. 185*3e2db036SSakari Ailus * 186*3e2db036SSakari Ailus * Take scaling factor and number of VT lanes into account as well. 187*3e2db036SSakari Ailus * 188*3e2db036SSakari Ailus * Find absolute limits for the factor of vt divider. 189*3e2db036SSakari Ailus */ 190*3e2db036SSakari Ailus dev_dbg(dev, "scale_m: %u\n", pll->scale_m); 191*3e2db036SSakari Ailus min_vt_div = DIV_ROUND_UP(pll->bits_per_pixel * op_pll_bk->sys_clk_div 192*3e2db036SSakari Ailus * pll->scale_n * pll->vt_lanes * phy_const, 193*3e2db036SSakari Ailus (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 194*3e2db036SSakari Ailus pll->csi2.lanes : 1) 195*3e2db036SSakari Ailus * vt_op_binning_div * pll->scale_m 196*3e2db036SSakari Ailus * PHY_CONST_DIV); 197*3e2db036SSakari Ailus 198*3e2db036SSakari Ailus /* Find smallest and biggest allowed vt divisor. */ 199*3e2db036SSakari Ailus dev_dbg(dev, "min_vt_div: %u\n", min_vt_div); 200*3e2db036SSakari Ailus min_vt_div = max(min_vt_div, 201*3e2db036SSakari Ailus DIV_ROUND_UP(pll_fr->pll_op_clk_freq_hz, 202*3e2db036SSakari Ailus lim->vt_bk.max_pix_clk_freq_hz)); 203*3e2db036SSakari Ailus dev_dbg(dev, "min_vt_div: max_vt_pix_clk_freq_hz: %u\n", 204*3e2db036SSakari Ailus min_vt_div); 205*3e2db036SSakari Ailus min_vt_div = max_t(uint32_t, min_vt_div, 206*3e2db036SSakari Ailus lim->vt_bk.min_pix_clk_div 207*3e2db036SSakari Ailus * lim->vt_bk.min_sys_clk_div); 208*3e2db036SSakari Ailus dev_dbg(dev, "min_vt_div: min_vt_clk_div: %u\n", min_vt_div); 209*3e2db036SSakari Ailus 210*3e2db036SSakari Ailus max_vt_div = lim->vt_bk.max_sys_clk_div * lim->vt_bk.max_pix_clk_div; 211*3e2db036SSakari Ailus dev_dbg(dev, "max_vt_div: %u\n", max_vt_div); 212*3e2db036SSakari Ailus max_vt_div = min(max_vt_div, 213*3e2db036SSakari Ailus DIV_ROUND_UP(pll_fr->pll_op_clk_freq_hz, 214*3e2db036SSakari Ailus lim->vt_bk.min_pix_clk_freq_hz)); 215*3e2db036SSakari Ailus dev_dbg(dev, "max_vt_div: min_vt_pix_clk_freq_hz: %u\n", 216*3e2db036SSakari Ailus max_vt_div); 217*3e2db036SSakari Ailus 218*3e2db036SSakari Ailus /* 219*3e2db036SSakari Ailus * Find limitsits for sys_clk_div. Not all values are possible 220*3e2db036SSakari Ailus * with all values of pix_clk_div. 221*3e2db036SSakari Ailus */ 222*3e2db036SSakari Ailus min_sys_div = lim->vt_bk.min_sys_clk_div; 223*3e2db036SSakari Ailus dev_dbg(dev, "min_sys_div: %u\n", min_sys_div); 224*3e2db036SSakari Ailus min_sys_div = max(min_sys_div, 225*3e2db036SSakari Ailus DIV_ROUND_UP(min_vt_div, 226*3e2db036SSakari Ailus lim->vt_bk.max_pix_clk_div)); 227*3e2db036SSakari Ailus dev_dbg(dev, "min_sys_div: max_vt_pix_clk_div: %u\n", min_sys_div); 228*3e2db036SSakari Ailus min_sys_div = max(min_sys_div, 229*3e2db036SSakari Ailus pll_fr->pll_op_clk_freq_hz 230*3e2db036SSakari Ailus / lim->vt_bk.max_sys_clk_freq_hz); 231*3e2db036SSakari Ailus dev_dbg(dev, "min_sys_div: max_pll_op_clk_freq_hz: %u\n", min_sys_div); 232*3e2db036SSakari Ailus min_sys_div = clk_div_even_up(min_sys_div); 233*3e2db036SSakari Ailus dev_dbg(dev, "min_sys_div: one or even: %u\n", min_sys_div); 234*3e2db036SSakari Ailus 235*3e2db036SSakari Ailus max_sys_div = lim->vt_bk.max_sys_clk_div; 236*3e2db036SSakari Ailus dev_dbg(dev, "max_sys_div: %u\n", max_sys_div); 237*3e2db036SSakari Ailus max_sys_div = min(max_sys_div, 238*3e2db036SSakari Ailus DIV_ROUND_UP(max_vt_div, 239*3e2db036SSakari Ailus lim->vt_bk.min_pix_clk_div)); 240*3e2db036SSakari Ailus dev_dbg(dev, "max_sys_div: min_vt_pix_clk_div: %u\n", max_sys_div); 241*3e2db036SSakari Ailus max_sys_div = min(max_sys_div, 242*3e2db036SSakari Ailus DIV_ROUND_UP(pll_fr->pll_op_clk_freq_hz, 243*3e2db036SSakari Ailus lim->vt_bk.min_pix_clk_freq_hz)); 244*3e2db036SSakari Ailus dev_dbg(dev, "max_sys_div: min_vt_pix_clk_freq_hz: %u\n", max_sys_div); 245*3e2db036SSakari Ailus 246*3e2db036SSakari Ailus /* 247*3e2db036SSakari Ailus * Find pix_div such that a legal pix_div * sys_div results 248*3e2db036SSakari Ailus * into a value which is not smaller than div, the desired 249*3e2db036SSakari Ailus * divisor. 250*3e2db036SSakari Ailus */ 251*3e2db036SSakari Ailus for (vt_div = min_vt_div; vt_div <= max_vt_div; 252*3e2db036SSakari Ailus vt_div += 2 - (vt_div & 1)) { 253*3e2db036SSakari Ailus for (sys_div = min_sys_div; 254*3e2db036SSakari Ailus sys_div <= max_sys_div; 255*3e2db036SSakari Ailus sys_div += 2 - (sys_div & 1)) { 256*3e2db036SSakari Ailus uint16_t pix_div = DIV_ROUND_UP(vt_div, sys_div); 257*3e2db036SSakari Ailus uint16_t rounded_div; 258*3e2db036SSakari Ailus 259*3e2db036SSakari Ailus if (pix_div < lim->vt_bk.min_pix_clk_div 260*3e2db036SSakari Ailus || pix_div > lim->vt_bk.max_pix_clk_div) { 261*3e2db036SSakari Ailus dev_dbg(dev, 262*3e2db036SSakari Ailus "pix_div %u too small or too big (%u--%u)\n", 263*3e2db036SSakari Ailus pix_div, 264*3e2db036SSakari Ailus lim->vt_bk.min_pix_clk_div, 265*3e2db036SSakari Ailus lim->vt_bk.max_pix_clk_div); 266*3e2db036SSakari Ailus continue; 267*3e2db036SSakari Ailus } 268*3e2db036SSakari Ailus 269*3e2db036SSakari Ailus rounded_div = roundup(vt_div, best_pix_div); 270*3e2db036SSakari Ailus 271*3e2db036SSakari Ailus /* Check if this one is better. */ 272*3e2db036SSakari Ailus if (pix_div * sys_div <= rounded_div) 273*3e2db036SSakari Ailus best_pix_div = pix_div; 274*3e2db036SSakari Ailus 275*3e2db036SSakari Ailus /* Bail out if we've already found the best value. */ 276*3e2db036SSakari Ailus if (vt_div == rounded_div) 277*3e2db036SSakari Ailus break; 278*3e2db036SSakari Ailus } 279*3e2db036SSakari Ailus if (best_pix_div < INT_MAX >> 1) 280*3e2db036SSakari Ailus break; 281*3e2db036SSakari Ailus } 282*3e2db036SSakari Ailus 283*3e2db036SSakari Ailus pll->vt_bk.sys_clk_div = DIV_ROUND_UP(vt_div, best_pix_div); 284*3e2db036SSakari Ailus pll->vt_bk.pix_clk_div = best_pix_div; 285*3e2db036SSakari Ailus 286*3e2db036SSakari Ailus pll->vt_bk.sys_clk_freq_hz = 287*3e2db036SSakari Ailus pll_fr->pll_op_clk_freq_hz / pll->vt_bk.sys_clk_div; 288*3e2db036SSakari Ailus pll->vt_bk.pix_clk_freq_hz = 289*3e2db036SSakari Ailus pll->vt_bk.sys_clk_freq_hz / pll->vt_bk.pix_clk_div; 290*3e2db036SSakari Ailus } 291*3e2db036SSakari Ailus 2929e05bbacSSakari Ailus /* 2939e05bbacSSakari Ailus * Heuristically guess the PLL tree for a given common multiplier and 2949e05bbacSSakari Ailus * divisor. Begin with the operational timing and continue to video 2959e05bbacSSakari Ailus * timing once operational timing has been verified. 2969e05bbacSSakari Ailus * 2979e05bbacSSakari Ailus * @mul is the PLL multiplier and @div is the common divisor 2989e05bbacSSakari Ailus * (pre_pll_clk_div and op_sys_clk_div combined). The final PLL 2999e05bbacSSakari Ailus * multiplier will be a multiple of @mul. 3009e05bbacSSakari Ailus * 3019e05bbacSSakari Ailus * @return Zero on success, error code on error. 3029e05bbacSSakari Ailus */ 3039e05bbacSSakari Ailus static int 304415ddd99SSakari Ailus __ccs_pll_calculate(struct device *dev, const struct ccs_pll_limits *lim, 305415ddd99SSakari Ailus const struct ccs_pll_branch_limits_fr *op_lim_fr, 306415ddd99SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk, 307415ddd99SSakari Ailus struct ccs_pll *pll, struct ccs_pll_branch_fr *op_pll_fr, 308415ddd99SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk, uint32_t mul, 3098030aa4fSSakari Ailus uint32_t div, uint32_t l, bool cphy, uint32_t phy_const) 3109e05bbacSSakari Ailus { 3119e05bbacSSakari Ailus /* 3129e05bbacSSakari Ailus * Higher multipliers (and divisors) are often required than 3139e05bbacSSakari Ailus * necessitated by the external clock and the output clocks. 3149e05bbacSSakari Ailus * There are limits for all values in the clock tree. These 3159e05bbacSSakari Ailus * are the minimum and maximum multiplier for mul. 3169e05bbacSSakari Ailus */ 3179e05bbacSSakari Ailus uint32_t more_mul_min, more_mul_max; 3189e05bbacSSakari Ailus uint32_t more_mul_factor; 319e583e654SSakari Ailus uint32_t i; 3209e05bbacSSakari Ailus 3219e05bbacSSakari Ailus /* 3229e05bbacSSakari Ailus * Get pre_pll_clk_div so that our pll_op_clk_freq_hz won't be 3239e05bbacSSakari Ailus * too high. 3249e05bbacSSakari Ailus */ 325415ddd99SSakari Ailus dev_dbg(dev, "op_pre_pll_clk_div %u\n", op_pll_fr->pre_pll_clk_div); 3269e05bbacSSakari Ailus 3279e05bbacSSakari Ailus /* Don't go above max pll multiplier. */ 328415ddd99SSakari Ailus more_mul_max = op_lim_fr->max_pll_multiplier / mul; 329415ddd99SSakari Ailus dev_dbg(dev, "more_mul_max: max_op_pll_multiplier check: %u\n", 3309e05bbacSSakari Ailus more_mul_max); 3319e05bbacSSakari Ailus /* Don't go above max pll op frequency. */ 3329e05bbacSSakari Ailus more_mul_max = 3339e05bbacSSakari Ailus min_t(uint32_t, 3349e05bbacSSakari Ailus more_mul_max, 335415ddd99SSakari Ailus op_lim_fr->max_pll_op_clk_freq_hz 336ae502e08SSakari Ailus / (pll->ext_clk_freq_hz / 337ae502e08SSakari Ailus op_pll_fr->pre_pll_clk_div * mul)); 338415ddd99SSakari Ailus dev_dbg(dev, "more_mul_max: max_pll_op_clk_freq_hz check: %u\n", 3399e05bbacSSakari Ailus more_mul_max); 3409e05bbacSSakari Ailus /* Don't go above the division capability of op sys clock divider. */ 3419e05bbacSSakari Ailus more_mul_max = min(more_mul_max, 342415ddd99SSakari Ailus op_lim_bk->max_sys_clk_div * op_pll_fr->pre_pll_clk_div 3439e05bbacSSakari Ailus / div); 3449e05bbacSSakari Ailus dev_dbg(dev, "more_mul_max: max_op_sys_clk_div check: %u\n", 3459e05bbacSSakari Ailus more_mul_max); 346c64cf71dSSakari Ailus /* Ensure we won't go above max_pll_multiplier. */ 34782ab97c8SSakari Ailus more_mul_max = min(more_mul_max, op_lim_fr->max_pll_multiplier / mul); 3489e05bbacSSakari Ailus dev_dbg(dev, "more_mul_max: min_pll_multiplier check: %u\n", 3499e05bbacSSakari Ailus more_mul_max); 3509e05bbacSSakari Ailus 351415ddd99SSakari Ailus /* Ensure we won't go below min_pll_op_clk_freq_hz. */ 352415ddd99SSakari Ailus more_mul_min = DIV_ROUND_UP(op_lim_fr->min_pll_op_clk_freq_hz, 353415ddd99SSakari Ailus pll->ext_clk_freq_hz / 354415ddd99SSakari Ailus op_pll_fr->pre_pll_clk_div * mul); 355415ddd99SSakari Ailus dev_dbg(dev, "more_mul_min: min_op_pll_op_clk_freq_hz check: %u\n", 3569e05bbacSSakari Ailus more_mul_min); 3579e05bbacSSakari Ailus /* Ensure we won't go below min_pll_multiplier. */ 3589e05bbacSSakari Ailus more_mul_min = max(more_mul_min, 359415ddd99SSakari Ailus DIV_ROUND_UP(op_lim_fr->min_pll_multiplier, mul)); 360415ddd99SSakari Ailus dev_dbg(dev, "more_mul_min: min_op_pll_multiplier check: %u\n", 3619e05bbacSSakari Ailus more_mul_min); 3629e05bbacSSakari Ailus 3639e05bbacSSakari Ailus if (more_mul_min > more_mul_max) { 3649e05bbacSSakari Ailus dev_dbg(dev, 3659e05bbacSSakari Ailus "unable to compute more_mul_min and more_mul_max\n"); 3669e05bbacSSakari Ailus return -EINVAL; 3679e05bbacSSakari Ailus } 3689e05bbacSSakari Ailus 369415ddd99SSakari Ailus more_mul_factor = lcm(div, op_pll_fr->pre_pll_clk_div) / div; 3709e05bbacSSakari Ailus dev_dbg(dev, "more_mul_factor: %u\n", more_mul_factor); 371415ddd99SSakari Ailus more_mul_factor = lcm(more_mul_factor, op_lim_bk->min_sys_clk_div); 3729e05bbacSSakari Ailus dev_dbg(dev, "more_mul_factor: min_op_sys_clk_div: %d\n", 3739e05bbacSSakari Ailus more_mul_factor); 3749e05bbacSSakari Ailus i = roundup(more_mul_min, more_mul_factor); 3759e05bbacSSakari Ailus if (!is_one_or_even(i)) 3769e05bbacSSakari Ailus i <<= 1; 3779e05bbacSSakari Ailus 3789e05bbacSSakari Ailus dev_dbg(dev, "final more_mul: %u\n", i); 3799e05bbacSSakari Ailus if (i > more_mul_max) { 3809e05bbacSSakari Ailus dev_dbg(dev, "final more_mul is bad, max %u\n", more_mul_max); 3819e05bbacSSakari Ailus return -EINVAL; 3829e05bbacSSakari Ailus } 3839e05bbacSSakari Ailus 384415ddd99SSakari Ailus op_pll_fr->pll_multiplier = mul * i; 385415ddd99SSakari Ailus op_pll_bk->sys_clk_div = div * i / op_pll_fr->pre_pll_clk_div; 386415ddd99SSakari Ailus dev_dbg(dev, "op_sys_clk_div: %u\n", op_pll_bk->sys_clk_div); 3879e05bbacSSakari Ailus 388415ddd99SSakari Ailus op_pll_fr->pll_ip_clk_freq_hz = pll->ext_clk_freq_hz 389415ddd99SSakari Ailus / op_pll_fr->pre_pll_clk_div; 3909e05bbacSSakari Ailus 391415ddd99SSakari Ailus op_pll_fr->pll_op_clk_freq_hz = op_pll_fr->pll_ip_clk_freq_hz 392415ddd99SSakari Ailus * op_pll_fr->pll_multiplier; 3939e05bbacSSakari Ailus 394c4c0b222SSakari Ailus if (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL) 395cac8f5d2SSakari Ailus op_pll_bk->pix_clk_div = pll->bits_per_pixel 3968030aa4fSSakari Ailus * pll->op_lanes * phy_const 3978030aa4fSSakari Ailus / PHY_CONST_DIV / pll->csi2.lanes / l; 398c4c0b222SSakari Ailus else 3998030aa4fSSakari Ailus op_pll_bk->pix_clk_div = 4008030aa4fSSakari Ailus pll->bits_per_pixel * phy_const / PHY_CONST_DIV / l; 401c4c0b222SSakari Ailus 402415ddd99SSakari Ailus op_pll_bk->pix_clk_freq_hz = 403415ddd99SSakari Ailus op_pll_bk->sys_clk_freq_hz / op_pll_bk->pix_clk_div; 404c4c0b222SSakari Ailus 405cac8f5d2SSakari Ailus dev_dbg(dev, "op_pix_clk_div: %u\n", op_pll_bk->pix_clk_div); 406cac8f5d2SSakari Ailus 407*3e2db036SSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS)) 408*3e2db036SSakari Ailus __ccs_pll_calculate_vt(dev, lim, op_lim_bk, pll, op_pll_fr, 409*3e2db036SSakari Ailus op_pll_bk, cphy, phy_const); 4109e05bbacSSakari Ailus 411cac8f5d2SSakari Ailus pll->pixel_rate_pixel_array = 412cac8f5d2SSakari Ailus pll->vt_bk.pix_clk_freq_hz * pll->vt_lanes; 4139e05bbacSSakari Ailus 414415ddd99SSakari Ailus return check_all_bounds(dev, lim, op_lim_fr, op_lim_bk, pll, op_pll_fr, 415415ddd99SSakari Ailus op_pll_bk); 4169e05bbacSSakari Ailus } 4179e05bbacSSakari Ailus 418415ddd99SSakari Ailus int ccs_pll_calculate(struct device *dev, const struct ccs_pll_limits *lim, 4199e05bbacSSakari Ailus struct ccs_pll *pll) 4209e05bbacSSakari Ailus { 421415ddd99SSakari Ailus const struct ccs_pll_branch_limits_fr *op_lim_fr = &lim->vt_fr; 422415ddd99SSakari Ailus const struct ccs_pll_branch_limits_bk *op_lim_bk = &lim->op_bk; 423415ddd99SSakari Ailus struct ccs_pll_branch_fr *op_pll_fr = &pll->vt_fr; 424415ddd99SSakari Ailus struct ccs_pll_branch_bk *op_pll_bk = &pll->op_bk; 4258030aa4fSSakari Ailus bool cphy = pll->bus_type == CCS_PLL_BUS_TYPE_CSI2_CPHY; 4268030aa4fSSakari Ailus uint32_t phy_const = cphy ? CPHY_CONST : DPHY_CONST; 427415ddd99SSakari Ailus uint16_t min_op_pre_pll_clk_div; 428415ddd99SSakari Ailus uint16_t max_op_pre_pll_clk_div; 4299e05bbacSSakari Ailus uint32_t mul, div; 430c4c0b222SSakari Ailus uint32_t l = (!pll->op_bits_per_lane || 431c4c0b222SSakari Ailus pll->op_bits_per_lane >= pll->bits_per_pixel) ? 1 : 2; 432e583e654SSakari Ailus uint32_t i; 4339e05bbacSSakari Ailus int rval = -EINVAL; 4349e05bbacSSakari Ailus 435cac8f5d2SSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL)) { 436cac8f5d2SSakari Ailus pll->op_lanes = 1; 437cac8f5d2SSakari Ailus pll->vt_lanes = 1; 438cac8f5d2SSakari Ailus } 4399490a227SSakari Ailus 440d7172c0eSSakari Ailus if (!pll->op_lanes || !pll->vt_lanes || !pll->bits_per_pixel || 441d7172c0eSSakari Ailus !pll->ext_clk_freq_hz || !pll->link_freq || !pll->scale_m || 442d7172c0eSSakari Ailus !op_lim_fr->min_pll_ip_clk_freq_hz || 443d7172c0eSSakari Ailus !op_lim_fr->max_pll_ip_clk_freq_hz || 444d7172c0eSSakari Ailus !op_lim_fr->min_pll_op_clk_freq_hz || 445d7172c0eSSakari Ailus !op_lim_fr->max_pll_op_clk_freq_hz || 446d7172c0eSSakari Ailus !op_lim_bk->max_sys_clk_div || !op_lim_fr->max_pll_multiplier) 447d7172c0eSSakari Ailus return -EINVAL; 448d7172c0eSSakari Ailus 4499490a227SSakari Ailus /* 4509490a227SSakari Ailus * Make sure op_pix_clk_div will be integer --- unless flexible 4519490a227SSakari Ailus * op_pix_clk_div is supported 4529490a227SSakari Ailus */ 4539490a227SSakari Ailus if (!(pll->flags & CCS_PLL_FLAG_FLEXIBLE_OP_PIX_CLK_DIV) && 4549490a227SSakari Ailus (pll->bits_per_pixel * pll->op_lanes) % (pll->csi2.lanes * l)) { 4559490a227SSakari Ailus dev_dbg(dev, "op_pix_clk_div not an integer (bpp %u, op lanes %u, lanes %u, l %u)\n", 4569490a227SSakari Ailus pll->bits_per_pixel, pll->op_lanes, pll->csi2.lanes, l); 4579490a227SSakari Ailus return -EINVAL; 4589490a227SSakari Ailus } 4599490a227SSakari Ailus 460cac8f5d2SSakari Ailus dev_dbg(dev, "vt_lanes: %u\n", pll->vt_lanes); 461cac8f5d2SSakari Ailus dev_dbg(dev, "op_lanes: %u\n", pll->op_lanes); 462cac8f5d2SSakari Ailus 4639e05bbacSSakari Ailus if (pll->flags & CCS_PLL_FLAG_NO_OP_CLOCKS) { 4649e05bbacSSakari Ailus /* 4659e05bbacSSakari Ailus * If there's no OP PLL at all, use the VT values 4669e05bbacSSakari Ailus * instead. The OP values are ignored for the rest of 4679e05bbacSSakari Ailus * the PLL calculation. 4689e05bbacSSakari Ailus */ 469415ddd99SSakari Ailus op_lim_fr = &lim->vt_fr; 470415ddd99SSakari Ailus op_lim_bk = &lim->vt_bk; 471415ddd99SSakari Ailus op_pll_bk = &pll->vt_bk; 4729e05bbacSSakari Ailus } 4739e05bbacSSakari Ailus 4749e05bbacSSakari Ailus dev_dbg(dev, "binning: %ux%u\n", pll->binning_horizontal, 4759e05bbacSSakari Ailus pll->binning_vertical); 4769e05bbacSSakari Ailus 4779e05bbacSSakari Ailus switch (pll->bus_type) { 47847b6eaf3SSakari Ailus case CCS_PLL_BUS_TYPE_CSI2_DPHY: 4799e05bbacSSakari Ailus /* CSI transfers 2 bits per clock per lane; thus times 2 */ 480cab27256SSakari Ailus op_pll_bk->sys_clk_freq_hz = pll->link_freq * 2 481cac8f5d2SSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 482ae502e08SSakari Ailus 1 : pll->csi2.lanes); 4839e05bbacSSakari Ailus break; 4848030aa4fSSakari Ailus case CCS_PLL_BUS_TYPE_CSI2_CPHY: 4858030aa4fSSakari Ailus op_pll_bk->sys_clk_freq_hz = 4868030aa4fSSakari Ailus pll->link_freq 4878030aa4fSSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 4888030aa4fSSakari Ailus 1 : pll->csi2.lanes); 4898030aa4fSSakari Ailus break; 4909e05bbacSSakari Ailus default: 4919e05bbacSSakari Ailus return -EINVAL; 4929e05bbacSSakari Ailus } 4939e05bbacSSakari Ailus 494cac8f5d2SSakari Ailus pll->pixel_rate_csi = 4958030aa4fSSakari Ailus div_u64((uint64_t)op_pll_bk->sys_clk_freq_hz 496cac8f5d2SSakari Ailus * (pll->flags & CCS_PLL_FLAG_LANE_SPEED_MODEL ? 4978030aa4fSSakari Ailus pll->csi2.lanes : 1) * PHY_CONST_DIV, 4988030aa4fSSakari Ailus phy_const * pll->bits_per_pixel * l); 499cac8f5d2SSakari Ailus 500415ddd99SSakari Ailus /* Figure out limits for OP pre-pll divider based on extclk */ 501415ddd99SSakari Ailus dev_dbg(dev, "min / max op_pre_pll_clk_div: %u / %u\n", 502415ddd99SSakari Ailus op_lim_fr->min_pre_pll_clk_div, op_lim_fr->max_pre_pll_clk_div); 503415ddd99SSakari Ailus max_op_pre_pll_clk_div = 504415ddd99SSakari Ailus min_t(uint16_t, op_lim_fr->max_pre_pll_clk_div, 5059e05bbacSSakari Ailus clk_div_even(pll->ext_clk_freq_hz / 506415ddd99SSakari Ailus op_lim_fr->min_pll_ip_clk_freq_hz)); 507415ddd99SSakari Ailus min_op_pre_pll_clk_div = 508415ddd99SSakari Ailus max_t(uint16_t, op_lim_fr->min_pre_pll_clk_div, 5099e05bbacSSakari Ailus clk_div_even_up( 5109e05bbacSSakari Ailus DIV_ROUND_UP(pll->ext_clk_freq_hz, 511415ddd99SSakari Ailus op_lim_fr->max_pll_ip_clk_freq_hz))); 512415ddd99SSakari Ailus dev_dbg(dev, "pre-pll check: min / max op_pre_pll_clk_div: %u / %u\n", 513415ddd99SSakari Ailus min_op_pre_pll_clk_div, max_op_pre_pll_clk_div); 5149e05bbacSSakari Ailus 515cab27256SSakari Ailus i = gcd(op_pll_bk->sys_clk_freq_hz, pll->ext_clk_freq_hz); 516cab27256SSakari Ailus mul = op_pll_bk->sys_clk_freq_hz / i; 5179e05bbacSSakari Ailus div = pll->ext_clk_freq_hz / i; 5189e05bbacSSakari Ailus dev_dbg(dev, "mul %u / div %u\n", mul, div); 5199e05bbacSSakari Ailus 520415ddd99SSakari Ailus min_op_pre_pll_clk_div = 521415ddd99SSakari Ailus max_t(uint16_t, min_op_pre_pll_clk_div, 5229e05bbacSSakari Ailus clk_div_even_up( 523482e75e7SSakari Ailus mul / 524482e75e7SSakari Ailus one_or_more( 525482e75e7SSakari Ailus DIV_ROUND_UP(op_lim_fr->max_pll_op_clk_freq_hz, 526482e75e7SSakari Ailus pll->ext_clk_freq_hz)))); 527415ddd99SSakari Ailus dev_dbg(dev, "pll_op check: min / max op_pre_pll_clk_div: %u / %u\n", 528415ddd99SSakari Ailus min_op_pre_pll_clk_div, max_op_pre_pll_clk_div); 5299e05bbacSSakari Ailus 530415ddd99SSakari Ailus for (op_pll_fr->pre_pll_clk_div = min_op_pre_pll_clk_div; 531415ddd99SSakari Ailus op_pll_fr->pre_pll_clk_div <= max_op_pre_pll_clk_div; 5324e1e8d24SSakari Ailus op_pll_fr->pre_pll_clk_div += 5334e1e8d24SSakari Ailus (pll->flags & CCS_PLL_FLAG_EXT_IP_PLL_DIVIDER) ? 1 : 5344e1e8d24SSakari Ailus 2 - (op_pll_fr->pre_pll_clk_div & 1)) { 535415ddd99SSakari Ailus rval = __ccs_pll_calculate(dev, lim, op_lim_fr, op_lim_bk, pll, 5368030aa4fSSakari Ailus op_pll_fr, op_pll_bk, mul, div, l, 5378030aa4fSSakari Ailus cphy, phy_const); 5389e05bbacSSakari Ailus if (rval) 5399e05bbacSSakari Ailus continue; 5409e05bbacSSakari Ailus 5419e05bbacSSakari Ailus print_pll(dev, pll); 5429e05bbacSSakari Ailus return 0; 5439e05bbacSSakari Ailus } 5449e05bbacSSakari Ailus 5459e05bbacSSakari Ailus dev_dbg(dev, "unable to compute pre_pll divisor\n"); 5469e05bbacSSakari Ailus 5479e05bbacSSakari Ailus return rval; 5489e05bbacSSakari Ailus } 5499e05bbacSSakari Ailus EXPORT_SYMBOL_GPL(ccs_pll_calculate); 5509e05bbacSSakari Ailus 5517389d01cSSakari Ailus MODULE_AUTHOR("Sakari Ailus <sakari.ailus@linux.intel.com>"); 5529e05bbacSSakari Ailus MODULE_DESCRIPTION("Generic MIPI CCS/SMIA/SMIA++ PLL calculator"); 553b3c0115eSSakari Ailus MODULE_LICENSE("GPL v2"); 554