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.