/*L10 - experiment control motoare DC cu viteza reglabila
prin sensorul Tuch.
Motoarele sint interfate cu optocuploare si se alimenteaza la
12V
*/

#include "mbed.h"
#include "TSISensor.h"

    TSISensor tsi ; 
    PwmOut M1(PTD4); // motor 1
    PwmOut M2(PTA12);// motor 2
    PwmOut M3(PTA4); // motor 3
    PwmOut M4(PTA5); // motor 4
   float x; 
    
int main(void) 
{
    
    M1.write(1);  // opresc motor 1
//  wait(0.1);  
     M2.write(1); // opresc motor 2
 //    wait(0.1);  
      M3.write(1); // opresc motor 3
  //    wait(0.1);  
       M4.write(1); // opresc motor 4
  //     wait(0.1);
       
   M1.period(0.020);  // perioada motor 1
   wait(0.1);
    M2.period(0.020);
    wait(0.1);
     M3.period(0.020);
     wait(0.1);
      M4.period(0.020);
      wait(0.1);
    
    while (1) 
    {
        x=tsi.readPercentage()/4; // lectura sensor cu
        wait(0.1);                // evitare viteza maxima
    
      M1.write(1-x);
      wait(0.1);   
       M2.write(1-x);
       wait(0.1);     
      M3.write(1-x);
       wait(0.1);
       M4.write(1-x);
        wait(0.1);
    }
}