Nicolas Sandoval / Mbed 2 deprecated Nucleo_read_analog_value

a

Dependencies:   mbed

main.cpp

Committer:
nsnicolassr
Date:
2017-04-28
Revision:
2:b39da64e9ebb
Parent:
1:21128721fd9a

File content as of revision 2:b39da64e9ebb:


#include "mbed.h"

PwmOut s1(PC_6);
PwmOut s2(PC_8);
PwmOut s3(PC_9);

void servos (int nservo, float grados)
{
    float porcentaje;
    
    porcentaje=((grados*0.000277778)+0.05);
    
    switch (nservo)
    {
    case 1: 
    s1.write(porcentaje);
    wait(0.5);
    break;
    
    case 2: 
    s2.write(porcentaje);
    wait(0.5);
    break;
    
    case 3: 
    s3.write(porcentaje);
    wait(0.5);
    break;
    
    default:
    s1.write( 0.05);
    s2.write( 0.05);
    s3.write( 0.05);
    wait(0.5);
    break;
    }
}

int main() {
    
    
    while(1) {
         servos (1, 180);
         wait(2);
         servos (2, 180);
         wait(2);
         servos (3, 180);
         wait(2);
         servos (1, 0);
         servos (2, 0);
         servos (3, 0);
         wait(2);
        }
}