~aleteoryx/muditaos

ref: 3cbbeff551230786ae13c23a7bf4fa8c50099896 muditaos/module-bsp/board/rt1051/drivers/RT1051DriverPLL2.cpp -rw-r--r-- 2.2 KiB
3cbbeff5 — Lefucjusz [MOS-1011] Fix frequency switching stability 2 years ago 
                                                                                
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70

// Copyright (c) 2017-2023, Mudita Sp. z.o.o. All rights reserved.
// For licensing, see https://github.com/mudita/MuditaOS/LICENSE.md

#include "RT1051DriverPLL2.hpp"
#include "board/rt1051/bsp/lpm/ClockState.hpp"
#include "board/rt1051/bsp/lpm/CpuFreqLPM.hpp"
#include "board/rt1051/bsp/lpm/Bandgap.hpp"
#include "board/rt1051/bsp/lpm/LDO.hpp"
#include "board/rt1051/bsp/lpm/DCDC.hpp"

namespace
{
    inline std::uint32_t getCurrentVDDRunVoltage()
    {
        return (DCDC->REG3 & DCDC_REG3_TRG_MASK);
    }
} // namespace

namespace drivers
{
    RT1051DriverPLL2::RT1051DriverPLL2() noexcept
    {
        if (!IsPLL2Enabled()) {
            /* Check if switching conditions already met */
            const auto isCurrentVoltageOverdrive = (getCurrentVDDRunVoltage() >= bsp::VDDRun_1275_mV);
            if (!isCurrentVoltageOverdrive) {
                bsp::dcdc::SwitchToOverdriveConfig();
            }

            /* Switch to regular bandgap */
            bsp::bandgap::SwitchToRegularMode();

            /* Switch to regular LDO */
            bsp::ldo::SwitchToRegularMode();

            /* Switch back to regular config */
            if (!isCurrentVoltageOverdrive) {
                bsp::dcdc::SwitchToRegularConfig();
            }

            /* Enable PLL2 */
            clkPLL2setup(CLK_ENABLE);
        }
    }

    RT1051DriverPLL2::~RT1051DriverPLL2() noexcept
    {
        if ((CLOCK_GetMux(kCLOCK_SemcMux) == SemcMuxPeripheralClock) && !bsp::IsClockEnabled(kCLOCK_Lpspi1) &&
            !bsp::IsClockEnabled(kCLOCK_Lpspi2) && !bsp::IsClockEnabled(kCLOCK_Lpspi3) &&
            !bsp::IsClockEnabled(kCLOCK_Lpspi4) && !bsp::IsClockEnabled(kCLOCK_Usdhc1) &&
            !bsp::IsClockEnabled(kCLOCK_Usdhc2)) {
            /* Disable PLL2 */
            clkPLL2setup(CLK_DISABLE);

            /* Switch DCDC to low power config */
            bsp::dcdc::SwitchToLowPowerConfig();

            /* Switch to low power LDO */
            bsp::ldo::SwitchToLowPowerMode();

            /* Switch to low power bandgap */
            bsp::bandgap::SwitchToLowPowerMode();
        }
    }

    bool RT1051DriverPLL2::IsPLL2Enabled() const noexcept
    {
        return not static_cast<bool>(CCM_ANALOG->PLL_SYS & CCM_ANALOG_PLL_SYS_POWERDOWN_MASK);
    }
} // namespace drivers