dangerous spin things

Dependencies:   Motor mbed

main.cpp

Committer:
tsevcik08
Date:
2014-10-16
Revision:
1:90b569aa2335
Parent:
0:fa52c6fc593f

File content as of revision 1:90b569aa2335:

#include "mbed.h"
#include "Motor.h"

Motor kate(p26, p29, p30);
DigitalIn sw2(p17);
DigitalIn sw3(p18);

int main()
{
    float mspeed;
    while(1) {
        if( sw2 == 1 ) {
            mspeed = 0.35;
            kate.speed(mspeed);
            wait(.03);
            mspeed = 0.0;
            kate.speed(mspeed);
            wait(.05);
            
        } else if (sw2 == 0) {
            mspeed = 0.0;
            kate.speed(mspeed);
        }
        else if(( sw2 == 1 && sw3 == 1)){ 
            mspeed = 0.0;
            kate.speed(mspeed);
            }
        if( sw3 == 1 ) {
            mspeed = -0.35;
            kate.speed(mspeed);
            wait(.03);
            mspeed = 0.0;
            kate.speed(mspeed);
            wait(.05);
            
        } else if (sw3 == 0) {
            mspeed = 0.0;
            kate.speed(mspeed);
        }
        else if(( sw2 == 1 && sw3 == 1)){ 
            mspeed = 0.0;
            kate.speed(mspeed);
        }
    }
}