Rotork Research Team / Mbed 2 deprecated TFM_Encoder

Dependencies:   mbed QEI

main.cpp

Committer:
simontruelove
Date:
2018-10-19
Revision:
0:634dd505dace
Child:
1:0191658b6ff4

File content as of revision 0:634dd505dace:

#include "mbed.h"

DigitalOut       Phase1                 (p21);                            
DigitalOut       Phase2                 (p22);
DigitalOut       Phase3                 (p23);
DigitalOut       Phase4                 (p24);

int main() {  
float x=0.02, y=0.01;
while(1)  {  
    Phase1 = 1;
    Phase2 = Phase3 = Phase4 = 0;
    wait(x);
    
    Phase1 = Phase2 = 1;
    Phase3 = Phase4 = 0;
    wait(y);
    
    Phase2 = 1;
    Phase1 = Phase3 = Phase4 = 0;
    wait(x);
     
    Phase2 = Phase3 = 1;
    Phase1 = Phase4 = 0;
    wait(y);
    
    Phase3 = 1;
    Phase1 = Phase2 = Phase4 = 0;
    wait(x);
        
    Phase3 = Phase4 = 1;
    Phase1 = Phase2 = 0;
    wait(y);
    
    Phase4 = 1;
    Phase1 = Phase2 = Phase3 = 0;
    wait(x);
    
    Phase4 = Phase1 = 1;
    Phase2 = Phase3 = 0;
    wait(y);   

    }
}