Sophia, an autonomous robot based on Tamiya kits
Sophia.cpp
- Committer:
- cylax
- Date:
- 2013-05-09
- Revision:
- 1:575431135236
- Parent:
- 0:db79273ace80
File content as of revision 1:575431135236:
#include "mbed.h"
#include "Motor.h"
#include "Sophia.h"
Motor motor_right(PTD4, PTC13, PTC12); // pwm, fwd, rev
Motor motor_left(PTD4, PTA13, PTD5);
void Sophia::move(float speed, int direction) {
if(direction) {
motor_right.speed(speed);
motor_left.speed(speed);
}
else {
motor_right.speed(-speed);
motor_left.speed(-speed);
}
}
void Sophia::turn(float speed, int direction) {
if(direction) {
motor_right.speed(0.0);
motor_left.speed(speed);
}
else {
motor_right.speed(speed);
motor_left.speed(0.0);
}
}
void Sophia::spin(float speed, int direction) {
if(direction) {
motor_right.speed(-speed);
motor_left.speed(speed);
}
else {
motor_right.speed(speed);
motor_left.speed(-speed);
}
}