forked from luck/tmp_suning_uos_patched
323dd2c3ed
In some cases the previous algorithm would not return the closest
approximation. This would happen when a semi-convergent was the
closest, as the previous algorithm would only consider convergents.
As an example, consider an initial value of 5/4, and trying to find the
closest approximation with a maximum of 4 for numerator and denominator.
The previous algorithm would return 1/1 as the closest approximation,
while this version will return the correct answer of 4/3.
To do this, the main loop performs effectively the same operations as it
did before. It must now keep track of the last three approximations,
n2/d2 .. n0/d0, while before it only needed the last two.
If an exact answer is not found, the algorithm will now calculate the
best semi-convergent term, t, which is a single expression with two
divisions:
min((max_numerator - n0) / n1, (max_denominator - d0) / d1)
This will be used if it is better than previous convergent. The test
for this is generally a simple comparison, 2*t > a. But in an edge
case, where the convergent's final term is even and the best allowable
semi-convergent has a final term of exactly half the convergent's final
term, the more complex comparison (d0*dp > d1*d) is used.
I also wrote some comments explaining the code. While one still needs
to look up the math elsewhere, they should help a lot to follow how the
code relates to that math.
This routine is used in two places in the video4linux code, but in those
cases it is only used to reduce a fraction to lowest terms, which the
existing code will do correctly. This could be done more efficiently
with a different library routine but it would still be the Euclidean
alogrithm at its heart. So no change.
The remain users are places where a fractional PLL divider is
programmed. What would happen is something asked for a clock of X MHz
but instead gets Y MHz, where Y is close to X but not exactly due to the
hardware limitations. After this change they might, in some cases, get
Y' MHz, where Y' is a little closer to X then Y was.
Users like this are: Three UARTs, in 8250_mid, 8250_lpss, and imx. One
GPU in vp4_hdmi. And three clock drivers, clk-cdce706, clk-si5351, and
clk-fractional-divider. The last is a generic clock driver and so would
have more users referenced via device tree entries.
I think there's a bug in that one, it's limiting an N bit field that is
offset-by-1 to the range 0 .. (1<<N)-2, when it should be (1<<N)-1 as
the upper limit.
I have an IMX system, one of the UARTs using this, so I can provide a
real example. If I request a custom baud rate of 1499978, the driver
will program the PLL to produce a baud rate of 1500000. After this
change, the fractional divider in the UART is programmed to a ratio of
65535/65536, which produces a baud rate of 1499977.0625. Closer to the
requested value.
Link: http://lkml.kernel.org/r/20190330205855.19396-1-tpiepho@gmail.com
Signed-off-by: Trent Piepho <tpiepho@gmail.com>
Cc: Oskar Schirmer <oskar@scara.com>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
103 lines
2.7 KiB
C
103 lines
2.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* rational fractions
|
|
*
|
|
* Copyright (C) 2009 emlix GmbH, Oskar Schirmer <oskar@scara.com>
|
|
* Copyright (C) 2019 Trent Piepho <tpiepho@gmail.com>
|
|
*
|
|
* helper functions when coping with rational numbers
|
|
*/
|
|
|
|
#include <linux/rational.h>
|
|
#include <linux/compiler.h>
|
|
#include <linux/export.h>
|
|
#include <linux/kernel.h>
|
|
|
|
/*
|
|
* calculate best rational approximation for a given fraction
|
|
* taking into account restricted register size, e.g. to find
|
|
* appropriate values for a pll with 5 bit denominator and
|
|
* 8 bit numerator register fields, trying to set up with a
|
|
* frequency ratio of 3.1415, one would say:
|
|
*
|
|
* rational_best_approximation(31415, 10000,
|
|
* (1 << 8) - 1, (1 << 5) - 1, &n, &d);
|
|
*
|
|
* you may look at given_numerator as a fixed point number,
|
|
* with the fractional part size described in given_denominator.
|
|
*
|
|
* for theoretical background, see:
|
|
* http://en.wikipedia.org/wiki/Continued_fraction
|
|
*/
|
|
|
|
void rational_best_approximation(
|
|
unsigned long given_numerator, unsigned long given_denominator,
|
|
unsigned long max_numerator, unsigned long max_denominator,
|
|
unsigned long *best_numerator, unsigned long *best_denominator)
|
|
{
|
|
/* n/d is the starting rational, which is continually
|
|
* decreased each iteration using the Euclidean algorithm.
|
|
*
|
|
* dp is the value of d from the prior iteration.
|
|
*
|
|
* n2/d2, n1/d1, and n0/d0 are our successively more accurate
|
|
* approximations of the rational. They are, respectively,
|
|
* the current, previous, and two prior iterations of it.
|
|
*
|
|
* a is current term of the continued fraction.
|
|
*/
|
|
unsigned long n, d, n0, d0, n1, d1, n2, d2;
|
|
n = given_numerator;
|
|
d = given_denominator;
|
|
n0 = d1 = 0;
|
|
n1 = d0 = 1;
|
|
|
|
for (;;) {
|
|
unsigned long dp, a;
|
|
|
|
if (d == 0)
|
|
break;
|
|
/* Find next term in continued fraction, 'a', via
|
|
* Euclidean algorithm.
|
|
*/
|
|
dp = d;
|
|
a = n / d;
|
|
d = n % d;
|
|
n = dp;
|
|
|
|
/* Calculate the current rational approximation (aka
|
|
* convergent), n2/d2, using the term just found and
|
|
* the two prior approximations.
|
|
*/
|
|
n2 = n0 + a * n1;
|
|
d2 = d0 + a * d1;
|
|
|
|
/* If the current convergent exceeds the maxes, then
|
|
* return either the previous convergent or the
|
|
* largest semi-convergent, the final term of which is
|
|
* found below as 't'.
|
|
*/
|
|
if ((n2 > max_numerator) || (d2 > max_denominator)) {
|
|
unsigned long t = min((max_numerator - n0) / n1,
|
|
(max_denominator - d0) / d1);
|
|
|
|
/* This tests if the semi-convergent is closer
|
|
* than the previous convergent.
|
|
*/
|
|
if (2u * t > a || (2u * t == a && d0 * dp > d1 * d)) {
|
|
n1 = n0 + t * n1;
|
|
d1 = d0 + t * d1;
|
|
}
|
|
break;
|
|
}
|
|
n0 = n1;
|
|
n1 = n2;
|
|
d0 = d1;
|
|
d1 = d2;
|
|
}
|
|
*best_numerator = n1;
|
|
*best_denominator = d1;
|
|
}
|
|
|
|
EXPORT_SYMBOL(rational_best_approximation);
|