Diff: targets/TARGET_Maxim/TARGET_MAX32625/mxc/pmu.c

Revision:

0:5c4d7b2438d3

diff -r 000000000000 -r 5c4d7b2438d3 targets/TARGET_Maxim/TARGET_MAX32625/mxc/pmu.c
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/targets/TARGET_Maxim/TARGET_MAX32625/mxc/pmu.c	Fri Nov 11 20:59:50 2016 +0000
@@ -0,0 +1,236 @@
+/*******************************************************************************
+ * Copyright (C) 2016 Maxim Integrated Products, Inc., All Rights Reserved.
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included
+ * in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+ * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES
+ * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
+ * OTHER DEALINGS IN THE SOFTWARE.
+ *
+ * Except as contained in this notice, the name of Maxim Integrated
+ * Products, Inc. shall not be used except as stated in the Maxim Integrated
+ * Products, Inc. Branding Policy.
+ *
+ * The mere transfer of this software does not imply any licenses
+ * of trade secrets, proprietary technology, copyrights, patents,
+ * trademarks, maskwork rights, or any other form of intellectual
+ * property whatsoever. Maxim Integrated Products, Inc. retains all
+ * ownership rights.
+ *
+ * $Date: 2016-06-21 16:19:28 -0500 (Tue, 21 Jun 2016) $
+ * $Revision: 23450 $
+ *
+ ******************************************************************************/
+
+#include <stdio.h>
+#include <stddef.h>
+#include "mxc_config.h"
+#include "mxc_assert.h"
+#include "pmu.h"
+
+#if (MXC_PMU_REV == 0)
+/* MAX32630 A1 & A2 Erratum #6: PMU only supports channels 0-4 -- workaround */
+#include "clkman_regs.h"
+/* Channel 5 infinite loop program */
+static const uint32_t pmu_0[] = {
+    PMU_JUMP(0, 0, (uint32_t)pmu_0)
+};
+#endif
+
+static void (*callbacks[MXC_CFG_PMU_CHANNELS])(int);
+
+
+/******************************************************************************/
+void PMU_Handler(void)
+{
+    int channel;
+    uint32_t cfg1, cfg2;
+    mxc_pmu_regs_t *MXC_PMUn;
+
+    for (channel = 0; channel < MXC_CFG_PMU_CHANNELS; channel++) {
+        MXC_PMUn = &MXC_PMU0[channel];
+
+        if (MXC_PMUn->cfg & MXC_F_PMU_CFG_INTERRUPT) {
+            cfg1 = MXC_PMUn->cfg;
+            /* Since any set flags will be cleared by the write-back below, mask them off */
+            cfg2 = cfg1 & ~(MXC_F_PMU_CFG_LL_STOPPED | MXC_F_PMU_CFG_BUS_ERROR | MXC_F_PMU_CFG_TO_STAT);
+
+            /* Clear the interrupt flag */
+            MXC_PMUn->cfg = cfg2 | MXC_F_PMU_CFG_INTERRUPT;
+
+            if (callbacks[channel]) {
+                callbacks[channel](cfg1);
+            }
+        }
+    }
+}
+
+/******************************************************************************/
+int PMU_Start(unsigned int channel, const void *program_address, pmu_callback callback)
+{
+    if(channel >= MXC_CFG_PMU_CHANNELS)
+        return E_BAD_PARAM;
+
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    uint32_t cfg = MXC_PMUn->cfg;
+
+    /* is this channel already running? */
+    if (cfg & MXC_F_PMU_CFG_ENABLE) {
+        return E_BUSY;
+    }
+
+#if (MXC_PMU_REV == 0)
+    /* MAX32630 A1 & A2 Erratum #6: PMU only supports channels 0-4 */
+    if (channel == 5) {
+        /* Channel 5 is used for the work-around */
+        return E_BUSY;
+    }
+    /* Select always-ON clock for PMU */
+    MXC_CLKMAN->clk_gate_ctrl0 |= MXC_F_CLKMAN_CLK_GATE_CTRL0_PMU_CLK_GATER;
+    /* Start channel 5 with infinite-loop program */
+    MXC_PMU5->cfg &= ~MXC_F_PMU_CFG_ENABLE; /* Clear enable and wipe W1C flags */
+    MXC_PMU5->dscadr = (uint32_t)pmu_0;
+    MXC_PMU5->cfg = MXC_F_PMU_CFG_ENABLE | (0x1c << MXC_F_PMU_CFG_BURST_SIZE_POS);
+#endif
+    /* Set callback */
+    callbacks[channel] = callback;
+
+    /* Set start op-code */
+    MXC_PMUn->dscadr = (uint32_t)program_address;
+
+    /* Configure the channel */
+    cfg = (cfg & ~(MXC_F_PMU_CFG_MANUAL | MXC_F_PMU_CFG_BURST_SIZE)) | (0x1c << MXC_F_PMU_CFG_BURST_SIZE_POS);
+
+    /* Enable if necessary */
+    if (callback) {
+        cfg |= MXC_F_PMU_CFG_INT_EN;
+    } else {
+        cfg &= ~MXC_F_PMU_CFG_INT_EN;
+    }
+
+    /* Start the channel */
+    cfg |= MXC_F_PMU_CFG_ENABLE;
+
+    /*If any W1C flags are set, this write will clear them */
+    MXC_PMUn->cfg = cfg;
+
+    return E_NO_ERROR;
+}
+
+/******************************************************************************/
+void PMU_Stop(unsigned int channel)
+{
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    uint32_t cfg = MXC_PMUn->cfg;
+
+    /* Since any set flags will be cleared by the write-back below, mask them off */
+    cfg &= ~(MXC_F_PMU_CFG_LL_STOPPED | MXC_F_PMU_CFG_BUS_ERROR | MXC_F_PMU_CFG_TO_STAT | MXC_F_PMU_CFG_INTERRUPT);
+
+    /* Clear the enable bit to stop the channel */
+    cfg &= ~MXC_F_PMU_CFG_ENABLE;
+
+    MXC_PMUn->cfg = cfg;
+
+    /* Remove callback */
+    callbacks[channel] = NULL;
+
+#if (MXC_PMU_REV == 0)
+    /* MAX32630 A1 & A2 Erratum #6: PMU only supports channels 0-4 */
+    /* Check channels 0-4 for any running channels. If none found, stop channel 5 */
+    if ((MXC_PMU0->cfg & MXC_F_PMU_CFG_ENABLE) == 0 &&
+        (MXC_PMU1->cfg & MXC_F_PMU_CFG_ENABLE) == 0 &&
+        (MXC_PMU2->cfg & MXC_F_PMU_CFG_ENABLE) == 0 &&
+        (MXC_PMU3->cfg & MXC_F_PMU_CFG_ENABLE) == 0 &&
+        (MXC_PMU4->cfg & MXC_F_PMU_CFG_ENABLE) == 0) {
+
+        MXC_PMU5->cfg &= ~MXC_F_PMU_CFG_ENABLE;
+    }
+#endif
+
+}
+
+/******************************************************************************/
+int PMU_SetCounter(unsigned int channel, unsigned int counter, uint16_t value)
+{
+    if((channel >= MXC_CFG_PMU_CHANNELS) || counter > 1)
+        return E_BAD_PARAM;
+
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+
+    if (counter == 0) {
+        MXC_PMUn->loop = (MXC_PMUn->loop & ~MXC_F_PMU_LOOP_COUNTER_0) | (value << MXC_F_PMU_LOOP_COUNTER_0_POS);
+    } else {
+        MXC_PMUn->loop = (MXC_PMUn->loop & ~MXC_F_PMU_LOOP_COUNTER_1) | (value << MXC_F_PMU_LOOP_COUNTER_1_POS);
+    }
+
+    return E_NO_ERROR;
+}
+
+/******************************************************************************/
+int PMU_SetTimeout(unsigned int channel, pmu_ps_sel_t timeoutClkScale, pmu_to_sel_t timeoutTicks)
+{
+    if(channel >= MXC_CFG_PMU_CHANNELS)
+        return E_BAD_PARAM;
+
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    uint32_t cfg = MXC_PMUn->cfg;
+
+    /* Since any set flags will be cleared by the write-back below, mask them off */
+    cfg &= ~(MXC_F_PMU_CFG_LL_STOPPED | MXC_F_PMU_CFG_BUS_ERROR | MXC_F_PMU_CFG_TO_STAT | MXC_F_PMU_CFG_INTERRUPT);
+
+    /* Adjust timeout settings */
+    cfg &= ~(MXC_F_PMU_CFG_TO_SEL | MXC_F_PMU_CFG_PS_SEL);
+    cfg |= ((timeoutClkScale << MXC_F_PMU_CFG_PS_SEL_POS) & MXC_F_PMU_CFG_PS_SEL) |
+           ((timeoutTicks << MXC_F_PMU_CFG_TO_SEL_POS) & MXC_F_PMU_CFG_TO_SEL);
+
+    MXC_PMUn->cfg = cfg;
+
+    return E_NO_ERROR;
+}
+
+/******************************************************************************/
+uint32_t PMU_GetFlags(unsigned int channel)
+{
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    uint32_t cfg = MXC_PMUn->cfg;
+
+    /* Mask off configuration bits leaving only flag bits */
+    cfg &= ~(MXC_F_PMU_CFG_ENABLE | MXC_F_PMU_CFG_MANUAL | MXC_F_PMU_CFG_TO_SEL | MXC_F_PMU_CFG_PS_SEL |
+             MXC_F_PMU_CFG_INT_EN | MXC_F_PMU_CFG_BURST_SIZE);
+
+    return cfg;
+}
+
+/******************************************************************************/
+void PMU_ClearFlags(unsigned int channel, unsigned int mask)
+{
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    uint32_t cfg = MXC_PMUn->cfg;
+
+    /* Since any set flags will be cleared by the write-back below, mask them off */
+    cfg &= ~(MXC_F_PMU_CFG_LL_STOPPED | MXC_F_PMU_CFG_BUS_ERROR | MXC_F_PMU_CFG_TO_STAT | MXC_F_PMU_CFG_INTERRUPT);
+
+    /* Now, apply the caller-supplied bits to clear */
+    cfg |= mask;
+
+    MXC_PMUn->cfg = cfg;
+}
+
+/******************************************************************************/
+uint32_t PMU_IsActive(unsigned int channel)
+{
+    mxc_pmu_regs_t *MXC_PMUn = &MXC_PMU0[channel];
+    return (MXC_PMUn->cfg & MXC_F_PMU_CFG_ENABLE);
+}