#include "motor_drive.h"

#include "esp_log.h"

#define MOTOR_DRIVE "MOTOR_DRIVE"

void motor_drive_uart_init() {}

void motor_drive_turn(int direction, int speed_level, double position) {
  if ((direction > 2) || (direction < 0)) {
    ESP_LOGW(MOTOR_DRIVE, "Direction out of range");
  }
  if ((speed_level > 9) || (speed_level < 0)) {
    ESP_LOGW(MOTOR_DRIVE, "Speed level out of range");
  }
  if ((position > 360) || (position <= 0)) {
    ESP_LOGW(MOTOR_DRIVE, "Position out of range");
  }

  
}

double motor_drive_read_encoder() { return 0.0; }