#include <stdio.h>
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "stepper_motor.h"

void app_main(void) {
    // 初始化所有馬達的 GPIO 腳位
    stepper_motors_init();
    
    while(1) {
        printf("讓第一個馬達轉動 400 步...\n");
        moveMotor(0, 400); // 轉動馬達 0，轉 400 步 (2圈)
        vTaskDelay(pdMS_TO_TICKS(5000)); // 延遲 5 秒
        
        printf("讓第二個馬達反向轉動 200 步...\n");
        moveMotor(1, -200); // 轉動馬達 1，反向轉 200 步 (1圈)
        vTaskDelay(pdMS_TO_TICKS(5000)); // 延遲 5 秒
    }
}