Drive.h

Go to the documentation of this file.

#ifndef DRIVE_H
#define DRIVE_H

#include <Adafruit_MotorShield.h>  //https://github.com/adafruit/Adafruit_Motor_Shield_V2_Library
#include <Arduino.h>

#include "LogConfiguration.h"

/* https://learn.adafruit.com/adafruit-motor-shield-v2-for-arduino/library-reference

void run(uint8_t)
FORWARD - Rotate in a forward direction
BACKWARD - Rotate in the reverse direction
RELEASE - Stop rotation
Also note that "RELEASE" simply cuts power to the motor. It does not apply any braking.

void setSpeed(uint8_t);
The setSpeed() function controls the power level delivered to the motor.
The speed parameter is a value between 0 and 255.
*/

class Drive {
    //=====PUBLIC====================================================================================
   public:
    enum class Direction {
        Left,     
        Right,    
        Forward,  
        Backward  
    };

    Drive(const int MotorPortRight, const int MotorPortLeft);
    void drive(Direction direction, unsigned int speed);

    void turn(Direction direction, unsigned int speed);

    void turnonpoint(Direction direction, unsigned int speed);

    void stop();

    //=====PRIVATE===================================================================================
   private:
    Adafruit_MotorShield pAFMS = Adafruit_MotorShield();  // Create the motor shield object with the default I2C address
    Adafruit_DCMotor *pMotorRight;                        
    Adafruit_DCMotor *pMotorLeft;                         
    int pSpeedLeft;                                       
    int pSpeedRight;                                      
    int pTurnSpeedLeft;
    int pTurnSpeedRight;
    Direction pWayVehicle = Direction::Forward;  
    //============================================================================
    //==Aux-Function==============================================================
    String decodeDirection(Direction direction);
};
#endif