1 files changed, 13 insertions, 0 deletions

diff --git a/drivers/soc/fsl/qe/qe.c b/drivers/soc/fsl/qe/qe.c
index d9c04f588f7f..31a094573a9d 100644
--- a/drivers/soc/fsl/qe/qe.c
+++ b/drivers/soc/fsl/qe/qe.c
@@ -161,11 +161,15 @@ EXPORT_SYMBOL(qe_issue_cmd);
  */
 static unsigned int brg_clk = 0;
 
+#define CLK_GRAN        (1000)
+#define CLK_GRAN_LIMIT  (5)
+
 unsigned int qe_get_brg_clk(void)
 {
         struct device_node *qe;
         int size;
         const u32 *prop;
+        unsigned int mod;
 
         if (brg_clk)
                 return brg_clk;
@@ -183,6 +187,15 @@ unsigned int qe_get_brg_clk(void)
 
         of_node_put(qe);
 
+        /* round this if near to a multiple of CLK_GRAN */
+        mod = brg_clk % CLK_GRAN;
+        if (mod) {
+                if (mod < CLK_GRAN_LIMIT)
+                        brg_clk -= mod;
+                else if (mod > (CLK_GRAN - CLK_GRAN_LIMIT))
+                        brg_clk += CLK_GRAN - mod;
+        }
+
         return brg_clk;
 }
 EXPORT_SYMBOL(qe_get_brg_clk);