Chindanai Mala-eiam / Main

Main

MOTOR.h

Committer:
chinetion
Date:
2015-12-08
Revision:
2:8441bd03d9bc
Parent:
1:0b8836a7cd96

File content as of revision 2:8441bd03d9bc:

class MOTOR{
    public:
        MOTOR(PinName,PinName);
        void forward();
        void backward();
        void stop();
        void read();
    private:   
        DigitalOut a;
        DigitalOut b;
        DigitalIn sw_top;
        DigitalIn sw_bot;
};
MOTOR::MOTOR(PinName pin_a,PinName pin_b):a(pin_a),b(pin_b),sw_top(D4),sw_bot(D5){
    stop();
}
void MOTOR::read(){
    printf("%d\n",sw_top.read());    
}
void MOTOR::forward(){
    while(!sw_top.read()){
        a=0;b=1;
    }
    stop();
}
void MOTOR::backward(){
    while(!sw_bot.read()){
        a=1;b=0;
    }
    stop();
}
void MOTOR::stop(){
    a=1;
    b=1;
}