#include "driveModi.h"

DriveModi::DriveModi(MoveControl* moveControl, ControlPadInput* input, SensorData* sensorData) {
    this->moveControl = moveControl;
    this->input = input;
    this->sensorData = sensorData;
    this->init();
}

DriveModi::DriveModi(DriveModiParams params){
    this->moveControl = params.moveControl;
    this->input = params.input;
    this->sensorData = params.sensorData;
    this->init();
}

DriveModi::~DriveModi() {
    this->moveControl->setSpeed(0);
    this->moveControl->setRotationSpeed(0);
    this->moveControl->setDrivingStatus(MoveControl::Status::Stop);
}

void DriveModi::init() {
    this->moveControl->setDrivingStatus(MoveControl::Status::Drive);
    this->loopDelay = 40;
}