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);
    }
}