a

Dependencies:   mbed

Committer:
nsnicolassr
Date:
Fri Apr 28 00:46:04 2017 +0000
Revision:
2:b39da64e9ebb
Parent:
1:21128721fd9a
programa de servo motores

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nsnicolassr 1:21128721fd9a 1
nsnicolassr 0:c77e4b298bbf 2 #include "mbed.h"
nsnicolassr 0:c77e4b298bbf 3
nsnicolassr 1:21128721fd9a 4 PwmOut s1(PC_6);
nsnicolassr 1:21128721fd9a 5 PwmOut s2(PC_8);
nsnicolassr 1:21128721fd9a 6 PwmOut s3(PC_9);
nsnicolassr 0:c77e4b298bbf 7
nsnicolassr 0:c77e4b298bbf 8 void servos (int nservo, float grados)
nsnicolassr 0:c77e4b298bbf 9 {
nsnicolassr 0:c77e4b298bbf 10 float porcentaje;
nsnicolassr 0:c77e4b298bbf 11
nsnicolassr 0:c77e4b298bbf 12 porcentaje=((grados*0.000277778)+0.05);
nsnicolassr 0:c77e4b298bbf 13
nsnicolassr 0:c77e4b298bbf 14 switch (nservo)
nsnicolassr 0:c77e4b298bbf 15 {
nsnicolassr 0:c77e4b298bbf 16 case 1:
nsnicolassr 0:c77e4b298bbf 17 s1.write(porcentaje);
nsnicolassr 0:c77e4b298bbf 18 wait(0.5);
nsnicolassr 0:c77e4b298bbf 19 break;
nsnicolassr 0:c77e4b298bbf 20
nsnicolassr 0:c77e4b298bbf 21 case 2:
nsnicolassr 0:c77e4b298bbf 22 s2.write(porcentaje);
nsnicolassr 0:c77e4b298bbf 23 wait(0.5);
nsnicolassr 0:c77e4b298bbf 24 break;
nsnicolassr 0:c77e4b298bbf 25
nsnicolassr 0:c77e4b298bbf 26 case 3:
nsnicolassr 0:c77e4b298bbf 27 s3.write(porcentaje);
nsnicolassr 0:c77e4b298bbf 28 wait(0.5);
nsnicolassr 0:c77e4b298bbf 29 break;
nsnicolassr 0:c77e4b298bbf 30
nsnicolassr 0:c77e4b298bbf 31 default:
nsnicolassr 0:c77e4b298bbf 32 s1.write( 0.05);
nsnicolassr 0:c77e4b298bbf 33 s2.write( 0.05);
nsnicolassr 0:c77e4b298bbf 34 s3.write( 0.05);
nsnicolassr 0:c77e4b298bbf 35 wait(0.5);
nsnicolassr 0:c77e4b298bbf 36 break;
nsnicolassr 0:c77e4b298bbf 37 }
nsnicolassr 0:c77e4b298bbf 38 }
nsnicolassr 0:c77e4b298bbf 39
nsnicolassr 0:c77e4b298bbf 40 int main() {
nsnicolassr 0:c77e4b298bbf 41
nsnicolassr 0:c77e4b298bbf 42
nsnicolassr 0:c77e4b298bbf 43 while(1) {
nsnicolassr 2:b39da64e9ebb 44 servos (1, 180);
nsnicolassr 0:c77e4b298bbf 45 wait(2);
nsnicolassr 1:21128721fd9a 46 servos (2, 180);
nsnicolassr 0:c77e4b298bbf 47 wait(2);
nsnicolassr 2:b39da64e9ebb 48 servos (3, 180);
nsnicolassr 0:c77e4b298bbf 49 wait(2);
nsnicolassr 2:b39da64e9ebb 50 servos (1, 0);
nsnicolassr 2:b39da64e9ebb 51 servos (2, 0);
nsnicolassr 2:b39da64e9ebb 52 servos (3, 0);
nsnicolassr 2:b39da64e9ebb 53 wait(2);
nsnicolassr 0:c77e4b298bbf 54 }
nsnicolassr 0:c77e4b298bbf 55 }