Diff: noos_mbed/util/clk.c

Revision:

0:e8a1ba50c46b

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/noos_mbed/util/clk.c	Thu Jan 14 19:12:57 2021 +0530
@@ -0,0 +1,128 @@
+/***************************************************************************//**
+ *   @file   clk.c
+ *   @brief  Implementation of Clock Driver.
+ *   @author DBogdan (dragos.bogdan@analog.com)
+********************************************************************************
+ * Copyright 2020(c) Analog Devices, Inc.
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *  - Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ *  - Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ *  - Neither the name of Analog Devices, Inc. nor the names of its
+ *    contributors may be used to endorse or promote products derived
+ *    from this software without specific prior written permission.
+ *  - The use of this software may or may not infringe the patent rights
+ *    of one or more patent holders.  This license does not release you
+ *    from the requirement that you obtain separate licenses from these
+ *    patent holders to use this software.
+ *  - Use of the software either in source or binary form, must be run
+ *    on or directly connected to an Analog Devices Inc. component.
+ *
+ * THIS SOFTWARE IS PROVIDED BY ANALOG DEVICES "AS IS" AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, NON-INFRINGEMENT,
+ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL ANALOG DEVICES BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+ * LIMITED TO, INTELLECTUAL PROPERTY RIGHTS, PROCUREMENT OF SUBSTITUTE GOODS OR
+ * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+ * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+ * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*******************************************************************************/
+
+/******************************************************************************/
+/***************************** Include Files **********************************/
+/******************************************************************************/
+#include "error.h"
+#include "clk.h"
+
+/******************************************************************************/
+/************************** Functions Implementation **************************/
+/******************************************************************************/
+
+/**
+ * Start the clock.
+ * @param clk - The clock structure.
+ * @return SUCCESS in case of success, negative error code otherwise.
+ */
+int32_t clk_enable(struct clk * clk)
+{
+	if (clk->hw->dev_clk_enable)
+		return clk->hw->dev_clk_enable(clk->hw->dev);
+	else
+		return FAILURE;
+}
+
+/**
+ * Stop the clock.
+ * @param clk - The clock structure.
+ * @return SUCCESS in case of success, negative error code otherwise.
+ */
+int32_t clk_disable(struct clk * clk)
+{
+	if (clk->hw->dev_clk_disable)
+		return clk->hw->dev_clk_disable(clk->hw->dev);
+	else
+		return FAILURE;
+}
+
+/**
+ * Get the current frequency of the clock.
+ * @param clk - The clock structure.
+ * @param rate - The current frequency.
+ * @return SUCCESS in case of success, negative error code otherwise.
+ */
+int32_t clk_recalc_rate(struct clk *clk,
+			uint64_t *rate)
+{
+	if (clk->hw->dev_clk_recalc_rate)
+		return clk->hw->dev_clk_recalc_rate(clk->hw->dev,
+						    clk->hw_ch_num,
+						    rate);
+	else
+		return FAILURE;
+}
+
+/**
+ * Round the desired frequency to a rate that the clock can actually output.
+ * @param clk - The clock structure.
+ * @param rate - The desired frequency.
+ * @param rounded_rate - The rounded frequency.
+ * @return SUCCESS in case of success, negative error code otherwise.
+ */
+int32_t clk_round_rate(struct clk *clk,
+		       uint64_t rate,
+		       uint64_t *rounded_rate)
+{
+	if (clk->hw->dev_clk_round_rate)
+		return clk->hw->dev_clk_round_rate(clk->hw->dev,
+						   clk->hw_ch_num,
+						   rate,
+						   rounded_rate);
+	else
+		return FAILURE;
+}
+
+/**
+ * Change the frequency of the clock.
+ * @param clk - The clock structure.
+ * @param rate - The desired frequency.
+ * @return SUCCESS in case of success, negative error code otherwise.
+ */
+int32_t clk_set_rate(struct clk *clk,
+		     uint64_t rate)
+{
+	if (clk->hw->dev_clk_set_rate)
+		return clk->hw->dev_clk_set_rate(clk->hw->dev,
+						 clk->hw_ch_num,
+						 rate);
+	else
+		return FAILURE;
+}