Nicolas Sandoval
/
Nucleo_read_analog_value
a
main.cpp@2:b39da64e9ebb, 2017-04-28 (annotated)
- 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?
User | Revision | Line number | New 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 | } |