EdgeBotix / motors

Initial Commit

motors.cpp

Committer:
Throwbot
Date:
2014-10-05
Revision:
1:201d986498c7
Parent:
0:5b2bf6e79b07

File content as of revision 1:201d986498c7:

#include "motors.h"

Motors::Motors(TB6612 * L, TB6612 * R, PinName STBY):
    Left(L), Right(R), enable(STBY)
{
    enable = 1;
}

void Motors::flip()
{
    TB6612 * temp = Left;
    Left = Right;
    Right = temp;

    Left->scale *= -1;
    Right->scale *= -1;              
}    
void Motors::reverse(bool m)
{
    if(m)
        Right->scale *= -1; //reverse right motor
    else
        Left->scale *= -1;  //reverse left motor
}

//TODO: write in a function that automatically sets the motors to be oriented properly. Use the
//gyroscopes and accelerometer to do this.