#include <stdio.h>
#include "pico/stdlib.h"

#define LED_MERAH  14
#define LED_KUNING 15
#define LED_HIJAU  16

int main() {
    stdio_init_all();

    gpio_init(LED_MERAH);
    gpio_set_dir(LED_MERAH, GPIO_OUT);

    gpio_init(LED_KUNING);
    gpio_set_dir(LED_KUNING, GPIO_OUT);

    gpio_init(LED_HIJAU);
    gpio_set_dir(LED_HIJAU, GPIO_OUT);

    while (true) {
        gpio_put(LED_MERAH, 1);
        gpio_put(LED_KUNING, 0);
        gpio_put(LED_HIJAU, 0);
        printf("Kendaraan Harap Berhenti\n");
        sleep_ms(3000);

        gpio_put(LED_MERAH, 0);
        gpio_put(LED_KUNING, 1);
        gpio_put(LED_HIJAU, 0);
        printf("Persiapan\n");
        sleep_ms(1000);

        gpio_put(LED_MERAH, 0);
        gpio_put(LED_KUNING, 0);
        gpio_put(LED_HIJAU, 1);
        printf("Silakan Jalan\n");
        sleep_ms(3000);
    }

    return 0;
}