nicolas rojas / Mbed 2 deprecated servo1

yty gyvg

Dependencies:   mbed

main.cpp

Committer:
nicolasrojas
Date:
2018-03-08
Revision:
0:3f5935fe427c

File content as of revision 0:3f5935fe427c:

#include "mbed.h"
#define MAXPOS 50   
#define SS_TIME 100     
 
PwmOut myServoX(PB_3);
PwmOut myServoY(PB_4);
 
 
 
void vertex2d(float x, float y){
 
    int pulseX =x*2000/50+500 ;
    int pulseY =y*2000/50+500 ;
 
  

    
    
    myServoX.pulsewidth_us(pulseX);
    myServoY.pulsewidth_us(pulseY);
    wait_ms(SS_TIME);
 
}
 
 
int main() {
     
    myServoX.period_ms(20);
    myServoY.period_ms(20);
    int posx=0;
    int posy=0;
    while(1)
    {
        wait(2);
        vertex2d(posx,posy);
        posx+=10;
        posy+=10;
        if (posx>50) posx=0;
        if (posy>50) posy=0;
        
        
     }
 
}