zhaw_st16b_pes2_10 / Mbed 2 deprecated Motors

d

Dependencies:   mbed mbed

Robot.cpp

Committer:
beacon
Date:
2017-03-08
Revision:
0:d4a8d6a32b36

File content as of revision 0:d4a8d6a32b36:

#include "Robot.h"

/* Work in progress -------------------------------------------- */

Robot::Robot(PwmOut* left, PwmOut* right, DigitalOut* enableSignal){
    this->powerSignal = enableSignal;
    this->left = left;
    this->right = right;
    
    this->left->period(0.00005f);
    this->right->period(0.00005f);
    }

/* work in progress ------------------------------------------- */
void Robot::drive(){
	//pwm determine what direction it goes.
    *powerSignal = 1;
    *left = 0.5;
    *right = 0.5;
}

//Remember to set 
//DigitalOut powerMotor(PB_2) = 1;
//DigitalIn errorMotor(PB_14);
//if (errorMotor){
	//reset
//}

//Add management for Overpower!! Pin PB_15