power-seq-software-seeed-rp2040/power-seq-software-seeed-rp2040.cpp


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

#include <cstddef>
#include <cstdint>
#include <array>
#include "pico/stdlib.h"
#include "pico/sleep.h"
#include "hardware/gpio.h"

#define PIN0 26
#define PIN1 27
#define PIN2 28
#define PIN3 29
#define PIN4 6

static constexpr std::size_t button_gpio = PIN4;
static constexpr std::size_t led_gpio = PIN0;
static constexpr std::array<std::size_t, 3> gpio_on_sequence { PIN1, PIN2, PIN3 };
static constexpr std::array<std::size_t, 3> gpio_off_sequence { PIN3, PIN2, PIN1 };
static constexpr std::size_t delay_ms = 2000;

int main()
{
    bool state = false;

    // init LED
    gpio_init(led_gpio);
    gpio_set_dir(led_gpio, GPIO_OUT);
    gpio_put(led_gpio, state);

    // init relay GPIOs
    for (auto const & relay : gpio_off_sequence)
    {
        gpio_init(relay);
        gpio_set_dir(relay, GPIO_OUT);
        gpio_put(relay, state);
    }

    while (true)
    {
        sleep_run_from_xosc();
        sleep_goto_dormant_until_edge_high(button_gpio);
        sleep_power_up();

        state = !state;
        gpio_put(led_gpio, state);

        auto const & sequence = state ? gpio_on_sequence : gpio_off_sequence;
        for (auto const & relay : sequence)
        {
            gpio_put(relay, state);
            sleep_ms(delay_ms);
        }
    }
}