d

Dependencies:   mbed mbed

Committer:
beacon
Date:
Wed Mar 08 16:49:14 2017 +0000
Revision:
0:d4a8d6a32b36
l

Who changed what in which revision?

UserRevisionLine numberNew contents of line
beacon 0:d4a8d6a32b36 1 #include "Robot.h"
beacon 0:d4a8d6a32b36 2
beacon 0:d4a8d6a32b36 3 /* Work in progress -------------------------------------------- */
beacon 0:d4a8d6a32b36 4
beacon 0:d4a8d6a32b36 5 Robot::Robot(PwmOut* left, PwmOut* right, DigitalOut* enableSignal){
beacon 0:d4a8d6a32b36 6 this->powerSignal = enableSignal;
beacon 0:d4a8d6a32b36 7 this->left = left;
beacon 0:d4a8d6a32b36 8 this->right = right;
beacon 0:d4a8d6a32b36 9
beacon 0:d4a8d6a32b36 10 this->left->period(0.00005f);
beacon 0:d4a8d6a32b36 11 this->right->period(0.00005f);
beacon 0:d4a8d6a32b36 12 }
beacon 0:d4a8d6a32b36 13
beacon 0:d4a8d6a32b36 14 /* work in progress ------------------------------------------- */
beacon 0:d4a8d6a32b36 15 void Robot::drive(){
beacon 0:d4a8d6a32b36 16 //pwm determine what direction it goes.
beacon 0:d4a8d6a32b36 17 *powerSignal = 1;
beacon 0:d4a8d6a32b36 18 *left = 0.5;
beacon 0:d4a8d6a32b36 19 *right = 0.5;
beacon 0:d4a8d6a32b36 20 }
beacon 0:d4a8d6a32b36 21
beacon 0:d4a8d6a32b36 22 //Remember to set
beacon 0:d4a8d6a32b36 23 //DigitalOut powerMotor(PB_2) = 1;
beacon 0:d4a8d6a32b36 24 //DigitalIn errorMotor(PB_14);
beacon 0:d4a8d6a32b36 25 //if (errorMotor){
beacon 0:d4a8d6a32b36 26 //reset
beacon 0:d4a8d6a32b36 27 //}
beacon 0:d4a8d6a32b36 28
beacon 0:d4a8d6a32b36 29 //Add management for Overpower!! Pin PB_15