nicolas rojas / Mbed 2 deprecated servo1

yty gyvg

Dependencies:   mbed

main.cpp@0:3f5935fe427c, 2018-03-08 (annotated)

Committer:
nicolasrojas
Date:
Thu Mar 08 02:46:17 2018 +0000
Revision:
0:3f5935fe427c
programa 1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nicolasrojas 0:3f5935fe427c 1 #include "mbed.h"
nicolasrojas 0:3f5935fe427c 2 #define MAXPOS 50
nicolasrojas 0:3f5935fe427c 3 #define SS_TIME 100
nicolasrojas 0:3f5935fe427c 4
nicolasrojas 0:3f5935fe427c 5 PwmOut myServoX(PB_3);
nicolasrojas 0:3f5935fe427c 6 PwmOut myServoY(PB_4);
nicolasrojas 0:3f5935fe427c 7
nicolasrojas 0:3f5935fe427c 8
nicolasrojas 0:3f5935fe427c 9
nicolasrojas 0:3f5935fe427c 10 void vertex2d(float x, float y){
nicolasrojas 0:3f5935fe427c 11
nicolasrojas 0:3f5935fe427c 12 int pulseX =x*2000/50+500 ;
nicolasrojas 0:3f5935fe427c 13 int pulseY =y*2000/50+500 ;
nicolasrojas 0:3f5935fe427c 14
nicolasrojas 0:3f5935fe427c 15
nicolasrojas 0:3f5935fe427c 16
nicolasrojas 0:3f5935fe427c 17
nicolasrojas 0:3f5935fe427c 18
nicolasrojas 0:3f5935fe427c 19 myServoX.pulsewidth_us(pulseX);
nicolasrojas 0:3f5935fe427c 20 myServoY.pulsewidth_us(pulseY);
nicolasrojas 0:3f5935fe427c 21 wait_ms(SS_TIME);
nicolasrojas 0:3f5935fe427c 22
nicolasrojas 0:3f5935fe427c 23 }
nicolasrojas 0:3f5935fe427c 24
nicolasrojas 0:3f5935fe427c 25
nicolasrojas 0:3f5935fe427c 26 int main() {
nicolasrojas 0:3f5935fe427c 27
nicolasrojas 0:3f5935fe427c 28 myServoX.period_ms(20);
nicolasrojas 0:3f5935fe427c 29 myServoY.period_ms(20);
nicolasrojas 0:3f5935fe427c 30 int posx=0;
nicolasrojas 0:3f5935fe427c 31 int posy=0;
nicolasrojas 0:3f5935fe427c 32 while(1)
nicolasrojas 0:3f5935fe427c 33 {
nicolasrojas 0:3f5935fe427c 34 wait(2);
nicolasrojas 0:3f5935fe427c 35 vertex2d(posx,posy);
nicolasrojas 0:3f5935fe427c 36 posx+=10;
nicolasrojas 0:3f5935fe427c 37 posy+=10;
nicolasrojas 0:3f5935fe427c 38 if (posx>50) posx=0;
nicolasrojas 0:3f5935fe427c 39 if (posy>50) posy=0;
nicolasrojas 0:3f5935fe427c 40
nicolasrojas 0:3f5935fe427c 41
nicolasrojas 0:3f5935fe427c 42 }
nicolasrojas 0:3f5935fe427c 43
nicolasrojas 0:3f5935fe427c 44 }
nicolasrojas 0:3f5935fe427c 45