// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2012 ST Microelectronics
 * Viresh Kumar <vireshk@kernel.org>
 *
 * SPEAr clk - Common routines
 */

#include <linux/clk-provider.h>
#include <linux/types.h>
#include "clk.h"

long clk_round_rate_index(struct clk_hw *hw, unsigned long drate,
                unsigned long parent_rate, clk_calc_rate calc_rate, u8 rtbl_cnt,
                int *index)
{
        unsigned long prev_rate, rate = 0;

        for (*index = 0; *index < rtbl_cnt; (*index)++) {
                prev_rate = rate;
                rate = calc_rate(hw, parent_rate, *index);
                if (drate < rate) {
                        /* previous clock was best */
                        if (*index) {
                                rate = prev_rate;
                                (*index)--;
                        }
                        break;
                }
        }

        if ((*index) == rtbl_cnt)
                (*index)--;

        return rate;
}