main.cpp

00001 // Hello World to sweep a servo through its full range
00002 
00003 #include "mbed.h"
00004 #include "Servo.h"
00005 
00006 // init pin for Nucleo-L476RG
00007 // Servo myservo(PB_3);
00008 
00009 // init pin for Nucleo-L432KC
00010 Servo myservo(D6);
00011 
00012 AnalogIn ain (A2);
00013 
00014 int main() {    
00015  
00016     float p = 0.0;
00017     float pRead;
00018     
00019     // myservo.position(0);
00020     while(1){
00021        /*myservo.write(0);
00022        wait(5);
00023        myservo.write(1);
00024        wait(5);*/
00025         //myservo.position(90);
00026         //myservo.write(p);
00027         //pRead = myservo.read();
00028        // printf("val = %f \n",pRead);
00029         //wait(0.8);
00030         /*if(p > 0.9)
00031             p=0.0;
00032         else
00033             p+=0.1;*/
00034         if (ain == 1)
00035         {
00036             myservo.write(1);
00037            // myservo.position(180);
00038             wait(2);
00039          //   myservo.position(0);
00040            myservo.write(0);
00041         }
00042     }
00043 
00044 }