ISISA-Zacatenco / Mbed 2 deprecated MOT_BIP_CRTL_VISUAL_ST

motor bipolar ctrl visual st

Dependencies:   mbed

main.cpp

Committer:
Javierdf
Date:
2019-11-19
Revision:
0:019a33f5a47c

File content as of revision 0:019a33f5a47c:

#include "mbed.h"

BusOut M1(D2,D3,D4,D5);
Serial pc(USBTX, USBRX);
char pos1[4]={0x05,0x06,0x0A,0x09};
char pos2[4]={0x0A,0x06,0x05,0x09};
int i=0,u=0;

int main()  
{
     
  int x=0;
  int y=0;
  int v=0;

while(1){

 y=pc.getc();
    
    if(x<=y)
    {
        for(x=v;x<=y;x++)
        {
            y=pc.getc();
            
         M1=pos1[i];
         wait(0.005);
         i++;
         if(i==4)
         i=0;
         }  
          v=x;
         }
    
    if(x>=y)
    {
        for(x=v;x>=y;x--)
        {
         y=pc.getc();
           
         M1=pos2[u];
         wait(0.005);
         u++;
         if(u==4)
         u=0;
            }
         v=x; 
        } 
      }
    }